Anda di halaman 1dari 9

Robotica (1997) volume 15, pp 563 – 571.

Printed in the United Kingdom ÷ 1997 Cambridge University Press

Experimental Evaluation of Identification Schemes on a Direct


Drive Robot*
Fernando Reyes and Rafael Kelly
Diy isio´ n de Fı´ sica Aplicada , CICESE , Apdo. Postal 2615 , Adm . 1 , Carretera Tijuana-Ensenada Km. 107 , Ensenada ,
B.C . 22800 (Mexico) e-mail: rkellyêcicese.mx. e-mail: freyezêcicese.mx.

(Received in Final Form: December 16, 1996)

SUMMARY The recognition that the total energy of robot


This paper describes the experimental evaluation of manipulators can be described by a linear regression in a
three identification schemes to determine the dynamic combination of the inertial parameters was used to
parameters of a two degrees of freedom direct-drive propose the supplied energy regression model12 also
robot. These schemes involve a recursive estimator while known as the integral model.3–5 As much as the filtered
the regression models are formulated in continuous time. dynamic model as the supplied energy model are
The fact that the total energy of robot manipulators can regression models independent of joint acceleration.
be represented as a linear relation in the inertial However, an advantage of the supplied energy model
parameters, has motivated the suggestion in the over the filtered dynamic model is that the former yields
literature of several regression models which are linear in a scalar prediction error while the latter leads to a vector
a common dynamic parameter vector. Among them, in prediction error.
this paper we consider the schemes based on the filtered A modest contribution of this paper is the proposal of
dynamic regression model, the supplied energy regres- a new regression model also based on the principle of
sion model and a new one proposed in this paper: the energy conservation. We call this model the filtered
filtered power regression model. The underling recursive power model; this is derived from the supplied energy
parameter estimator used in the experimental evaluation model proposed by Gautier and Khalil.12 In contrast with
is the standard least-squares. the supplied energy model which involves the integral of
the power, the new proposed regression model contains a
low-pass filter of the power. This filter avoids potential
KEYWORDS: Direct drive robot; Identification schemes; problems owing to the infinite gain of the integrator at
Regression model; Filtered power.
zero frequency.
Although there exists a number of references in the
1 INTRODUCTION literature dealing with robot identification, there have
Identification techniques for robot manipulators are been few works concerning experimental comparison
particularly attractive to determine the dynamic para- between the use of various regression models. Among
meters of robot manipulators when there exists difficulty the exceptions, Shirkey5 has performed experimental
to measure them directly. The usefulness of the dynamic identification tests with the filtered dynamic model and
parameters arises in implementation of advanced the supplied energy model on a two degrees of freedom
model-based controllers for robot manipulators. The direct drive arm. The conclusion of that work is that the
precision, performance, and robustness of these schemes filtered dynamic model is superior to the supplied energy
depend on the accuracy of the dynamic model model. Two more exceptions of our special interest that
parameters. are worth mentioning here are.3,4 The first one presented
A landmark in robot identification has been the a comparison between filtered dynamic and supplied
recognition that combinations of inertial parameters energy model on a direct driven two link robot. It was
appear linearly in the dynamic equations of robots remarked that the filtered dynamic model has advantages
manipulators.1,2 The early identification work exploiting with respect to the supplied energy model. Recently,
this property of robot dynamics required joint accelera- Kozlowski and Dutkiewicz4 presented experimental
tion into the regression model. This approach led to so identification using both regression models on a
called the dynamic regression model also known as the non-direct drive robot. They focus their attention on
differential regression model.3–5 The first approach optimal trajectory design for both models. Their
relaxing joint acceleration data was proposed by Hsu et conclusion is also that the filtered dynamic model has
al.6 by introducing the filtered dynamic regression model. advantage in comparison the supplied energy model.
Since that time, a number of identification approaches The goal of this paper is to present an experimental
has been suggested in the literaturer;1,2,6–11 (for an comparison of three identification schemes. These
interesting review see Lu et al.11) schemes belong to the hybrid identification philosophy,8
i.e. estimation is performed by a recursive estimator
* Work partially supported by CONACYT, Mexico. while the regression model is formulated in continuous

Downloaded from https://www.cambridge.org/core. Pan African Lawyers Union, on 26 Feb 2018 at 19:13:58, subject to the Cambridge Core terms of use, available at
https://www.cambridge.org/core/terms. https://www.cambridge.org/core/product/8956F69BD9DF40117A1A90E98CFEAB10
564 Direct driy e robot

