You are on page 1of 6

NONLINEAR FRICTION PHENOMENA IN

DIRECT-DRIVE ROBOTIC ARMS: AN


EXPERIMENTAL SET-UP FOR RAPID
MODELLING AND CONTROL PROTOTYPING

Basilio Bona ∗ Marina Indri ∗ Nicola Smaldone ∗


Dipartimento di Automatica e Informatica
Politecnico di Torino
Torino, Italy

Abstract: This paper considers the design and the experimental validation of
digital control algorithms when both low and high velocity precision issues are
important for the quality of the controlled equipment. At low velocities friction
phenomena are dominant, while at high velocities the nonlinear coupled and
configuration-dependent dynamics plays a major role. Since rapid control proto-
typing (RCP) requires “finely-tuned” models of the equipment under investigation,
an accurate definition of the nonlinear friction model is of capital importance for
assessing the qualification of the proposed algorithms. An experimental validation
of the proposed models and control algorithms with friction compensation is
presented and discussed for a two-arms planar manipulator with brushless direct-
drive actuators.

Keywords: Rapid control prototyping, robot modelling and control, CACSD.

1. INTRODUCTION environment, where different controller blocks are


available, with structure and parameters easily
Rapid control prototyping (RCP) is becoming modifiable to be tested on the simulated plant and
one of the major issues in control design for downloaded on the target hardware platform for
advanced mechatronic equipments (Hanselmann, real-time validation.
1996; Bona et al., 2001). Fast prototyping of dig- A “finely-tuned” model of the physical phenom-
ital control algorithms requires integrated hard- ena to be controlled is of capital importance to
ware/software architectures, allowing fast and allow the simulation of control algorithms prior to
systematic interactions between the algorithmic their experimentation on the real plant. The mod-
design phase and the experimental testing. The els developed for simulation, after suitable sim-
design phase is performed with the support of a plifications, can be used also in nonlinear model-
computer aided control system design (CACSD) based control algorithms.
environment, where simulations are performed on
accurate models of the specific equipment under Among the principal phenomena to be modelled
investigation; after that, a rapid transfer of the in motion control, low velocity friction plays a
algorithm on the target hardware is necessary to major role, as it can lead to considerable track-
experimentally validate the proposed algorithm. ing errors, stick-and-slip motion and limit cycles
This process may be iterated several times until (Dupont, 1990; Armstrong-Hélouvry, 1991; Bona
a satisfactory behaviour is reached. It is there- and Indri, 1995; de Wit et al., 1995). Its nonlinear
fore necessary to have a PC-based prototyping nature makes the application of simple PID con-
trol laws questionable, especially when the same The arms are driven by a couple of brushless NSK
control law must cope both with low velocity stic- Megatorque direct drives. Two control modes
tion torques and high velocity dynamic coupling are available, the Torque Mode and the Velocity
torques between arms (de Wit et al., 1991; Bona Mode: on the basis of the resolver signals, a cur-
and Indri, 1995; Hirschorn and Miller, 1999; Kim rent loop is closed to regulate the torque in the
and Lewis, 2000; Armstrong et al., 2001; Ray et first case, whereas a further velocity loop is added
al., 2001). in the second mode. The basic mode is the Torque
mode, and it will be the only one used in this work
This paper presents a RCP experimental setup
to control the manipulator. The inner current loop
for a two-dof planar manipulator, having signifi-
referred above is fixed, and the actuators model
cant nonlinear friction torques on both joints. The
for control results in a simple proportional gain
RCP architecture is used to control the robot in
KV 2τ between the input command voltage, Vm ,
the execution of different tasks, by means of sim-
and the torque τm supplied by the motor:
ple independent joints PD control laws, to collect
the data necessary to reconstruct the behavior of τm = KV 2τ Vm (1)
the friction torques, according to the most widely
known models available in literature (de Wit et The original control system manufactured by the
al., 1991; Armstrong-Hélouvry et al., 1994; de Wit IMI Corp. has been substituted by a new RCP
et al., 1995; de Wit and Lischinsky, 1997), and architecture. The control system environment,
then to simulate the manipulator dynamic behav- called Open DSP, has been developed by the
ior, for the validation of the developed friction Mechatronics Laboratory of the Politecnico di
model. Finally, the identified friction model is Torino, and represents the enhanced, industrial
used to compensate for friction torques within an evolution of an older, educational version, illus-
inverse dynamics control scheme, which is applied trated in (Argondizza et al., 1997). OpenDSP
to the robot in the last experimental tests. consists of a DSP board and a programmable
input/output board. The system is linked via en-
The outline of the paper is as follows. In Section 2
hanced parallel port (EPP) protocol to the host
a brief description of the manipulator and of the
PC, and by some connections to each axes inter-
experimental setup is given. Section 3 is devoted
face. A Matlab environment with Simulink runs
to friction modelling and identification, while Sec-
on the host PC. The architecture of the complete
tion 4 shows some preliminary experimental re-
experimental setup is sketched in Figure 2.
sults, relative to the application of nonlinear con-
trol laws with explicit friction compensation. Sec- The OpenDSP system includes a new toolbox for
tion 5 finally draws the conclusions and outlines Matlab called MatDSP, which allows the Matlab-
further research topics. code interaction with the DSP. In this way it is
possible to read or change any variable processed
by the DSP, in synchronous or asynchronous
2. THE MANIPULATOR AND THE RCP mode. The control algorithms written in C can
EXPERIMENTAL SETUP be compiled, downloaded and started/paused on
DSP.
The considered robot is a planar two-arms manip- The Matlab GUIDE tool has been used to con-
ulator, manufactured by IMI (USA), and sketched struct some graphic user interfaces, which allow
in Figure 1. The maximum extension of the links an easy execution of some standard modelling and
(1 + 2 ) is about 0.7 m, the angular limits being control design steps, hiding the MatDSP com-
±2.15 rad for both joints. mands by a logic construction, and grouping the
signals in high level functions rather than using
q2 them to perform single hardware operations. In
particular, three tools are currently available to
l2 the user: the IMIConsole, to enable and supervise

