Documentos de Académico
Documentos de Profesional
Documentos de Cultura
discussions, stats, and author profiles for this publication at: http://www.researchgate.net/publication/4239340
CITATIONS
3 AUTHORS, INCLUDING:
M. Vakil
R. Fotouhi
University of Saskatchewan
University of Saskatchewan
27 PUBLICATIONS 64 CITATIONS
SEE PROFILE
SEE PROFILE
I. INTRODUCTION
Because of their potential application in a wide range of
operation, flexible-link manipulators have been widely studied
over a number of years. Many of these studies have been on
the end-effectors trajectory planning [1, 3, 4, 5].
One possibility for the end-effectors trajectory tracking is
adopting the regulation method introduced in [2]. The
feasibility of applying this method to flexible-link
manipulators is studied in [3].
Another alternative for the end-effectors trajectory
tracking is to create a feedforward control command by using
the inversion of the system dynamic. Inversion of a minimum
phase system, such as end-effectors motion of rigid-link
manipulators, is done very easily. Contrary to rigid-link
manipulators the end-effectors trajectory tracking of flexiblelink manipulators has non-minimum phase characteristics.
Thus, the causal stable inversion of the dynamic equation of
flexible-link manipulators having a desired trajectory for the
end-effector is not achievable. To force the end-effector of a
SFLM to follow a specific path, the required bounded torque
is obtained by the non-causal inversion of the equation of
motion in the frequency domain [4]. Using Laplace
transformation, Kwon and Book [5] solved the same problem
of end-effectors trajectory inversion for a SFLM. The
methods introduced in [4, 5] find the proper initial conditions
for the inverse system so that the result of the inverse system
becomes bounded. Moreover, these inversion procedures are
D
i=0
376
ai
(2)
B=
u py = ze mt
(3)
bi
where
i=0
d
(4)
( dt ) i
a i ( i = 0 ,1, 2 .. p ) and b i ( i = 0 ,1, 2 ..h ) are real constants.
Let y d be the desired output to be tracked. The
Di =
z=k
c e
ri t
(7)
y (t f ) = y f 0 , y 1 (t f ) = y f 1 , y 2 (t f ) = y f 2 ...., y n 1 (t f ) = y fn 1
(13)
i
d
y
where t i and t f are the initial and final times, y i =
, with
dt i
q-1 and n-1 being the highest order of derivatives of y that
have to be satisfied at t i and t f , respectively. It is worth
i
where t i is the initial time, u i = d u , with w-1 being the
dt i
highest order of derivative of u that has to be satisfied at t i . It
k i e mi t
yd =
a m
(12)
i =1
u = u p + uc
i=0
p
i=0
(6)
Au c = 0
Since the coefficients of the differential operator A are
constant, the complementary solution is:
p
b m
i
uc =
(11)
(9)
i =1
377
EI : Links rigidity
: Mass per unit length
Kh : Hobs kinetic energy
Ktp : Tip-masss kinetic energy
Using the Lagrangian approach, the dynamic equation of
the motion for the SFLM is obtained as:
+ K d = F
(20)
Md
where, d is the vector of DOF, composed of the rigid
coordinate ( ) and the flexible coordinates ( i ) . F is the
input control vector which includes the input torque u. M and
K are the mass and stiffness matrices, respectively. It is to be
noted that the derivation of this linear dynamic model is based
on the fact that in the kinetic energy the quadratic terms of the
deformation is negligible [8].
Since Eq.20 is linear, the state space representation of Eq.
20 for the output y, using the first two mode shapes of the arm,
is:
z = A2 z + B 2 F
(21)
here is applicable.
Remark 3: It is clear that the m i in Eq. 9 is decided at the
beginning of the procedure. They can be any negative
numbers except the negative roots of the characteristic
equations A(m)=0 and B(m)=0 of (2) and (3). Therefore, the
inversion method presented here via output planning results in
a family of solutions rather than just one polynomial solution
as given by [1].
Having calculated the number of exponential functions
from Eq. 15, the unknowns (k in Eq.10, z in Eq.11 and c in
Eq.7) are found by solving a set of simultaneous linear
algebraic equations.
IV. SFLM STABLE INVERSION THROUGH OUTPUT
PLANNING
In this section the stable inversion of a SFLM by output
planning will be examined. The dynamic model from [1] is
used for simulation. Due to finite wave propagation in elastic
media there is a time delay between actuation and sensing if
the actuator and sensor are non-collocated. In a linear model,
this delay is represented by a zero at the right hand side of the
S-plane. Because of the existence of such positive zeros the
linear system is non-minimum phase. Usually for a flexiblelink manipulator, the input is the torque at the base and the
desired output is the end-effectors position. Thus, the relation
between the input (torque) and the output (end-effectors
position) has a non-minimum phase characteristic. The
dynamics of the flexible-link manipulator is of infinitedimension. Usually a truncated dynamic model based on the
assumed mode shape method (AMM) [5], or finite element
method (FEM) [6], is used to control the motion of a flexiblelink manipulator. Use of the AMM for trajectory tracking of a
flexible-link manipulator at the joint space is studied in [7]. In
this paper the dynamic modeling based on the AMM is also
used.
The lateral displacement of a point at a distance x from the
base as in Fig. 1, is obtained as the sum of rigid body rotation
( ) and the small deflection ( ):
(16)
= x +
It is assumed that (lateral displacement of point x in
flexible-link manipulator measured from rotated rigid-link
manipulator) is small and given by:
( x) i
y = C2z
C 2 = [L
0]
d
d = [
0
B 2 = 1
M
L = [L
2 ]
1 ( L ) 2 ( L )]
F = [u
0]
(17)
I h = 1 . 8 10 3 ( kg .m 2 )
1
d
Ke = ( dx) + Kh + Ktp
2 L dt
I
0
z = d
T
i =1
d 2
1
Pe = EI 2 dx
2 L dx
A2 =
1
M
K
(18)
= 2 . 0316 ( kg / m )
EI = 47 . 25 ( N .m )
2
(19)
m t = 6 . 79 kg
I t = 4 . 742 10 2 ( kg .m 2 )
where
378
(22)
The first and second natural frequencies of such clampedfree beam are f 1 = 6 . 03 Hz and f 2 = 16 . 07 Hz as noted in
[1]. The transfer function which relates the desired endeffectors position y and the input torque u is [1]:
y
.295 s 4 + 98 .736 s 2 + 3331956 .636
(23)
=
u s 2 (s 4 + 19015 .243 s 2 + 25179356 .808 )
This transfer function is obtained assuming two mode shapes
and using physical parameters given in (22). The transfer
functions zeros are:
z 1, 2 = 59 . 4
(24)
z
=
56
.
5
i
3
,
4
this value was chosen as the starting point for choosing other
mi values.
Since there was no damping consideration in the singlelink flexible-link manipulator presented in [1], there exist
purely imaginary zeros. While the existence of pure imaginary
zeros is a barrier in application of the non-causal integration
method introduced in [4, 5], our method can handle the
existence of pure imaginary zeros. To determine the number
of exponential functions that must be used for output planning
consider that the following initial conditions are imposed on y
and u and their derivatives and also the following final
conditions are imposed on y and its derivatives:
y ( 0 ) = y 1 ( 0 ) = y 2 ( 0 ) = y 3 ( 0 ) = y 4 ( 0 ) = y 5 ( 0 ) = 0 (25)
(26)
u (0 ) = u 1 (0 ) = u 2 (0) = u 3 (0) = 0
and
y (10 ) = 1 . 57
(27)
y 1 (10 ) = y 2 (10 ) = 0
To find the output y in the time domain from the transfer
function given in Eq.23 zero initial conditions on y and its first
five derivatives (Eq.25) and zero initial conditions on u and its
first three derivatives (Eq.26) are assumed. It is also assumed
that the duration of motion is 10 seconds (t f = 10) . To find the
12
k i e mit
mi
mi
(28)
For this set the displacement and the input torque are shown in
Fig. 4 and Fig. 5, respectively.
i =1
379
mi
mi
mi
mi
mi
2.16,2.4,2.64,2.88]
380
For this set the displacement and input torque are shown in
Fig. 6 and Fig. 7, respectively. A comparison of these three
sets indicated the dependence of the required torque and the
end-effectors displacement on the values of the mi . Since no
in Eq.7, thus p
on the number
desired output
function, k i in
V. CONCLUSION
k e
mit
i =1
REFERENCES
[1]
[2]
[3]
[4]
[5]
[6]
[7]
APPENDIX
CALCULATING THE NUMBER OF EXPONENTIAL
FUNCTIONS USED IN PLANNING DESIRED OUTPUT
[8]
[9]
381