time. The identification schemes use a common underling 3 LINEARITY IN THE PARAMETERS OF THE
recursive estimator: the standard least-squares method, ROBOT TOTAL ENERGY AND DYNAMICS
and three different regression models: filtered dynamic The purpose of this Section is to recall the property of
model, supplied energy model, and filtered power model. linearity of the total energy of robot manipulators and
These regression models take into account the friction that of the robot dynamics, both in terms of the dynamic
torques which are assumed to be described by Coulomb parameters.
and viscous friction models.13 Ù ) of robot manipulators is given
The total energy % (q , q
The estimated parameters obtained from these by the sum of the kinetic energy _ (q , q Ù ) plus the
identification schemes were compared with the actual potential energy 8 (q ):
parameters of the robot manipulator obtained by direct
physical measuring of masses, inertia and center of Ù ) 5 _ (q , q
%(q , q Ù ) 1 8(q ). (5)
masses, as well as data provided by the actuator
manufacturer. Because sensors accuracy, the measured The kinetic and potential energy can be written as a
parameters may not be exact, but they can be considered linear function of the dynamics parameters:12
as the best approximation of the real dynamic
parameters. We have also compared open loop responses Ù ) 5 f _ (q , q
_ (q , q Ù )T u_ (6)
of the actual robot with simulations using the robot 8(q ) 5 f 8(q ) u8 T
(7)
model incorporating the identified parameters.
The organization of this paper is as follows: In Section where f _ and f 8 are p 1 3 1 and p 2 3 1 vector functions,
2 we recall the robot dynamics. In Section 3 we review u_ and u8 stand for p 1 3 1 and p 2 3 1 vectors which
the energy model and useful properties. Section 4 contain the dynamic parameters of the manipulator such
presents the identification procedure. The filtered as masses and inertia.
dynamic and supplied energy models are present, then Therefore, the total energy (5) can be written as a
the filtered power model is derived in this section. The linear regression in terms of the dynamic parameters:12
experimental implementation is described in Section 5.
The experimental results and discussions are presented in Ù ) 5 f %(q , q
% (q , q Ù )T u% (8)
Section 6. Finally, we give brief conclusions in Section 7.
Ù )T 5 [f _ (q , q
where f %(q , q Ù )T f 8(q )T ] and

2 ROBOT DYNAMICS u% 5 [uT_ uT8]T. (9)


The dynamics of a serial n -link rigid robot can be written
as:14 The linear parametrization of the total energy leads to
the well known property of linearity in terms of the
Ù )q
M (q )q¨ 1 C (q , q Ù 1 g (q ) 1 f (q
Ù)5t (1) dynamic parameters for the robot dynamics. For the sake
of completeness, let us derive this property.
where q is the n 3 1 vector of joint displacements, q Ù is By using equations (6) and (7), we have that the
the n 3 1 vector of joint velocities, t is the n 3 1 vector of Ù ) of the robot can be expressed in the
Lagrangian + (q , q
applied torques, M (q ) is the n 3 n symmetric positive form:
definite manipulator inertia matrix, C (q , q Ù ) is the n 3 n
matrix of centripetal and Coriolis torques, and g (q ) is the Ù ) 5 f + (q , q
+ (q , q Ù )T u%
n 3 1 vector of gravitational torques obtained as the where
gradient of the robot potential energy 8 (q ) , i.e. Ù )T 5 [f _ (q , q
f + (q , q Ù )T 2 f 8(q )T ]. (10)

­8(q ) This yields


g (q ) 5 , (2)
­q

and the n 3 1 vector f (q Ù ) stands for the friction torques. Ù


­q
5
­qÙ
Ù)
­+ ­f + (q , q
u% ,
d ­+
Ù
dt ­q
5
dt ­q
F G F
Ù
Ù)
d ­f + (q , q
u% , G
The friction torque f (q Ù ) is decentralized in the sense that
Ù ) depends only on q
fi (q ~i Ù)
­+ ­f + (q , q
5 u% .
~ 1)