Host PC
l1
q1
x RS232 IMI robot
EPP

y
OpenDSP rack Drivers

Fig. 1. The geometrical scheme of the IMI planar


manipulator. Fig. 2. The experimental setup.
the entire control system; the IMIExecute, to se- the average bristle deflection for a steady state
lect and execute a previously planned trajectory; motion is then determined by the velocity.
the IMIReference, to generate some simple, basic
The well-known LuGre model (de Wit et al., 1995;
reference functions.
Olsson et al., 1998), which takes into account both
More details about the OpenDSP architecture and the steady-state friction curve and the presliding
real-time software, which belongs to the so-called phase by means of a bristle model, will be used
round-robin with interrupts architecture group, to represent the friction torques present on the
can be found in (Bona et al., 2001; Bona et joints of the considered manipulator. According to
al., 2002). such a model, the behavior of the friction torque
τf,i on the i-th joint is described by the following
equations:
3. FRICTION MODELLING AND
ESTIMATION dzi |q̇i |
= q̇i − σ0,i zi (2)
dt gi (q̇i )
In this section, the main characteristics of the fric-
dzi
tion phenomena and the various friction models τf,i = σ0,i zi + σ1,i + fi (q̇i ) (3)
proposed in literature are briefly reviewed, before dt
discussing the experimental results obtained in where q̇i is the angular velocity of the joint (qi
the friction identification tests, performed on the being the joint position coordinate), zi is a state
considered robot. variable representing the average bristle deflection
for joint i, σ0,i and σ1,i are model parameters
that are assumed to be constant, and functions
3.1 Friction modelling gi (q̇i ) and fi (q̇i ) model the Stribeck effect and
the viscous friction, respectively. For constant
Different models have been proposed in literature, velocity, the steady-state friction torque is then
see e.g. (Armstrong-Hélouvry, 1991; de Wit et given by:
al., 1991; Armstrong-Hélouvry et al., 1994; de Wit
τf,iss = gi (q̇i ) sgn(q̇i ) + fi (q̇i ) (4)
et al., 1995; Dupont et al., 2000; Swevers et
al., 2000; Hensen et al., 2002; Chen et al., 2002) Different parameterizations are possible for func-
to describe in a more or less accurate way all tions gi (q̇i ) and fi (q̇i ): the first one is a nonlinear
the friction components. A basic classification of function of velocity, generally expressed by means
the friction models is relative to their static or of exponential terms, while the second one can be
dynamic characteristics (Olsson et al., 1998). given by a simple linear viscous function or by a
higher order polynomial function, when required
The classical static models describe friction as a for a better fitting with the collected experimental
function of the relative velocity of the bodies in data.
contact, taking into account some of the various
aspects of the friction force, such as Coulomb
friction, viscous friction, stiction, and the so- 3.2 Friction estimation
called Stribeck effect, which is relative to the low-
velocities region, in which friction decreases as ve- The model of the manipulator under study can be
locity increases. Different velocity nonlinear func- described by the following second-order nonlinear
tions have been proposed to describe such aspects, differential equation:
taking into account only the current velocity value
(thus defining static friction models). M (q)q̈ + C(q, q̇)q̇ + τ f (q, q̇) = τ c (5)
where q, q̇, and q̈ are the vectors of joint angles,
The model proposed in (Armstrong-Hélouvry et
angular velocities and angular accelerations, M
al., 1994) can be considered as an intermediate
is the configuration-dependent inertia matrix, in-
step towards dynamic models; in fact, such a
cluding both links and motors inertia, C q̇ is the
model introduced temporal dependencies for stic-
term containing Coriolis and centrifugal torques,
tion and the Stribeck effect, but it did not handle
τ f is the friction torque vector, and τ c is the
presliding displacement, which is addressed by
command torque vector. The gravitation effects
the proper dynamic friction models dealing with
are considered to be negligible, due to the physical
the behavior of the microscopical contact points
placement of the manipulator arms, that move in
between the surfaces. In such models, each contact
the horizontal plane. Each command torque can
point is generally modelled as a bond between
be expressed as a function of the command input
flexible bristles; as the surfaces move, the strain in
voltage of the corresponding actuator according
the bond increases and the bristles act as springs.
to equation (1).
Friction is then modelled as the average deflection
force of the elastic springs. When the deflection In a previous paper (Bona et al., 2002), friction
becomes sufficiently large, the bristles start to slip; has been characterized taking into account only
two main aspects of that phenomenon, i.e. static eral times the same motion and filtering the mea-
friction and viscous friction. In this paper, the sured data to extract the mean values.
RCP architecture described in Section 2 is used
The parameter values to be identified in (4), with
to find whether it is possible to obtain a more
gi (q̇i ) and fi (q̇i ) defined as in (6) and (7), should
accurate reconstruction of the real behavior of the
be six for each joint (the four α’s together with
friction torques, according to the LuGre model
ωs1,i and ωs2,i ). By the observation of the acquired
illustrated in the previous subsection, by consid-
data, tentative values between 0.1 and 0.3 rad/s
ering in particular the following expressions for
have been considered for the exponential parame-
the Stribeck curve gi (q̇i ) and the viscous friction
ters ωs1,i and ωs2,i , and then a least square algo-
fi (q̇i ), for i = 1, 2:
rithm has been applied to a linearized expression
q̇i
of (4)-(7) to estimate the α’s parameters for each
− sgn(q̇i )
gi (q̇i ) = α0,i + α1,i e q̇s1,i joint. By some iterations, the values reported in
 q̇
 Table 1 have been obtained.
