Beruflich Dokumente
Kultur Dokumente
www.elsevier.com/locate/automatica
Brief paper
Abstract
Most control algorithms for rigid robots are given in joint coordinates. However, since the task to be accomplished is expressed in Cartesian
coordinates, inverse kinematics has to be computed in order to implement the control law. Alternatively, one can develop the necessary theory
directly in workspace coordinates. This has the disadvantage of a more complex robot model. In this paper, a control-observer scheme is given
to achieve exact Cartesian tracking without the knowledge of the manipulator dynamics nor computing inverse kinematics. Also, only joint
measurements are used.
2005 Elsevier Ltd. All rights reserved.
Keywords: Tracking control; Observer design; Cartesian workspace
1. Introduction
Robot manipulators are high nonlinear systems. To achieve
accurate tracking control, many schemes have been proposed
in the last decades. Among the main problems which have to
be solved, two of the most important are the lack of velocity
measurements and of an exact robot model. One of the earliest
schemes designed to work only with joint measurements is the
one by Nicosia and Tomei (1990). In that paper, a nonlinear
observer is presented which can be used to achieve tracking
control. On the other hand, to handle an inaccurate model, some
adaptive and robust schemes have been proposed (Slotine &
Li, 1987; Spong, 1992). When using a robust technique, an
extra term is introduced in the control law to achieve ultimately
boundedness of the trajectory errors. An adaptive algorithm
may be much more complex and is aimed at estimating on line
This paper was not presented at any IFAC meeting. This paper was
recommended for publication in revised form by Associate Editor Masaki
Yamakita under the direction of Editor Mituhiko Araki.
Corresponding author. Tel.: +52 55 56 22 30 13; fax: +52 55 56 16 10 73.
E-mail addresses: arteaga@verona.-p.unam.mx (M.A. Arteaga),
adrian@verona.-p.unam.mx (A. Castillo-Snchez), vparra@cinvestav.mx
(V. Parra-Vega).
0005-1098/$ - see front matter 2005 Elsevier Ltd. All rights reserved.
doi:10.1016/j.automatica.2005.11.004
474
All the algorithms for rigid robots mentioned before are given
in joint coordinates. However, since the task to be accomplished
is usually expressed in Cartesian coordinates, inverse kinematics has to be computed for implementation. Alternatively, one
can develop the necessary theory directly in workspace coordinates (Murray, Li, & Sastry, 1994). Since the new model
owns basically the same properties than the original one, control schemes only have to be rewritten in taskspace form to
be used. For instance, in Caccavale, Natale, and Villani (1999)
and Xian, de Queiroz, Dawson, and Walker (2004), control
approaches designed in taskspace coordinates and which do
not require velocity measurements are proposed. Both schemes
use the unit quaternion to deal with the orientation tracking.
However, they also have the disadvantage of using the robot
model both for the controller and the (nonlinear) observer. On
the other hand, in Takegaki and Arimoto (1981), a PD control
approach is presented which does not require the robot model
nor inverse kinematics. However, it only guarantees position
control and velocity measurements are needed.
In this paper, a control scheme based on that given in
Parra-Vega et al. (2003) is presented. Thus, no robot model
is needed for implementation, while the design is carried out
directly in taskspace coordinates. Furthermore, a linear observer is employed to avoid velocity measurements. While
the control-observer scheme is quite simple, exact tracking
control is achieved. The orientation problem is dealt using the
analytical Jacobian instead of the geometric one. Experimental
results are given to support the theory.
The paper is organized as follows. The robot model is given in
Section 2. The tracking controller with linear observer scheme
is proposed in Section 3. Section 4 presents experimental results. The paper concludes in Section 5.
(2)
(3)
(4)
(5)
x o x z z,
(6)
x = x o + z z + kd z,
(7)
x o = x d x (x x d ) ksd + kd z z,
(8)
(1)
x2
(9)
(10)
475
3.1. Discussion
where K Rnn is a diagonal positive denite matrix and
Rn , with
s = x x d + x (x xd )x + x x ,
(11)
s1 = s sd ,
(12)
kt
sd = s(0)e ,
t
=
{K s1 () + sign(s1 ())} d,
(13)
(0) = 0,
(14)
(15)
(16)
Finally, we dene
so xo x r .
= Kp J1 (q)(x + x x + K ),
with Kp Rnn a positive denite matrix, a proper combination of the gains k, kd , x , z , K , K and Kp can always be
found so that tracking and observation errors (x, x, z, z) are
bounded and tend to zero.
A detailed mathematical development of the proof, together
with the necessary conditions for the controller-observer gains,
are given in Appendix B.
(19)
(17)
= Kp J1 (q)so ,
(20)
[mm]
[mm]
476
2
4
2
0
[m]
0.42
0
8
t [s]
10
12
14
[m]
10
t [s]
15
10
t [s]
15
2
4
15
(f)
16
4
[V]
0.36
0.34
0.32
2
0
2
0.3
0
(b)
[]
10
t [s]
15
Fig. 4. Tracking and observation errors: (a) x; (b) zx ; (c) y; (d) zy ;
(e) ; (f) z .
0.44
(a)
8
t [s]
10
12
14
16
10
12
14
16
10
12
14
16
10
12
14
16
t [s]
(a)
4
[V]
50
40
30
20
10
0
2
0
2
0
(c)
(e)
0.46
0.4
10
t [s]
(d)
2
4
15
[]
[]
(c)
10
t [s]
(b)
15
[mm]
[mm]
(a)
10
t [s]
8
t [s]
10
12
14
16
8
t [s]
(b)
4
[V]
T
sition x(tf ) = 0.45 m 0.35 m 45 , with the nal time
tf = 15 s. The initial condition for the desired trajectories are
xd (0) = [0.406 m 0.305 m 0 ]T . Fifth order polynomial will
2
0
2
(c)
8
t [s]
477
If si si < for all time, then and s1 are bounded for all
time.
5. Conclusions
The tracking control problem for rigid robots without model
available nor velocity measurements has been studied in this
paper. Furthermore, the proposed scheme is designed in Cartesian coordinates, so that inverse kinematics is not necessary to
carry out a given task. The observer computes the not measurable velocities directly in Cartesian coordinates as well. It has
been shown that tracking and observation errors tend to zero,
under the condition that no singularity is reached. This assumption is made for simplicity, but a subregion of the dextrous
workspace and proper gains can always be chosen to guarantee
it. Experimental results show that the control-observer scheme
works well, both for orientation and position. As future work,
the unit quaternion will be introduced to see its performance.
Acknowledgements
(A.7)
It is straightforward to get
V 21 min (K K )2
[ 21 min (K K ) (max (K )si +
n)].
(A.8)
Then, if
(A.9)
one has
This work is based on research supported by the DGAPAUNAM under Grants IN119003 and IN116804 and by the
CONACYT.
Appendix A. Auxiliary theorem and lemma
In this appendix, we present an auxiliary theorem and lemma
for the proof of Theorem 1. First, consider the following wellknown theorem.
Theorem 2 (Khalil, 2002, pp. 172). Let D Rn be a domain
that contains the origin and V : [0, ) D R be a continuously differentiable function such that
(A.10)
(B.1)
(A.1)
jV
jV
+
f(t, x) W3 (x) x > 0,
jt
jx
sx x x r = x + x x x z sd + K ,
(B.2)
(A.2)
q r J1 (q)xr ,
(B.3)
sr q q r = J1 (q)sx .
(B.4)
< 1
2 (1 (r)).
or
(A.3)
Then, there exits a class KL function and for every initial state
x(t0 ), satisfying x(t0 ) 1
2 (1 (r)), there is T 0 (dependent
on x(t0 ) and ) such that the solution of x = f(t, x) satises
(A.4)
x1
1 (2 ())
(A.5)
t t0 + T .
(B.5)
(B.6)
where
(B.7)
By rewriting (18) as
= Kp sr + Kp J1 (q)r,
(B.8)
si = s1 + K .
where KDP D + Kp .
(A.6)
(B.9)
478
For the observer error dynamics, rst of all we note that (7)
can be written as x = x o + z z + kd z, so that by substituting in
(8) one gets after some manipulation
r = sx kd r K .
(B.10)
q r = J1 (xd x x + x z + sd K ).
(B.11)
where J 1 = (d/dt)(J1 ). Since sr = J1 sx + J 1 sx , by multiplying both sides of (B.11) by JT H(q) and taking into account
(B.6) one gets after some manipulation
Hr r = kd Hr r Cr sx Dr sx + JT
JTYa Hr K ,
(B.12)
with
Hr JT H(q)J1 ,
(B.13)
(B.14)
Dr JT DJ1 .
(B.15)
(B.17)
Hence
sx = x x r = r + s1 + K z z.
(B.19)
+ J x r .
(B.22)
1 T
2 y My,
(B.23)
(B.24)
(B.25)
(B.26)
qR
x r = x s1 K .
(B.21)
with
(B.16)
(B.20)
qR
(B.27)
(B.28)
479
c1 maxn J(q),
(B.30)
(B.31)
s1
(B.32)
Cr c3 ,
(B.33)
Ya cya ,
(B.34)
pmax ,
(B.35)
where
qR
qR
c4
(B.36)
cya (1 + c2 + c4 )
,
(B.37)
(B.38)
(B.39)
(B.40)
(B.41)
ds1
min (K K )s1 2
dt
min (K )|s1 | + s1 sipmax ,
(B.44)
s = x + x x = sd = s(0)ekt ,
(B.45)
(B.43)
sx r = kd r + K .
ds1
.
dt
sx r = z z + ksd + K .
one gets
V y2 y
cya (1+ c2 + c4 )
y
cya (1+ c2 + c4 ) .
ds1
(min (K ) sipmax )s1 .
dt
(B.42)
(kd I + z )z + kd z z = ksd .
(B.48)
References
Arteaga-Prez, M. A. (1998). On the properties of a dynamic model of exible
robot manipulators. ASME Journal of Dynamic Systems, Measurement,
and Control, 120, 814.
Arteaga-Prez, M. A. (2003). Robot control and parameter estimation with
only joint position measurements. Automatica, 39, 6773.
Arteaga-Prez, M. A., & Kelly, R. (2004). Robot control without velocity
measurements: New theory and experimental results. IEEE Transactions
on Robotics and Automation, 20(2), 297308.
480
Berghuis, H., & Nijmeijer, H. (1994). Robust control of robots via linear
estimated state feedback. IEEE Transactions on Automatic Control, 39(10),
21592162.
Caccavale, F., Natale, C., & Villani, L., 1999. Taskspace tracking control
without velocity measurements. In Proceedings of the IEEE international
conference on robotics and automation (pp. 512517), Detroit, Michigan,
USA.
Canudas de Wit, C., & Fixot, N. (1991). Robot control via robust estimated
state feedback. IEEE Transactions on Automatic Control, 36(12), 1497
1501.
Khalil, H. K. (2002). Nonlinear systems. (3rd ed.), Upper Saddle River, NJ,
USA: Prentice-Hall.
Murray, R. M., Li, Z., & Sastry, S. S. (1994). A mathematical introduction
to robotic manipulation. Boca Raton, FL, USA: CRC Press.
Nicosia, S., & Tomei, P. (1990). Robot control by using only joint position
measurements. IEEE Transactions on Automatic Control, 35(9), 1058
1061.
Parra-Vega, V., Arimoto, S., Liu, Y.-H., Hirzinger, G., & Akella, P. (2003).
Dynamic sliding PID control for tracking of robot manipulators: Theory
and experiments. IEEE Transactions on Robotics and Automation, 19(6),
967976.
Qu, Z., Dawson, D. M., Dorsey, J. F., & Dufe, J. D. (1995). Robust estimation
and control of robotic manipulators. Robotica, 13, 223231.
Sciavicco, L., & Siciliano, B. (2000). Modeling and control of robot
manipulators. (2nd ed.), London, Great Britain: Springer.
Slotine, J. J. E., & Li, W. (1987). On the adaptive control of robot
manipulators. International Journal of Robotics Research, 6(3), 4959.
Spong, M. W. (1992). On the robust control of robot manipulators. IEEE
Transactions on Automatic Control, 37(11), 17821786.
Takegaki, M., & Arimoto, S. (1981). A new feedback method for dynamic
control of manipulators. ASME Journal of Dynamic Systems, Measurement,
and Control, 102(2), 119125.
Xian, B., de Queiroz, M. S., Dawson, D., & Walker, I. (2004). Taskspace
tracking control of robot manipulators via quaternion feedback. IEEE
Transactions on Robotics and Automation, 20(1), 160167.