3 4
f1(q ­q ­q
f2(q ~ 2)
Ù )5
f (q . (3)
???
By considering as the generalized nonconservative
forces those owing to the applied torques / forces t and
fn (q ~ n) Ù ) , from the Lagrange’s equation of
the friction forces f (q
In this paper we consider the common Coulomb and motion we obtain
viscous friction models;13 that is

~ i ) 5 [bi q
fi (q ~ i 1 fci sgn (q
~ i )] (4) Fdtd F­f ­(qÙq, qÙ )G 2 ­f ­(qq, qÙ )Gu 5 t 2 f (qÙ ).
+ +
% (11)

where bi and fci represent coefficients of viscous and Due to the fact that the friction force present in the
Coulomb friction for i -th joint respectively. robot is assumed be Coulomb and viscous friction, then it

Downloaded from https://www.cambridge.org/core. Pan African Lawyers Union, on 26 Feb 2018 at 19:13:58, subject to the Cambridge Core terms of use, available at
https://www.cambridge.org/core/terms. https://www.cambridge.org/core/product/8956F69BD9DF40117A1A90E98CFEAB10
Direct driy e robot 565

is linear with respect to the coefficients of Coulomb and is obtained by minimizing cost function (17), which we
viscous friction, this is: denote as u
ˆ (k ) satisfying the following equation:

F O  (i)y(i)G
k
Ù ) 5 f ^ (q
f (q Ù )u^ (12) ˆ (k ) 5 P (k ) P (0)21uˆ (0) 1
u (18)
where f ^ is an n 3 2n matrix function and u^ stands i 51

F 1 O  (i ) (i ) G
k 21
2n 3 1 vector, which contains the Coulomb and viscous P (k ) 5 P (0)21 T
(19)
friction coefficients. Therefore the equation (11) can be i 51
written as: where P (k ) is n 3 n matrix called covariance matrix.

FFdtd F­f ­(qÙq, qÙ )G 2 ­f ­(qq, qÙ )G


+ +
G
Ù ) u 5 t (13)
f ^ (q
The recursive version of the least-squares method is
given by the well known equations:15,16
CBBBBBBDBBBBBB E u
ˆ (k ) 5 uˆ (k 2 1) 1 P (k 2 1) (k )
Ù , q¨ )
Y (q , q

where 3 [I 1  (k )TP (k 2 1) (k )]21e (k ) (20)


u 5 [uT% uT^]T (14) P (k ) 5 P (k 2 1) 2 P (k 2 1) (k )
denotes the vector of the dynamic and friction 3 [I 1  (k )TP (k 2 1) (k )]21 (k )TP (k 2 1) (21)
parameters. where the prediction error e (k ) is defined as:
Finally, from the robot dynamics (1) and (13) we get e (k ) 5 y (k ) 2  (k )Tuˆ (k 2 1). (22)
the well established fundamental property of the robot
dynamics of being linear in the dynamic parameters,1,2 4.2 Filtered dynamic regression model
i.e. The robot dynamic model (15), which finally serves for
Ù )q
M (q )q¨ 1 C (q , q Ù 1 g (q ) 1 f (q
Ù ) 5 Y (q , q
Ù , q¨ )u 5 t (15) robot control, relates the torques applied on the joints to
the regressor matrix Y (q , q Ù , q¨ ) and the vector of
Ù , q¨ ) is an n 3 p matrix of known functions, u
where Y (q , q unknown dynamic parameters u. This leads to the
is p 3 1 vector containing the robot and friction dynamic regression model also so-called the differential
parameters, and p 5 p 1 1 p2 1 2n. regression model:3–5
Ù , q¨ )u.
t 5 Y (q , q (23)
4 PARAMETER IDENTIFICATION
In this Section we describe three identification schemes. Notice that to compute the elements of Y (q , q Ù , q¨ ) , one
Each scheme arises from a common recursive estimator, needs the measurement of joint acceleration q ¨ . To
in this case the least squares method, and the overcome this shortcoming the filtered dynamic regres-
corresponding regression model. Before we introduce the sion model has been proposed in the literature.6,9–11
regression models, we outline the standard least-squares The key idea is to filter both sides of the robot
algorithm. dynamics (23) by a stable strictly proper filter. Without
lost of generality, the simple first order filter has been
considered in most previous works.6,9–11. Let us denote
4.1 Least-squares algorithm
l
The least-squares method is a basic technique for this filter by its transfer function f (s ) 5 , where
parameter estimation. The method is particularly simple s1l
if the model has the property of being linear in the l . 0 and s stands for the differential operator.
parameters. Let us consider the following regression Therefore, the filtered dynamic regression model can be
model written as
y (k ) 5  (k )T u (16) tf 5 Yf (q , q Ù )u
where
where y (k ) represents an n 3 1 output vector,  (k ) tf 5 f (s )t
stands for the p 3 n regressor matrix of known functions, Ù ) 5 f (s )Y (q , q
Yf (q , q Ù , q¨ ).
and u is the p 3 1 vector of unknown parameters. The
Thanks to the introduction of the filters, the
model is indexed by the variable k , which denotes the
requirement of joint acceleration q ¨ into the regressor
sampling time. It will be assumed that the index set is a
discrete set. Ù ) has been obviated.
Yf (q , q
With above notation, and with reference to the
The unknown parameters u can be estimated by
recursive least-squares method, the prediction error
minimizing the following cost function:15,16
corresponding to the filtered dynamic regression model
Jk (u) 5
1 k
O
2 i51
[ y (i ) 2  (i )T u]T [ y (i ) 2  (i )T u]
takes the form
Ù )(k ) uˆ (k 2 1).
e (k ) 5 tf (k ) 2 Yf (q , q (24)
1 CDE CBDBE
1 [u 2 uˆ (0)]TP (0)21[u 2 uˆ (0)] (17) y (k )  (k )T
2
where P (0) 5 P (0)T . 0 and uˆ (0) denotes the initial 4.3 Supplied energy regression model
estimate. In this subsection we recall the derivation of the supplied
The value estimated of vector u based on the energy regression model introduced by Gautier and
observations of the vector y (k ) and of the regressor  (k ) Khalil.12

Downloaded from https://www.cambridge.org/core. Pan African Lawyers Union, on 26 Feb 2018 at 19:13:58, subject to the Cambridge Core terms of use, available at
https://www.cambridge.org/core/terms. https://www.cambridge.org/core/product/8956F69BD9DF40117A1A90E98CFEAB10
566 Direct driy e robot

The principle of conservation of energy states that the which is linear in the dynamic and friction parameters
work of the forces applied to a system and which are not and it depends on q and q Ù but not on the joint
derived of potential is equal to the change of the total acceleration q
¨ . The left hand side of (29) is the regression
energy of the system, i.e., model output; this is the filtering of the power tTq Ù.
Let the scalar prediction error of the filtered power
E t(s ) qÙ (s )ds
t
T
Ù (t ))2%(q (0) , q
5 %(q (t ) , q Ù (0)) regression model be defined as:
0 CBBBBDBBBBE
CBBDBB E Energy stored at the instant t l
Energy supplied at the instant t
e (k ) 5 Ù )(k )
(tTq
s1l
E qÙ (s ) f (qÙ (s ))ds CBDBE
t
1 T
(25) y (k )

Fs 1lsl f (q, qÙ ) (k), s 1l l qÙ f (qÙ )(k)Guˆ (k 2 1).


0
CBBDBBE
Energy dissipated at the instant t 2 %
T T
^

Without loss of generality, we suppose that total CBBBBBBDBBBBBBE T


 (k )
energy at the instant zero is null, that is (30)
Ù (0)) 5 0.
% (q (0) , q (26)
5 EXPERIMENTAL IMPLEMENTATION
From principle of conservation of energy and by using We have designed and built at CICESE Research Center
the equations (8) and (12), then we obtain the supplied a direct drive vertical robot manipulator with two
energy regression model:12 degrees of freedom moving in the vertical plane (see
Figure 1). It consists of two links made of 6061 aluminum
E t(s ) qÙ (s )ds
t
T both actuated by brushless direct drive servo actuator to
0 drive the joints without gear reduction. Advantages of

5 Ff (q (t ) , q
Ù (t )) E q Ù (s ))ds Gu ,
t this type of direct-drive actuator includes freedom from
% Ù (s ) f (q
T T
^ (27) backslash and significantly lower joint friction compared
0 to actuators with gear drives.17 The motors used in the
which is linear in the dynamic and friction parameters robot manipulator are the DM1200-A and DM1015-B
and the regressor depends on q and q Ù . It does not require models from Parker Compumotor for the shoulder and
the measurement of joint acceleration q ¨. elbow joints respectively. The servos are operated in
Therefore, the prediction error of the supplied energy torque mode, so the motors act as torque source and
regression model for its use in the recursive least-squares they accept an analog voltage as a reference of torque
algorithm is defined as: signal. In this configuration the motor DM1200-A is
capable to deliver 200 Nm torque output and the motor

E DM1015-B only 15 Nm.


kh
e (k ) 5 Ù (s )ds
t(s )Tq Position information is obtained from incremental
0
CBBDBB E encoders located on the motors which have a resolution
y (k )
of 1024000 p / rev for the first motor and 655360 p / rev for
FBBBBBBDBBBBBB
E qÙ (s ) f (qÙ (s ))dEs Guˆ (k 2 1)
kh
the second one. The accuracy for both motors is 30
Ù )T (k )
2 f %(q , q T
^ (28)
arc-seconds.
C 0
 (k )T

where h denotes the sampling period.


It is worth noting that this prediction error is a scalar
function while in the filtered dynamic model it was a
vector function.

4.4 Filtered power regression model


Now, we are in position to formulate a new regression
model. The idea is to filter both sides of the supplied
energy model (27) via a stable strictly proper filter.
Without lost of generality, let us consider again the first
order filter whose transfer function is given by
f (s ) 5 l / (s 1 l ) where l . 0.
By applying the filter to both sides of (27) we obtain
the following model, which is called here the filtered
power regression model:

l
s1l
Ù (t ) 5
tT (t )q
ls
s1l
F Ù (t ))T ,
f %(q (t ) , q
l
s1l
Ù Tf ^ (q
q Ù ) u. G
(29) Fig. 1. Experimental robot manipulator.

Downloaded from https://www.cambridge.org/core. Pan African Lawyers Union, on 26 Feb 2018 at 19:13:58, subject to the Cambridge Core terms of use, available at
https://www.cambridge.org/core/terms. https://www.cambridge.org/core/product/8956F69BD9DF40117A1A90E98CFEAB10
Direct driy e robot 567

A motion control board based on a TMS320C31 32-bit u are related by


floating point microprocessor from Texas Instruments, is u% 5 [θ 1 θ 2 θ 3 θ 4 θ 5]T ,
used to execute the control algorithm. This board is
mounted in a PC 486DX2 host computer which contains u^ 5 [θ 6 θ 7 θ 8 θ 9]T ,
a software environment that has been developed to give u 5 [uT% uT^]T.
an user-friendly interface and easy control over In a first stage, the values of robot parameters shown
experiment set-up, execution, data recording, graphics, in Table I were obtained by direct physically measuring.
display and home return.18 We disassembly the robot manipulator in order to
In the particular case of our experimental arm the measure its parameters. The mass of each component
entries of the robot dynamics are given was determined with a beam balance, while rotor masses
were provided from manufacturer;19 the center gravity of
M (q ) 5 Fθθ 112θθ coscos((qq)) θ 1 θ θcos (q )G ,
1

3
2

2
2

2
3 2

3
2
each link was located orthogonal to rotation axis by
balancing each link. The moments of inertia of each joint

Ù)5F G,
22θ sin (q )q ~ 2θ sin (q )q~ motors were provided from manufacturer19 and moments
2 2 2 2 2 2
C (q , q of inertia of link were measured by timing oscillations
θ sin (q )q
2 ~ 0 2 1
about an axis perpendicular to the plane in which the
g (q ) 5 F G,
θ sin (q ) 1 θ sin (q 1 q )
4 1 5 1 2 robot operates and using the equation of motion for a
θ sin (q 1 q ) 5 1 2
physical pendulum. Moments of inertia for the composite
links (link, servo rotor, bolts, etc.) were determined by
Ù )5F G
θ q
~ 1 θ sgn (q
6 1 ~ ) 8 1 summing the inertia of the components about the servo
f (q
θ q~ 1 θ sgn (q
7 2 ~ ) 9 2 axis and applying the parallel axis theorem. The friction
coefficients were measured by using a proportional
where the dynamic and friction parameters are given by controller of velocity.
An important constituent of identification schemes
θ 1 5 m 1 l 2c1 1 m 2 l 21 1 m 2 l 2c2 1 I1 1 I2 that requires a more careful and systematic investigation
θ 2 5 l1 m 2 lc 2 is the choice of a class of input trajectories for exciting
the robot. The selection of trajectories must be such that
θ 3 5 m 2 l 2c2 1 I2 it allows complete identification of the system. This class
θ 4 5 g (lc 1 m 1 1 m 2 l1) of trajectories is known as a persistently exciting
trajectory.16 Furthermore, the trajectory must foresee the
θ 5 5 gm 2 lc 2 actuators from torque saturating and velocity overflow.
θ 6 5 b1 Choosing a persistently exciting trajectory is sufficiently
complex and has not been addressed in this work.20
θ 7 5 b2 During the preliminary experiments, we have tested
θ 8 5 fc1 several torque trajectories being linear of sinusoidal
functions that contain superposition of four different
θ 9 5 fc2 . frequencies to excite the system. The best result of
parameter identification were obtained by using the
The parameters θ i , i 5 1 ? ? ? 9 can be interpreted as a following trajectories
combinations of some physical properties of the links τ 1 5 (1 2 e 20.8t)29.0 1 68 sin (16t 1 0.1)
which are time-invariant. The individual robot para-
1 9 sin (20t 1 0.15) [Nm], (31)
meters are defined in Table I.
With reference to the parametrization of the kinetic τ 2 5 (1 2 e 21.8t)1.2 1 8 sin (26t 1 0.08)
and potential energies, the vector of dynamic parameters 1 2 sin (12t 1 0 .34) [Nm]. (32)

Table I. Parameter values.


Parameter Notation Value Unit
Length link 1 l1 0.45 m
Mass link 1 m1 23.902 Kg
Mass link 2 m2 3.880 Kg
Link (1) center of mass lc1 0.091 m
Link (2) center of mass lc2 0.048 m
Inertia link 1 I1 1.266 Kg m2
Inertia link 2 I2 0.093 Kg m2
Viscous coefficient 1 b1 2.288 Nm-sec
Viscous coefflcient 2 b2 0.175 Nm-sec
Coulomb coefficient 1 fc 1 ~ 1 . 0 and 8.049 if q
7 .17 and if q ~1,0 Nm
Coulomb coefficient 2 fc 2 1.734 Nm
Gravity acceleration g 9.81 m / sec2

Downloaded from https://www.cambridge.org/core. Pan African Lawyers Union, on 26 Feb 2018 at 19:13:58, subject to the Cambridge Core terms of use, available at
https://www.cambridge.org/core/terms. https://www.cambridge.org/core/product/8956F69BD9DF40117A1A90E98CFEAB10
568 Direct driy e robot

All identification schemes as well as the torque input Since joint torques, positions, and velocities are hold
trajectory were written in C language; the sampling constant between sampling instant, the filters f (s ) 5
period h used in all the experiments was h 5 2 .5 msec. l ls
and f (s ) 5 can be implemented in form
The joint velocity was computed through a standard s1l s1l
backwards difference algorithm applied to the position (1 2 e 2hl)z 21 (1 2 z 21)l
discrete as f (z 21) 5 and f (z 21
) 5
measurement. In the experiments the arm started at rest 1 2 e 2hlz 21 1 2 e 2hlz 21
respectively.
from its vertical position downward. This produces the
following initial conditions: q 1(0) 5 q 2(0) 5 0 , and 5.2 Supplied energy model
~ 1(0) 5 q
q ~ 2(0) 5 0. The prediction error of the supplied energy regression
In order to validate the values of the robot parameters model is given by equation (28). In its adaptation to our
obtained by direct measurement given in Table I, we direct-drive robot, the regressor takes the form
have performed simulations and experiments on the
F E G
kh
actual robot arm using the torque inputs (31) – (32). ~ )T
f% (q , q ~ (s )Tf ^ (q
q ~ (s ))ds
Figure 2 shows the joint positions obtained in both cases. 0

Notice that the results from simulation, which uses the 5 F 1



2 ~ 21 cos (q2)q
q ~ 1(q
~11q
~ 2) q
~ 2(q
~ 1 1 1–2 q
~ 2) 1 2 cos (q 1)
values of the robot parameters given in Table I, have a
E E E E G
kh kh kh kh

good matching with the experimental ones. This allows 1 2 cos (q1 1 q2) ~ 21 ds
q ~ 22ds
q ~ 1u ds
uq ~ 2u ds
uq .
0 0 0 0
the conclusion that parameters given in Table I produces
The integrals of regressor matrix have been imple-
a model of the real robot reflecting with good precision
mented with a standard trapezoid-type integration rule.
its dynamic behavior.
5.3 Filtered power model
5.1 Filtered dynamic model The prediction error of the filtered power regression
The prediction error for the filtered regression model is model was defined in (30). The regressor becomes in this
described by (24). For our arm, the regressor is given by case

Fs 1lsl f (q, q~ ) s 1l l qÙ f (q~ )(k)G


C
ls ls
~1
q cos (q 2)(2q~11q ~ 2) T T
s 1l s 1l % ^
ls

3 4 5F ~ Sq
~ 1 D
~)5
Yf (q , q ~11
cos (q 2)q ls q~ ls 2
ls ~
q
s 1l 1
cos (q )q~ (q
~ 1q ~ ) q
2
0 2 1 1 2 2 1
l s1l 2 s1l s1l 2
~11q
sin (q 2)(q ~ 2)q~1
s 1l ls ls
[1 2 cos (q 1)] [1 2 cos (q 1 1 q 2)]
ls l l s1l s1l
~2 sin (q 1 1 q 2)
G
q sin (q 1)
s 1l s 1l s 1l l l l l
ls l ~ 21
q ~ 22
q ~ 1u
uq ~ 2u .
uq
~11q
(q ~ 2) 0 sin (q 1 1 q 2) s1l s1l s1l s1l
s 1l s 1l

D
The filters f (s ) 5 l / (s 1 l ) invoked in the regressor
l l have been implemented in a recursive manner in the
~1
q 0 ~ 1)
sgn (q 0 same way that those of the filtered dynamic model.
s 1l s 1l
l l .
0 ~2
q 0 ~ 2)
sgn (q 6 EXPERIMENTAL RESULTS
s 1l s 1l
In this Section we describe the experimental results
obtained from the three identification schemes. For the
three cases, the recursive least-squares algorithm
(20) – (21) was employed with the following initial
conditions: the covariance matrix P (0) 5
diag (1000, 1000, 1000, 1000, 1000, 1000, 1000, 1000, 1000)
and the initial vector of estimated parameters u ˆ (0) 5 0 .
The bandwidth l of the filters used in the regressors
must be chosen such that it reject the high-frequency
components resulting from noise while allowing the
low-frequency components generated by the torque input
command. The highest frequency in the command
trajectory was of v 5 26 rad / s. Therefore we have chosen
l 5 50 Hz.

6.1 Filtered dynamic model


Figure 3 shows the experimental profiles for the
estimation vector uˆ (k ) obtained with the filtered dynamic
regression model. We observe the convergence in all
parameter estimates. Their values at t 5 10 sec. are
Fig. 2. Simulated and experimental open-loop responses. summarized in Table II. The accuracy in the estimated

Downloaded from https://www.cambridge.org/core. Pan African Lawyers Union, on 26 Feb 2018 at 19:13:58, subject to the Cambridge Core terms of use, available at
https://www.cambridge.org/core/terms. https://www.cambridge.org/core/product/8956F69BD9DF40117A1A90E98CFEAB10
Direct driy e robot 569

simulation with these estimated parameters follow the


shape of the experimental responses obtained on the
actual robot.

6.2 Supplied energy model


Figure 5 depicts the evolution in time of the vector of
estimated parameters by using the supplied energy
regression model. The value of the estimated parameter
are listed in Table II. For this identification scheme we
remark that five of the nine parameters do not converge
adequately, rather diverging and furthermore they are
found in small oscillations. This is the case of the
components θˆ 5(k ) 2 θˆ 9(k ). This phenomenon can be
attributed to the following: The supplied energy
approach employs integrators in some components of the
regressor; they have infinite-gain at zero frequency and
they amplify low frequency noise. This is particularly
true for the entries of the regressor corresponding to
Coulomb coefficients. Hence, these components of the
regressor keep large values owing to the low-frequency
of sgn (qÙ ) leading offsets and drifts.11 This drawback of
the supplied energy regression model is overcome with
the filtered power regression model which instead of
integrators involves low-pass filters with unit gain at zero
frequency.

Fig. 3. Estimated vector uˆ of the filtered dynamic model.

dynamic parameters (excluding friction parameters) is


found between 82% and 97% with respect to the
parameters obtained by direct physically measuring.
However the estimated friction coefficients have a larger
deviation.
Despite the deviation of the estimated values with
respect to those computed from direct measurement, the
open-loop responses depicted in Figure 4 illustrate that

Fig. 4. Simulated and experimental responses; case filtered


dynamic model. Fig. 5. Estimated vector uˆ of the supplied energy model.

Downloaded from https://www.cambridge.org/core. Pan African Lawyers Union, on 26 Feb 2018 at 19:13:58, subject to the Cambridge Core terms of use, available at
https://www.cambridge.org/core/terms. https://www.cambridge.org/core/product/8956F69BD9DF40117A1A90E98CFEAB10
570 Direct driy e robot

Table II.

Measured Supplied Filtered Filtered Unit


Energy Power Dynamic

θ1 2.351 2.14 1.99 1.98 Nm-sec2


θ2 0.084 0.088 0.084 0.087 Nm
θ3 0.102 0.087 0.084 0.084 Nm-sec2
θ4 38.465 39.04 36.20 38.48 Nm
θ5 1.825 — 2.01 1.99 Nm
θ6 2.288 — 2.35 2.11 Nm-sec
θ7 0.175 — 0.192 0.120 Nm-sec
θ8 7.60 — 4.95 6.20 Nm
θ9 1.734 — 1.01 1.18 Nm

Because the lack of convergence of some of the estimated parameters are summary in the Table II. The
estimated parameters, we have not performed any deviation of these parameters (excluding the friction
open-loop simulation with the estimated parameters. parameters) with respect to the nominal ones obtained
via direct measurement is in between 82 – 94%. However
6.3 Filtered power model the estimated Coulomb coefficients have a larger
Figure 6 shows the vector of estimated parameter uˆ (k ) deviation.
plotted versus time using the filtered power regression Figure 7 shows a comparison between the real joint
model. In contrast with the supplied energy model, in positions and the simulated joint positions with the
this identification scheme the oscillations in the identified parameters obtained with the identification
components θˆ 5(k ) 2 θˆ 9(k ) of the estimated vector are scheme using the filtered power regression model. In this
reduced significantly and in spite of excessive excursions case the results show good features, however it does not
of some estimated parameters after the initial transient, improve the results obtained with the filtered dynamic
we can observe that there exists parameter convergence model. This may be attributed to the fact that the latter
for all the components of parameter vector. The value of involves a vector prediction error being more rich in
information.4

6.4 Discussion
The experimental results allow the conclusion that the
identification schemes based on the filtered dynamic and
filtered power models are clearly superior to the one
based on the supplied energy model. Notwithstanding, in
case of knowledge of the Coulomb coefficients and their
use for friction compensation, the supplied energy model
should have similar performances that the filtered power
model.
The identification scheme based on the filtered
dynamic regressor model has a vector prediction error.

Fig. 7. Simulated and experimental responses; case filtered


Fig. 6. Estimated vector uˆ of the filtered power model. power model.

Downloaded from https://www.cambridge.org/core. Pan African Lawyers Union, on 26 Feb 2018 at 19:13:58, subject to the Cambridge Core terms of use, available at
https://www.cambridge.org/core/terms. https://www.cambridge.org/core/product/8956F69BD9DF40117A1A90E98CFEAB10
Direct driy e robot 571

Therefore it is more complex to implement and it REFERENCES


consumes more calculation time, while the identification 1. P. Khosla and T. Kanade, ‘‘Parameter identification of
schemes based on the supplied energy and filtered power robot dynamics’’ Proceedings of 24th Conference on
regressor models is made up with one scalar prediction Decision and Control , Ft. Lauderdale Fl, (1985) pp.
1754 – 1760.
error which saves a lot of computational effort by 2. C.G. Atkeson, C.H. An and J.M. Hollerbach, ‘‘Estimation
avoiding the need of calculating more data. of inertial parameters of manipulator loads and links’’ Int.
The experimental results indicate deviations of the J. Robotics Research 5, No. 3, 101 – 118, (1986).
estimated parameters with respect to the nominal ones. 3. M. Pru¨ fer, C. Schmidt and F. Wahl, ‘‘Identification of robot
Possible explanations are the following. dynamics with differential and integral models: a
comparison’’ Proceedings IEEE International Conference
Ù used in the regressors has not been
$ The joint velocity q on Robotics and Automation , San Diego, California (1994)
directly measured by any sensor but it has been Vol. 1, pp. 340 – 345.
computed via numerical differentiation of joint 4. K.R. Kozlowski and P. Dutkiewicz, ‘‘Experimental
position q. This fact introduces an approximation for identification of robot and load dynamics’’ 13th IFAC
the velocity value which causes deviation of the World Congress , San Francisco, USA, (1996) Preprints
Vol. A, pp. 397 – 402.
estimated parameters. 5. P.R. Shirkey, ‘‘A testbed for intelligent control’’ Thesis of
$ In our experimental robot, the Coulomb coefficient for Master of Science (University of Illinois at Urbana-
the first joint is not constant. It takes two different Champaign, 1996).
values of depending from the sense of motion. 6. P. Hsu, M. Bodson, S. Sastry and B. Paden, ‘‘Adaptive
Therefore the corresponding component of the vector identification and control for manipulators without using
joint accelerations’’ Proceedings of IEEE International
of estimated parameters do not converge to none of its Conference on Robotics and Automation , Raleigh, C.N.,
real values. This also will have influence on the (1987) pp. 1210 – 1215.
convergence of the other components. This is may be 7. B. Armstrong, O. Khatib and J. Burdick, ‘‘The explicit
the main reason why the estimated Coulomb dynamic model and inertial parameters of the PUMA 560
coefficients obtained from all the identification arm’’ Proceedings of the IEEE International Conference on
Robotics and Automation , (1986). pp. 510 – 518.
schemes differ notably from the nominal values. 8. C. Canudas and A. Aubin, ‘‘Parameters identification of
robot manipulators via sequential hybrid estimation
algorithms’’ Proc. IFAC ’90 Congress , Tallin, (1990) pp.
178 – 183.
7 CONCLUSION 9. W. Khalil and P.P. Restrepo, ‘‘An efficient algorithm for
In this paper we have presented the experimental the calculation of the filtered dynamic model of robots’’
evaluation of three identification schemes to determine Proc. of IEEE International Conf. on Robotics and
Automation , Minneapolis, MN (1996) pp. 323 – 328.
the dynamic parameters for a two degrees of freedom 10. J.J.E. Slotine and W. Li, ‘‘Adaptive robot control: a new
direct-drive robot. perspective’’ Proceedings of the 26th Conference on
The identification schemes are composed by an Decision and Control , Los Angeles, CA, (1987) pp.
underling standard recursive least-squares algorithm with 192 – 198.
three regression models. The considered schemes are 11. Z. Lu, K.B. Shimoga and A.A. Goldenberg, ‘‘Experimental
determination of dynamic parameters of robotic arms’’ J.
based on the following regression models: filtered Robotic Systems 10(8), 1009 – 1029 (1993).
dynamic, supplied energy and filtered power models. 12. M. Gautier and W. Khalil, ‘‘On the identification of the
The filtered dynamic model scheme presents the best inertial parameters of robot’’ Proceedings of the 27th
results in the estimated parameters, however, it is the Conference on Decision and Control , Austin, Texas (1988)
more complex to implement. On the other hand, the pp. 2264 – 2269.
13. C. Canudas, P. Noel, A. Aubin and B. Brogliato,
supplied energy and filtered power models reduce the ‘‘Adaptive friction compensation in robot manipulators:
computational burden and therefore they are more low velocities’’ Int. J. Robotics Research 10 , No. 3, 189 – 199
suitable for real-time implementation. (1991).
In case of absence of friction or friction compensation, 14. M.W. Spong and M. Vidyasagar, Robot Dynamics and
the supplied energy and filtered power models may Control (John Wiley and Sons, NY., 1989).
15. K.J. Åstro¨ m and B. Wittenmark, Adaptiy e Control
perform in a similar way; however, if Coulomb friction is (Addison-Wesley, Reading, MA, 1989).
present, the filtered power model offers advantage over 16. G.C. Goodwin and K.S. Sin, Adaptiy e Filtering Prediction
the approach based on the supplied energy model. and Control (Prentice-Hall, NY, 1984).
Besides the exact knowledge of the structure of the 17. C.H. An, C.G. Atkeson and J.M. Hollerbach, Model Based
robot dynamics and the suitable choice of the torque Control of a Robot Manipulator (The MIT Press,
Cambridge, Mass., 1989).
input signal, for good robot identification we believe that 18. F. Reyes and R. Kelly, ‘‘A direct-drive robot for control
accurate joint velocity information plays an important research’’ Proceedings of the IASTED International
role on the final results. Conference , Applications of Control and Robotics ,
Orlando, Fl. USA (1996) pp. 181 – 184.
19. Yokogawa, Direct driy e sery o actuator -general specification
(GS A101-E ) (Yokogawa Electric Corp., Tokyo, Japan,
ACKNOWLEDGMENTS 1988).
20. B. Armstrong, ‘‘On finding exciting trajectories for
The authors would like to thank Marc Feyh from Parker identification experiments involving systems with nonlinear
Compumotor for providing us with useful information on dynamics’’ Proc. of IEEE International Conf. on Robotics

Downloaded from https://www.cambridge.org/core. Pan African Lawyers Union, on 26 Feb 2018 at 19:13:58, subject to the Cambridge Core terms of use, available at
https://www.cambridge.org/core/terms. https://www.cambridge.org/core/product/8956F69BD9DF40117A1A90E98CFEAB10

Anda mungkin juga menyukai