Академический Документы
Профессиональный Документы
Культура Документы
Firouzy
ARTICLE INFO
ABSTRACT
Keywords:
Flexible Links, Mobile Base,
Dynamic Load Carrying
Capacity.
This paper focuses on the effects of closed- control on the calculation of the
dynamic load carrying capacity (DLCC) for mobile-base flexible-link
manipulators. In previously proposed methods in the literature of DLCC
calculation in flexible robots, an open-loop control scheme is assumed, whereas in
reality, robot control is achieved via closed loop approaches which could render
the calculated DLCC value inaccurate. The aim of this research is to investigate
the necessity of considering the effect of closed loop control in the calculation of
the DLCC of mobile-based flexible link manipulators. Finite elements modeling
and the Lagrange method have been used for modeling a mobile-base manipulator
with two flexible links link. After that, a control scheme based on the feedback
linearization method has been devised. A method for calculating the DLCC from a
previously published study has then been utilized, with the difference that closedloop motion control has been assumed as opposed to open-loop control. Finally,
three simulation case studies have been presented for which the results have been
compared with those reported in a previously published study which ignores the
closed-loop control effects. The comparisons show that the effect of closed-loop
control on the DLCC needs to be taken into account.
1- Introduction
This study addresses consideration of closed-loop
control effects on the calculation the dynamic load
carrying capacity (DLCC) of mobile-base flexiblelink manipulators, using finite elements and Lagrange
modeling and feedback linearization control
approach. Mobile robot manipulators have
increasingly been given attention during recent years
due to their several advantages over their rigid
counterparts; such as their improved maneuverability
and their reduced power consumption. However,
application of these types of robots involves dealing
with a number of problems. Since mobile robots are
usually power-on-board with limited power
34
35
7 7 matrix and
n1
is
and y 0 .
M M (q )
q [x 0
u3
u4
w3
w 4 ]T . The
and
n2
36
x0
Where 1
x 0 (the
second
x 0
is on the
x 0 in
and
time-derivative of
while F
G
are 2 2 square matrices comprised only of the first
and fourth rows of G and F , respectively. The
differential equation of the rest of the generalized
coordinates could be represented in a matrix form as
follows:
f F f G f
(8)
q
Where the subscript f refers to the flexural variables
Q 1 0 0 2 0 0 . Now, those
terms of the equations containing
2 T ,
(4)
Where q 1 u 3 u 4 2 w 3 w 4 , and
M 2 is obtained by eliminating the first column of
M . By multiplying both sides of the equation by
M 2 1 and defining F (M 2 ) 1 (f M 1x 0 ) , eq.
(4) becomes:
F ( M 2 ) 1 Q
(5)
q
Since there are four zero rows in Q , four of the
columns of M 2 1 are multiplied by zeros in eq.
(5); therefore by eliminating them, the equation
describing the behavior of the generalized
coordinates of the whole system will become:
F G
q
(6)
37
G [F v ]
(9)
T
Where d [ 1d 2d ] is the desired joint angle
~
~
~
1 2 0
(11)
This is a linear differential equation in which proper
choice of 1 and 2 will lead to the asymptotic
convergence of the tracking error to zero. This is a
problem of placing the poles of the linearized closedloop system, which must be located on the left hand
side of the vertical axis in the complex number plane.
Here, the optimum locations of the closed loop poles
were chosen by trial and error, and the corresponding
values of 1 and 2 are 1.1 and 0.1, respectively.
u3 , u 4 , w3
and
38
+
_
( )
Robot
Model
q
,
q
_
+
(q ,
This can be regarded as the remaining allowable endeffector deflection at point j of the given trajectory.
This remaining amount can express the amount of
additional load that can be carried along the desired
trajectory without violating the maximum allowable
deviation of the end-effector position. Therefore, a
load coefficient (C p ) j can be introduced for point j
(C p ) j
simulations,
no-load
deflection
R
max[Def
(Def
e
)j
] max[Def
nl
(12)
Where
max{Defe } max{(Defe )1 , (Defe ) 2 ,..., (Defe ) m } (13)
max{Defnl } max{(Defnl )1 , (Defnl ) 2 ,..., (Defnl ) m }
(Def n ) j
and
4-2. Formulation of the actuator torque constraint
The formulation of the actuator torque constraint
for rigid manipulators could be found in [8]. The
same approach could be used for flexible
manipulators as well, as in [6]. In order to formulize
the actuator torque constraint, knowledge of the
maximum allowable torques of the motors is needed;
therefore, typical torque-speed curves of DC motors
39
k 2 T s / nl
k 1 Ts
and
k 1 k 2 q
k 1 k 2 q
(14)
are
i (U
i (U
) i ( e ) i ( nl ) i
) i ( e ) i ( nl ) i
Moment of Inertia
Mass per Length
(15)
Modulus of
Elasticity
( a ) i
max{ i , i }
(16)
Now a load coefficient could be defined to represent
the actuator torque constraint, as follows:
(C a ) j min{( a / e ) i , i 1,2,..., n}
(17)
I1 I 2 5 .5e 8
m1 m
0 .8
E1 E2 2.0e11
k1
160
k2
10
m4
Kg/m
N / m2
N .m .
N .m.s / ra
40
d (t)
x 0 ( t ) 1.84
0
.
15
0
.
15
Sin
(
4
/
2
)
200
150
upper bound
actual path
0.3
0.25
desired path
Y (m)
0.2
100
-50
no-load torque
0.15
-100
lower bound
0.1
-150
0.05
-200
0.1
0.2
0.3
0.4
0.5
0.6
0.7
0.8
0.9
time (sec)
-0.05
1.8
1.85
1.9
1.95
2.05
2.1
2.1
X (m)
-3
Fig. 4: Desired and actual path of the end effector with initial
load
x 10
200
u3, m
150
upper bound
-1
100
to rq u e o f th e firs t jo in t
-2
-3
50
-4
0
-5
0.1
0.2
0.3
0.4
0.5
0.6
0.7
0.8
0.9
t, sec
-50
no-load torque
u3
-100
-3
lower bound
x 10
-150
4
-200
0.1
0.2
0.3
0.4
0.5
0.6
0.7
0.8
0.9
1
2
time (sec)
u4, rad
-2
-4
-6
0.1
0.2
0.3
0.4
0.5
0.6
0.7
0.8
0.9
t, sec
41
u4
-4
x 10
w3, m
-2
-4
-6
End effector Path, desired and actual
-8
0.35
0.1
0.2
0.3
0.4
0.5
0.6
0.7
0.8
0.9
t, sec
actual path
0.3
w3
0.25
-3
x 10
0.2
desired path
Y (m )
0.8
0.6
0.4
0.15
0.1
w4, rad
0.2
0.05
0
-0.2
-0.4
-0.05
1.8
1.85
1.9
1.95
2.05
2.1
2.15
-0.6
X (m)
-0.8
-1
0.1
0.2
0.3
0.4
0.5
0.6
0.7
0.8
0.9
t, sec
Fig. 10: Flexural slop at the tip point of the second link,
w4
0.014
0.012
0.01
0.008
0.006
0.004
0.002
0.1
0.2
0.3
0.4
0.5
0.6
0.7
0.8
0.9
time (sec)
42
point { x1
in Fig.15.
200
upper bound
150
100
50
-50
no-load torque
-100
-150
lower bound
-200
0.1
0.2
0.3
0.4
0.5
0.6
0.7
0.8
0.9
time (sec)
200
150
upper bound
100
0 t T /4
v at
T / 4 t 3T / 4
v v max
v v
3T / 4 t T
max at
50
-50
no-load torque
-100
lower bound
-150
-200
0.1
0.2
0.3
0.4
0.5
0.6
0.7
0.8
0.9
time (sec)
43
2.4
Upper Bound
2.3
Y (m)
Actual path
Lower Bound
2.1
Desired Path
2
1.9
0
No-Load Torque
-5
-10
Lower Bound
0.5
1.5
2.5
Time (sec)
Fig.17: Torque of the first joint actuator with and without the
initial load.
30
Upper Bound
20
K s 2 25
-25
K S1 18 ,
0.7
-20
Actuator stall
torque
0.6
-15
K 2 10
0.5
Upper Bound
K 1 15 ,
0.4
10
Spring Constant
0.3
15
m 2 0 .5
0.2
m1 0 . 7 ,
0.1
X (m)
Mass
2.2
10
No-Load Torque
0
Lower Bound
-20
Kg
N.m
-30
0.5
1.5
2.5
3.5
Time (sec)
N.m.s/rad
44
25
20
15
10
Max Load
0.5
1.5
2.5
3.5
time (sec)
2.4
2.35
Upper Bound
Length of links
L1 L 2 1 .2
Moment of
inertia
Mass
I 1 I 2 5 .5 e 4
2.3
Y (m)
2.25
2.2
Actual path
Lower Bound
2.15
2.1
2.05
Desired Path
m1 0 .8,
Spring Constant
K1 17,
Actuator stall
torque
K S1 12 ,
m 2 0 .8
K2 12
K s 2 30
Kg.m2
Kg
N.m
N.m.s/rad
1.95
0.1
0.2
0.3
0.4
0.5
0.6
0.7
X (m)
20
10
Torque with Maximum Load
No-Load Torque
-10
-20
Lower Bound
0.5
1.5
2.5
Time (sec)
Fig. 21: Torque of the first joint actuator while carrying the
maximum allowable load
45
0.6
30
0.4
0.2
actual path
0
Teta1(rad)
D y n a m ic L o a d C a rry i n g C a p a c i ty
25
20
-0.2
desired path
-0.4
15
-0.6
10
-0.8
0.5
1.5
Time(sec)
Fig. 24: Angle of the first joint during the motion of the
manipulator
Max Load
0
0.5
2.5
1.5
Time (sec)
2.4
desired path
2.3
actual path
Teta2(rad)
2.2
2.1
1.9
1.8
1.7
1.6
1.5
0.5
1.5
Time(sec)
Fig. 25: Angle of the second joint during the motion of the
manipul
1.6
1.4
Y (m)
1.2
desired path
0.8
upper bound
0.6
0.4
0.4
lower bound
actual path
0.6
0.8
1.2
1.4
X (m)
Fig. 26: Desired and actual path of the end-effector for the
third case study
46
1.6
REFERENCES
[1] Thomas M, Yuan-Chou HC, Tesar D.,
Optimal Actuator Sizing for Robotic
Manipulators Based on Local Dynamic
Criteria J. of Mechanisms Transmission
Automation in Design, Vol.107, 1985, pp. 163
169.
[2] Wang LT, Ravani B (1988) Dynamic load
carrying capacity of mechanical manipulators,
Part I, problem formulation. J Dyn Syst Meas
Control 110:4652.
[3] Korayem M. H., Basu A. Formulation and
Numerical Solution of Elastic Robot Dynamic
Motion with Maximum Load Carrying
Capacity Robotica, Vol.12, 1994, pp. 253
261.
[4] M. H. Korayem, A. Basu, Mathematical
Modeling and Simulation of Differentially
Wheeled Mobile Robots Dynamic Equations,
Int. Journal of Applied Science and
Computations, Vol. 10, 2003, PP. 30-37.
[5] M. H. Korayem, A. Basu, Dynamic load
carrying capacity of robotic manipulators with
joint elasticity imposing accuracy constraints,
47
48