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
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 Ff (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.
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 )
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
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
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)
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
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
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.
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
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.
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.
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
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