Documenti di Didattica
Documenti di Professioni
Documenti di Cultura
Heidari
Keywords:
Modeling and Simulation
Manipulator
Ergonomic principle
Flexible joints
ABSTRACT
In this paper, design and manufacturing of a mobile mechanical manipulator with flexible
joints are presented. Ergonomic principals such as balancing the human height and
anthropometric, enough space for moving, accessibility of the controllers, making
environment labor-friendly adapting the manipulator with the load and anthropometric are
considered in order to reduce harm and fatigue. First, the kinematics and dynamic equations
of the mechanism with flexible joints for the three major axis of the mobile robot are derived
and simulated. Next, a method for determination of the dynamic load carrying capacity
(DLCC) for a specific reference is explained subject to both accuracy and actuator
constraints. The manipulator is tested for a given trajectory in order to find the
characteristics of the designed manipulator. While the manipulator is designed to carry the
maximum load, end-effector's speed, robot's compatibility with the operator's condition, and
accuracy are the most important applicable points of the manipulator. Therefore, the
manipulator in different trajectories with various speeds and loads are tested, and then the
results are analyzed.
1. Introduction
Today, one of the most important problems in the modern
industrial companies is difficulties in the manufacturing for
operators. In addition, in the automation, which needs
operator's accuracy and swiftness, manipulating might cause
errors in measurement especially in hard working situations.
This hard work situation not only might hurt labor but also
cause unqualified production. Mechanization of industries
has been emerged as a result of recent developments.
Although operators controlling role have decreased, there
are some limitations, which hinder full automation. In such
conditions, we use semi-automatic mechanisms. Efficiency
is the main purpose in manipulators usage in industries and
they are tremendously used in carrying pieces. The use of
industrial mechanisms especially robotic manipulators in
production industry has been very important worldwide, in
* Address for correspondence: hkorayem@iust.ac.ir
19
20
2. Intermediate circuit:
Initially raw signals enter into the intermediate circuit and
through a FPGA circuit, used as a signal converter, are
converted to processor-friendly ones. Computer and the
hardware circuit are connected, using a COM1 port and
RS232 standard. Sending rate is 2400 bit per second. The
designed intermediate circuit and the manufactured one are
shown in Figures 4 and 5.
Figure (2). The designed manipulator for carrying automobile petrol
tank
3. Computer programming:
We have used Visual Basic program to run computer
program, which processes the received information from the
encoders. In each time, until all three encoder's data are
received, the information would be saved in special array.
The diagram would change with renewed information.
4. Computer:
21
Link Number
ai
di
L0
2
0
L1
L2
L3
L4
2
0
0
1
L0 L4 L1 S 2
0
0
0
1
22
as
the
link
angles
F2 q 4L q 4L G2 q 4L H 2 K 22 q 2L q 2J 0
A3 q1L B3 q2L C3 q3L D3 q1L q1L
E3 q1L q 2L F3 q 2L q 2L K 33 q 2L q 2J 0
and
qiJ q1J , q2J , as the rotor angles defined for the multilink flexible joint manipulator. A Lagrangian approach was
used in order to obtain the dynamic equations of motion for
the manipulator with elastic joints, as below:
L C(qL , q
L )q
Lq
L G(qL ) F
(4)
D(qL )q
L CqL , q L q L q L GqL KqL qJ 0
DqL q
J KqL qJ
(6)
Jr q
(10)
(11)
(12)
K33 q q 3
(13)
J r33 q
Assuming a given trajectory, variation of joints angles are
determined from the above differential equations. The
graphic representation of the solutions with different
torsional stiffness coefficients are depicted in Figures (9) to
(12) for trolley and joints 1 to 3, respectively. Joint's torques
are shown in Figure (13).
J
3
(5)
L
3
J
3
Rigid
K1=5*104 ,K2=8*104 ,K4=4*104
K1=5000 ,K2=8000 ,K4=4000
K1=3500 ,K2=5000 ,K4=3000
X(m)
6
5
4
3
2
1
0
0.5
1.5
2
T(sec)
2.5
3.5
-0.2
TETA1(rad)
-0.4
-0.6
-0.8
-1
Rigid
-1.2
-1.4
0.5
1.5
2
T(sec)
2.5
3.5
(9)
0.2
0.18
J
i
0.16
0.14
TETA2(rad)
0.12
0.1
0.08
0.06
0.04
Rigid
0.02
0.5
1.5
2
T(sec)
2.5
3.5
23
-0.02
TETA4(rad)
-0.04
-0.06
-0.08
-0.1
Rigid
-0.12
-0.14
0.5
1.5
2
T(sec)
2.5
3.5
F (N)
torque1 (N.m)
torque2 (N.m)
torque4 (N.m)
35
30
Torque(N.m)
25
20
1.5
15
10
0.5
Angle Joints(rad)
5
0
-5
0.5
1.5
2
T(sec)
2.5
3.5
0
-0.5
-1
-1.5
-2
-2.5
10
15
20
25
Time(s)
Theory
Test1
Test2
Test3
Test4
Test5
Test6
0.9
position Y (m)
0.8
0.7
0.6
0.5
0.4
-0.2
-0.15
-0.1
-0.05
0
0.05
0.1
position X (m)
0.15
0.2
0.25
24
0.3
RP L L 3S L
Theory1
Teta1
Theory2
Teta2
Theory3
Teta3
L
Where:
Angle Joints(rad)
0.5
L j ( x j x ) 2 ( y j y) 2 ( z j z ) 2
n
SL
-0.5
(L
j 1
L)2
(17)
n 1
-1
(16)
1 n
Lj
n j 1
10
15
20
Various loads
Various Velocity
25
Time(s)
0.14
0.12
0.1
-0.8
Theory
Test
0.08
0.06
-0.9
position Z (m)
0.04
-1
0.02
0
-1.1
-1.2
-1.3
0.6
0.9
0.4
0.2
-0.2
0.7
-0.4
position Y (m)
0.5
0.8
0.6
position X (m)
SSE xk xt h
(19)
SSE
k 2
(20)
pose accuracy ( AP P ).
APP ( x xc )2 ( y yc )2 ( z zc )2
Variation
(14)
Where:
1 n
x xj
n J 1
1 n
y yj
n J 1
1 n
z zj
n J 1
(15)
25
Uallow c1 c2q
Where k1 s , k 2 s / 0 ,
(22)
0.12
0.1
0.08
0.06
0.04
0.02
i Ua i e i
0
1
Various loads
Various velocity
(24)
( a )i
can then
be calculated as follows:
(25)
a i max i ,i
In order to determine the maximum allowable load, by
considering the actuator constraint, it is essential to define a
load coefficient (ca ) j for any point along the given
Variation method
0.006
0.005
trajectory as follows
a i
ca j min
, i 1,2,, n
max
max
e
n
0.004
0.003
0.002
Where
(26)
0.001
1
Various loads
Various Velocity
26
experimental mass
R P =0.15
m, the maximum
load is 15 Kg in comparison with 10 Kg for simulation
maximum load with the same R P . According to RD's petrol
tank weight, 10 Kg, the result is acceptable. Improving some
details and considering customer's priorities the manipulator
would be ready for industrial usage.
13. Conclusion
The manipulator is designed, simulated and tested in
different trajectories and pose. While the manipulator is
designed to carry the automobile petrol tank, operator's
facility, end-effector speed, accuracy and DLCC are
considered the main criteria. The main error sources are
human's fluctuation, noise, measurement tools etc. although
the experimental results are near the theoretical ones, at the
end of trajectory, according to joint flexibility and nonaccurate manufacturing they diverge, and the error interval
is about 5-10 percent. Quality manufacturing, manipulator
conditions, adaptable working space and optimizing the
pneumatic system design are main criteria in manipulator
manufacturing. According to manipulator usage, maximum
error in each trajectory, pose accuracy and pose repeatability
are its important characteristics. Regarding error sources, as
human's fluctuation in automobile petrol tank carrying,
deviation from desired path particularly in direct Angular
rotation of the joints, is acceptable.
me
mlo a d can
be
(29)
actuator can follow the trajectory within the allowable endeffector's deflection, unless the actual mass and the moment
of inertia of the load are more than maximum calculated
load. Applying 4-atmosphere pressure on this pneumatic
system of the manipulator, while the accuracy in the endeffector has been assumed 0.15 m, allowable dynamic load
would be 10 Kg. According to the minimal size of this
manipulator, this load is considerable.
References
[1] M. H. Korayem, and Gariblu, Analysis of Wheeled
Mobile Flexible Manipulator Dynamic Motions With
Maximum Load Carrying Capacities, Robotics and
Autonomous Systems, Vol. 48, No. 2-3, pp. 63-76, 2004.
[2] M. Thomas, H. C. Yuan-Chou and D. Tesar, "Optimal
actuator sizing for robotic manipulators based on local
dynamic criteria", ASME Journal of Mechanisms,
12. Discussion
To design a robot, one should consider kinematics and
dynamic situations. It needs to solve complicated long
27
28