Flatness-Based Control
Flatness-Based Control
é q1(t ) ù
q(t ) = êê ú
ú
q (t )
ëê 2 ûú
Fig. 2. Ambuigity of the inverse kinematics
y3 = pM 1 = 0.5 · (pM 1l + pM 1r ) , (16a) Here, the desired trajectories for the end-effector
y4 = pM 2 = 0.5 · (pM 2l + pM 2r ) , (16b) position in x-direction xEd and in z-direction zEd
as well as their first two time derivatives have to
The differential flatness can be proven as follows: be provided, whereas the desired trajectories for
all system states can be directly expressed by the the mean pressure of drive 1, i.e. pM 1d , and the
flat outputs and their time derivatives mean pressure of drive 2, i.e. pM 2d , are directly
xE = y1 , ẋE = ẏ1 , zE = y2 , żE = ẏ2 . (17) employed in a feedforward manner
4. SIMULATION RESULTS
xE (q) zE (q)
zx = , zz = , (19)
ẋE (q, q̇) żE (q, q̇)
Tracking performance as well as steady-state ac-
Here, in contrast to the approach presented curacy w.r.t. end-effector position and mean pres-
in (Aschemann and Hofer, 2004), the end-effector sure have been investigated by simulation studies
acceleration has not to be determined neither by of a parallel robot with the following dimensions:
evaluation of the equation of motion (3) nor by a = 0.5 m, lA = 0.4 m, sA = 0.2 m, lP = 0.8 m.
a double real differentiation of the measured po- For this purpose, the tracking of a triangle-like
sition signal. By inserting the new defined inputs desired trajectory for the controlled variables as
v1 = ẍE , v2 = z̈E , v3 = pM 1 , and v4 = pM 2 shown in fig. 5 has been considered. At this, the
as well as the transformed states into (18), the desired value for the mean pressure is held con-
inverse dynamics becomes stant at 4.0 bar.
u = u (zx , zz , v1 , v2 , v3 , v4 ) . (20) The first part consists of a motion from the
The error dynamics of the end-effector positions starting point (x = 0 m, z = 1 m) to the
xE and zE can be asymptotically stabilized with point (x = −0.2 m, z = 0.6 m). The second
the control laws part comprises a movement in x-direction by
1.5 pM1ld [bar]
x [m] 6 6
Ed
0.9 1 zEd [m] p [bar]
M1l
0.8
0.5 4 4
0.7 pM1rd [bar]
0 p [bar]
0.6 2 2 M1r
des. traj. in xz−plane [m]
0.5 −0.5 0 5 10 0 5 10
−0.3−0.2−0.1 0 0.1 0.2 0.3 0 5 10
t [s] t [s] t [s]
2 20
xpp [m/s2] pM2rd [bar]
Ed 6 6
1 zppEd [m/s2] p [bar]
10 M2r
0 4 4
0 pM2ld [bar]
−1 xp [m/s]
Ed p [bar]
zp [m/s] 2 M2l 2
Ed
−2 −10
0 5 10 0 5 10 0 5 10 0 5 10
t [s] t [s] t [s] t [s]
Fig. 5. Desired trajectories and according tracking Fig. 7. Desired values and actual values of the four
errors for carriage position and mean pressure muscle pressures
−3 −3
4
x 10
4
x 10 robot with two degrees of freedom driven by pneu-
ex [m] ez [m] matic muscles. The modelling of this mechatronic
2 2
system leads to a system of non-linear differential
0 0
equations of eigth order. For the characteristics of
−2 −2 the pneumatic muscles polynomials serve as good
−4
0 5 10
−4
0 5 10
approximations. The non-linearity of the valve is
t [s] t [s] linearised by means of a pre-multiplication with
0.1
epM1 [bar]
0.1
epM2 [bar]
its approximated inverse characteristic. The inner
0.05 0.05 control loops of the cascade involve a flatness-
0 0 based control of the internal muscle pressure with
−0.05 −0.05
high bandwidth. The outer control loop achieves
a decoupling of the end-effector position and the
−0.1 −0.1
0 5 10 0 5 10 mean pressures as controlled variables. Simulation
t [s] t [s]
results emphasise the excellent closed-loop perfor-
Fig. 6. Tracking errors w.r.t. the end-effector po- mance with maximum position errors of approx.
sition (top) and the mean pressures (bottom) 3 mm during the movements, vanishing steady-
state position error and steady-state pressure er-
0.4 m to the point (x = 0.2 m, z = 0.6 m). ror of less than 0.01 bar. Future research will
The third part involves the return motion to the address experiments at a prototype system.
starting point. These fast trajectories have been
generated considering and, consequently, avoiding
saturation effects due to the mass flow limitations. REFERENCES
The corresponding tracking errors are depicted in Aschemann, H. and E.P. Hofer (2004). Flatness-
fig. 6. As for the end-effector position, the maxi- based trajectory control of a pneumatically
mum tracking errors during the acceleration and driven carriage with uncertainties. Proceed-
deceleration intervals are approx. 3 mm, whereas ings of NOLCOS 2004, Stuttgart, Germany,
the steady-state error becomes zero due to the in- pp. 239–244.
tegral control part. Concerning the mean pressure, Bindel, R., R. Nitsche, R. Rothfuß and M. Zeitz
tracking errors of approx. 0.1 bar occur during the (1999). Flatness based control of two valve
acceleration and deceleration intervals, whereas hydraulic joint actuator of a large manip-
the steady-state error is less than 0.01 bar. ulator. CD-ROM-Proceedings of ECC 1999,
The corresponding desired values as well as ac- Karlsruhe, Germany.
tual values of the decentralised pressure controls Carbonell, P., Z. P. Jiang and D. Repperger
are depicted in figure 7. As can be seen, these (2001). Comparative study of three nonlin-
decentralised control loops achieve an excellent ear control strategies for a pneumatic mus-
tracking of the desired values provided by the cle actuator. Proceedings of NOLCOS 2001,
outer decoupling control. Saint-Petersburg, Russia, pp. 167–172.
Fliess, M., J. Levine, P. Martin and P. Rouchon
(1995). Flatness and defect of nonlinear sys-
5. CONCLUSIONS tems: Introductory theory and examples. Int.
J. Control 61, pp. 1327–1361.
In this paper, a cascaded trajectory control based
on differential flatness is presented for a parallel