Professional Documents
Culture Documents
Abstract - This paper studies the performance of different order Pad Fractional Order
(FO) PD0.5 controllers applied to the leg joint control of a hexapod robot with two dof
legs and joint actuators with saturation. For simulation purposes the robot prescribed
motion is characterized through several locomotion variables and for the walking
performance evaluation are used two indices, one based on the mean absolute density of
energy per travelled distance and the other on the hip trajectory errors. A set of
simulation experiments reveals the influence of the different order Pad PD0.5 controllers
tuning upon the proposed indices. Copyright 2006 IFAC
The application of the theory of fractional calculus in We consider a walking system (Fig. 1) with n = 6
robotics is still in a research stage, but the recent legs, equally distributed along both sides of the robot
progress in this area reveals promising aspects for body, having each two rotational joints (i.e., j = {1,
future developments (Silva and Machado, 2005). 2} {hip, knee}) (Silva, et al., 2005). Motion is
described by means of a world coordinate system.
Taking into consideration these facts, a simulation The kinematic model comprises: the cycle time T, the
model for multi-leg locomotion systems was duty factor , the transference time tT = (1)T, the
developed, for several periodic gaits. This tool is support time tS = T, the step length LS, the stroke
adopted in the present study to evaluate the pitch SP, the body height HB, the maximum foot
performance of different order Pad Fractional Order clearance FC, the ith leg lengths Li1 and Li2 and the ith
(FO) PD0.5 control algorithms applied to the leg joint foot trajectory offset Oi. Moreover, we consider a
control of a hexapod robot. The analysis is based on periodic trajectory for each foot, with body velocity
the formulation of two indices measuring the mean VF = LS / T.
absolute density of energy per travelled distance and
the hip trajectory errors during walking.
VF during the stance phase:
SP
p Fd ( t ) = [VF T 0]
T
41
(3)
L41 L21
L61 The algorithm for the forward motion planning
accepts the desired cartesian trajectories of the leg
HB hips pHd(t) and feet pFd(t) as inputs and, by means of
42 an inverse kinematics algorithm 1, generates the
L42 L22
L62 related joint trajectories d(t) = [i1d(t), i2d(t)]T,
y O6
O4
O2 selecting the solution corresponding to a forward
(x4F,y4F) FC knee:
x LS
pd ( t ) = xid ( t ) yid ( t ) = p Fd ( t ) p Hd ( t )
T
Fig. 1. Coordinate system and variables that (4a)
characterize the motion trajectories of the multi-
pd ( t ) = [d (t ) ] d (t ) = pd ( t ) 1
(4b)
legged robot.
(t ) = J 1 p ( t ) , J = (4c)
Gaits describe sequences of leg movements, d d d
alternating between transfer and support phases.
Given a particular gait and duty factor , it is
possible to calculate, for leg i, the corresponding
3. ROBOT DYNAMICS AND CONTROL
phase i, the time instant where each leg leaves and
ARCHITECTURE
returns to contact with the ground and the cartesian
trajectories of the tip of the feet (that must be
completed during tT). Based on this data, the
3.1 Inverse Dynamics Computation
trajectory generator is responsible for producing a
motion that synchronises and coordinates the legs.
The planned joint trajectories constitute the reference
for the robot control system. The model for the robot
The robot body, and by consequence the legs hips, is
inverse dynamics is formulated as:
assumed to have a desired horizontal movement with
a constant forward speed VF. Therefore, for leg i the
cartesian coordinates of the hip of the legs are given = H ()
+ c , ( RH)
+ g ( ) F J T ()F (5)
F RF
have a spine that allows supporting the locomotion f2y (xiH, yiH)
BxH
(xiH, yiH)
with improved stability. In the present study, the Segment 5 Segment 3 Segment 1
ByH
KxH
KyH
robot body is divided in n identical segments (each (xiH, yiH)
f2x
with mass Mbn1) and a linear spring-damper system 21
22 Ground Compliance
u BxF
The general control architecture of the hexapod robot Fig. 3. Hexapod robot control architecture.
is presented in Fig. 3. On a previous work were
demonstrated the advantages of a cascade controller, In this paper, for implementing the FO algorithm
with PD position control and foot force feedback, (Eq. (9)) it is adopted a discrete-time uth-order Pad
over a classical PD with, merely, position feedback, approximation (aij, bij , j = 1, 2) yielding an
particularly in real situations where we have non- equation in the z-domain of the type:
ideal actuators with saturation and being also more
robust for variable ground characteristics (Silva, et i =u i =u
al., 2003). Previous studies have also allowed us to GC1 j ( z ) Kp j + K j aij z i b ij z i . (10)
i =0 i =0
conclude that the control of a hexapod walking robot
through a FO PD algorithm guaranteed the best
performance for the fractional order j = 0.5 (Silva
and Machado, 2005). Based on these results, we now 4. MEASURES FOR PERFORMANCE
evaluate the effect of different orders of the FO PD0.5 EVALUATION
controller adopted for Gc1(s), while for Gc2 it is
In mathematical terms we establish two global
considered a simple P controller. For the FO PD
measures of the overall performance of the
algorithm we have:
mechanism in an average sense. In this perspective,
we define one index {Eav} inspired on the system
GC1 j ( s ) = Kp j + K j s j , j ,
j = 1, 2 (9) dynamics and another one {xyH} based on the
trajectory tracking errors.
where Kpj and Kj are the proportional and
derivative gains, respectively, and j is the fractional Regarding the mean absolute density of energy per
order, for joint j. travelled distance Eav, it is computed assuming that
energy regeneration is not available by actuators
doing negative work (by taking the absolute value of 600.0
Eav [Jm ]
product of the motor torque and angular velocity.
1
The global index Eav is obtained by averaging the 450.0
350.0
1 n m T
Eav = ij ( t ) ij ( t ) dt
0.50 1.00 1.50 2.00 2.50 3.00
Jm 1 (11) xyH [m]
d i =1 j =1 0
n Ns
1
( + iyH 2 )
500.0
xyH = [ m]
Eav [Jm ]
1
2
ixH
i =1 Ns k =1 (12) 450.0
500.0
Eav [Jm ]
1
500.0
Eav [Jm ]
100
12m (Nm)
0
6. CONCLUSIONS
-100
In this paper we have compared the performance of
different order Pad FO PD0.5 controllers applied to
-200
-300
the leg joint control of a hexapod robot with two dof
-400
0.0 0.2 0.4 0.6 0.8 1.0
legs and leg joint actuators having saturation.
t (s)
0.001
0.000 the solution with simultaneous low values for Eav and
-0.001 xyH.
-0.002
-0.003
The focus of the work presented has been on the use
-0.004
0.0 0.2 0.4 0.6 0.8 1.0
of the Pad approximation for the implementation of
t (s) the PD0.5 controllers with a proportional plus a
derivative / integrative term. Presently we are
0.020
studying the performance of the system in case we
0.015
use the series approximation for the implementation
of the FO PD0.5. Future work in this area will also
0.010 address the study of the performance of a FO PID
1yH (m)
-0.005 REFERENCES
0.0 0.2 0.4 0.6 0.8 1.0
t (s)
Silva, M. F. and Machado, J. A. T. (2005). Integer
vs. Fractional Order Control of a Hexapod Robot,
Fig. 6. Plots of 1xH and 1yH vs. t, considering a Pad in Climbing and Walking Robots, Manuel A.
approximation for the PD0.5 Gc1(s) with four Armada and Pablo Gonzalz de Santos (Eds.),
terms (u = 4) and Gc2 = 0.9. Springer, pp. 7383.
Silva, M. F., Machado, J. A. T. and Barbosa, R. S.
From the analysis of these figures it is possible to (2006). Complex-Order Dynamics in Hexapod
conclude that, for the algorithm implementation with Locomotion, Signal Processing. Accepted for
this Pad order (according to the previous studies), publication.
the robot locomotion is performed with only minor Silva, M. F., Machado, J. A. T. and Lopes, A. M.
oscillations in the hip joint torque, largely due to the (2003). Position / Force Control of a Walking
feet impact with the ground at the end of the transfer Robot. MIROC Machine Intelligence and Robot
phase, and with much lower oscillations in the knee Control, 5, pp. 33 44.
torque. Furthermore, it is possible to conclude that Silva, M. F., Machado, J. A. T. and Lopes, A. M.
the torque that the actuators must supply along the (2005). Modelling and Simulation of Artificial
locomotion cycle is lower than the actuators Locomotion Systems, ROBOTICA, 23, pp. 595
saturation torque, as desirable. 606.