− q̇ i sgn(q̇i )
+α2,i 1 − e s2,i (6) Table 1. Estimated static parameters of
the LuGre friction model.
f (q̇i ) = α3,i q̇i + α4,i q̇i2 (7)
Joint 1 Joint 1 Joint 2 Joint 2
Two different series of experiments are needed ω>0 ω<0 ω>0 ω<0
to identify all the parameters of the considered α0 40.854 -46.473 17.837 3.408
α1 -32.454 53.873 -14.837 -0.408
friction model: the static parameters αk,i in (6)
α2 -31.233 55.738 -14.998 -0.635
and (7), and the dynamic parameters σk,i in (2) α3 -0.760 -0.293 -0.156 -0.104
and (3). α4 -0.262 0.177 -0.050 0.036
ωs1 0.19 0.14 0.2 0.3
The first series, which is relative to the estimation ωs2 0.17 0.15 0.19 0.1
of the steady-state friction curve given in (4), is
constituted by tests at different constant joint Figures 3 and 4 show the resulting steady-state
velocity values. A PD control law, with high friction torque together with the acquired data for
gains to avoid stick-slip phenomena, has been used the first joint (for positive and negative velocity
in the experimental tests (with 1 ms sampling values, respectively). Similar results have been
time) to move each joint at low velocity values, obtained for the second joint.
whereas acquisition at high velocity has been
performed letting the joint rotate freely (without A second series of tests has been performed to esti-
the links), using the Torque mode functionality mate the dynamic friction parameters σ0 and σ1 .
of the actuators, until a dynamic equilibrium Their identification is particularly critical, since
situation at constant velocity is achieved. it is not possible to measure directly the state
variable zi in equations (2)-(3). Following a pro-
In both cases, the tests have been executed by cedure similar to the one proposed in (de Wit and
means of a C-based DSP code, developed within Lischinsky, 1997), under some pre-sliding assump-
a fixed template. The IMIConsole GUI has been tions, it is possible to compute zi by integrating
used to compile and download the real time code equation (2) from joint position measures acquired
and to enable the axis drives; the acquisition of the by applying a slowly growing torque ramp to each
joint position data has been performed without joint to estimate σ0,i , and by applying a torque
any invasive effect on the control function, as it step to estimate σ1,i (see (de Wit and Lischin-
is entirely executed within the DSP environment. sky, 1997) for details). A good approximation of
Velocity data (and acceleration, when needed) are such parameters could be obtained only starting
subsequently determined via software.
The friction torque data have been indirectly
derived by considering:
τ m,k = τ f,k (8)
in the open loop tests, where τ m,k and τ f,k are
the k-th samples of the applied motor torques
and of the joint friction torques, respectively, and
from the manipulator dynamic equation (5) in the
closed loop tests at low velocity, as:
τ f (q̇) + τ err = τ c − M (q)q̈ − C(q, q̇) (9)
where τ err is a torque vector that represents all
modelling errors and measurement disturbances; Fig. 3. Friction torque (Nm) vs. positive velocity
such a term has been disregarded, repeating sev- (rad/s) on joint 1.
Inverse dynamics PID feedback control
0.025

0.02

0.015

Position errors (rad)


0.01

with friction compensation without friction compensation

0.005

−0.005

−0.01
0 0.5 1 1.5 2 2.5 3 3.5 4
Time (s)

Fig. 4. Friction torque (Nm) vs. negative velocity


(rad/s) on joint 1. Fig. 5. Inverse dynamic control without and with
friction compensation: position error on joint
from high precision joint position measurements.
1.
Since the the encoder signal is decoded with a
resolution of only 2π/76800 rad, the estimated available nominal values. The applied inner loop-
values of σ0,i and σ1,i could be not consistent outer loop control scheme is of the following type:
in our case; a subsequent model validation, per- τ c = M (q)(q̈ r − v c ) + C(q, q̇)q̇ + τ̂ f (q̇) (10)
formed by comparing the real robot behavior with
the results of simulation tests (carried out by a where q̈ r is the joint acceleration reference vector,
Simulink model, which can be directly run from τ̂ f (q̇) is the estimated friction torque vector, and
the IMIConsole GUI) has allowed some adjust- a PD control algorithm has been considered to
ments of the estimated values of the dynamic define the outer loop law v c .
friction parameters, but some more investigation Figure 5 shows the time-history of the position
will be necessary. The currently estimated values error of the first joint (for a circular, cartesian ref-
are reported in Table 2. erence trajectory, defined by means of the IMIRef-
erence GUI), when τ̂ f (q̇) = 0 is considered,
Table 2. Estimated dynamic parameters
i.e. without any friction compensation, and when
of the LuGre friction model.
τ̂ f (q̇) corresponds to the estimated steady-state
Joint 1 Joint 1 Joint 2 Joint 2 friction curve. Since the estimated values of σ0,i
ω>0 ω<0 ω>0 ω<0 and σ1,i currently available require to be better
σ0 55500 26000 12600 12600 validated and updated, we preferred to use only
σ1 1000 800 70 70 the more reliable steady-state estimation to see
if such, somehow partial, friction compensation is
anyway sufficient to achieve good improvements
from the control point of view. As Figure 5 shows,
4. NONLINEAR CONTROL WITH FRICTION a significant error reduction has been obtained by
COMPENSATION the inserted friction compensation term (similar
results have been achieved for the seconds joint,
In robotic manipulators with brushless direct too).
drive actuators, the positive effects of reduction
gears are absent. At low velocities, where stic-
tion and the Stribeck effect are conspicuous, sim- 5. CONCLUSIONS
ple wideband “stiff” PD controllers may work
(Tataryn et al., 1996), although instabilities may The RCP architecture developed for the consid-
occur due to various reasons, the principal one ered manipulator has revealed to be particularly
being the neglected parasitic elastic dynamics. At useful for an easy execution of different tasks,
high velocities, where the effects of nonlinear cou- aimed at a finely tuned determination of the robot
pling torques become noticeable, PID controllers dynamic model, and of the friction phenomena
become inefficient. in particular. Unfortunately the estimation of the
pre-sliding friction obtained so far is not suffi-
Some preliminary tests have been performed to
ciently reliable to be directly used for control,
evaluate the improvements that can be obtained
but the first experimental results, obtained with
from the control point of view by friction com-
the only steady-state friction compensation, are
pensation. An inverse dynamic control scheme
promising.
has been applied, by using again the IMIConsole
GUI, under the assumption that all the inertial Future works will be devoted to improve pre-
and dynamic robot parameters are equal to their sliding friction estimation, and to calibration tests
that allow a parallel estimation of the friction de Wit, C. Canudas, H. Olsson, K.J. Åström
torques and of the inertial robot parameters, as- and P. Lischinsky (1995). A new model for
sumed simply equal to their nominal values in the control of systems with friction. IEEE Trans.
carried out tests. on Automatic Control 40(3), 419–425.
de Wit, C. Canudas, P. Noël, A. Aubin and
B. Brogliato (1991). Adaptive friction com-
pensation in robot manipulators: Low veloci-
Acknowledgments
ties. Int. J. of Robotics Research 10(3), 189–
199.
The authors acknowledge the financial support
Dupont, P., B. Armstrong and V. Hayward
of MIUR under “MISTRAL” National Research
(2000). Elasto-plastic friction model: contact
Project, and Italian Space Agency, under grant
compliance and stiction. In: 2000 American
ASI-ARS-99-38.
Control Conference. pp. 1072–1077, vol.2.
Dupont, P.E. (1990). Friction modeling in dy-
namic robot simulation. In: IEEE Interna-
REFERENCES tional Conference on Robotics and Automa-
tion. pp. 1370 –1376, vol. 2.
Argondizza, A., B. Bona and S. Carabelli (1997). Hanselmann, H. (1996). Automotive control: from
Automatic control teaching with matlab and concepts to experiments to product. In: IEEE
matdsp. In: European Control Conference Int. Symp. on Computer-Aided Control Sys-
(ECC 97). Brussel. tems Design. Dearborn. pp. 129–134.
Armstrong, B., D. Neevel and T. Kusik (2001). Hensen, R.H.A., M.J.G. van de Molengraft and
New results in npid control: Tracking, inte- M. Steinbuch (2002). Frequency domain iden-
gral control, friction compensation and ex- tification of dynamic friction model parame-
perimental results. IEEE Trans. on Control ters. IEEE Trans. on Control Systems Tech-
Systems Technology 9(2), 399–406. nology 10(2), 191–196.
Armstrong-Hélouvry, B. (1991). Control of Ma- Hirschorn, R.M. and G. Miller (1999). Control of
chines with Friction. Kluwer Academic Pub- nonlinear systems with friction. IEEE Trans.
lishers. Boston. on Control System Technology 7(5), 588–595.
Armstrong-Hélouvry, B., P. Dupont and C. Ca nu- Kim, Y.H. and F.L. Lewis (2000). Reinforce-
das de Wit (1994). A survey of models, anal- ment adaptive learning neural-net-based fric-
ysis tools and compensation methods for the tion compensation control for high speed and
control of machines with friction. Automatica precision. IEEE Trans. on Control System
30(7), 1083–1138. Technology 8(1), 118–126.
Bona, B. and M. Indri (1995). Friction com- Olsson, H., K.J. Åström, C. Canudas de Wit,
pensation and robustness issues in force/po- M. Gäfvert and P. Lischinsky (1998). Friction
sition controlled manipulators. IEE Pro- models and friction compensation. European
ceedings, Control Theory and Applications Journal of Control (4), 176–195.
142(6), 569–574. Ray, L.R., A. Ramasubramanian and J. Townsend
Bona, B., M. Indri and N. Smaldone (2001). Open (2001). Adaptive friction compensation using
system real time architecture and software de- extended kalman-bucy filter friction estima-
sign for robot control. In: IEEE/ASME In- tion. Control Engineering Practice 9, 169–
ternational Conference on Advanced Intelli- 179.
gent Mechatronics (AIM01). Como (Italy). Swevers, J., F. Al-Bender, C.G. Ganseman and
pp. 349–354. T. Prajogo (2000). An integrated friction
Bona, B., M. Indri and N. Smaldone (2002). An model structure with improved presliding
experimental setup for modelling, simulation behaviour for accurate friction compensa-
and fast prototyping of mechanical arms. In: tion. IEEE Trans. on Automatic Control
IEEE Conference on Computer-Aided Con- 45(4), 675–686.
trol Systems Design. Glasgow (UK). Tataryn, P.D., N. Sepehri and D. Strong (1996).
Chen, Y.-Y., P.-Y. Huang and J.-Y-Yen (2002). Experimental comparison of some compen-
Frequency-domain identification algorithms sation techniques for the control of manip-
for servo systems with friction. IEEE Trans. ulators with stick-slip friction. Control Eng.
on Control Systems Technology 10(5), 654– Practice 4(9), 1209–1219.
665.
de Wit, C. Canudas and P. Lischinsky (1997).
Adaptive friction compensation with par-
tially known dynamic friction model. Int. J.
of Adaptive Control and Signal Processing
11, 65–80.

You might also like