Académique Documents
Professionnel Documents
Culture Documents
Systems Approach
Q.P. Ha, H.M. Ha and G. Dissanayake
ARC Centre of Excellence for Autonomous Systems
University of Technology, Sydney
PO Box 123 Broadway NSW 2007 AUSTRALIA
Abstract This paper addresses robust control of multiple
mobile robots moving in desired formations. A rigorous control
technique for such an agent-based robotic system may encounter
problems of singularity, parameter sensitivity and inter-robot
collision. Our proposed framework focuses on the enhancement
of robustness as well as collision-free establishment of formations
even in the case of singularity and uncertainties in sensing
information of the reference coordinates by using variable
structure controllers incorporated with a reactive control scheme.
Advantages of the approach are veried in simulation of three
robots moving in a line, a column and a wedge.
I. I NTRODUCTION
The issue of control and coordination for multiple mobile
robots has revolved around two major tasks. First, the robot
platoon must maintain some desired shapes such as a line, a
column or a ring formation. The motivation is that multiple
robots are capable of performing many applications that single
robots cannot. Second, the robots have to simultaneously
avoid collisions between themselves and with obstacles in
the environment. Examples of these applications include box
pushing [10], load transportation [7] and capturing/enclosing
an invader [14].
There exist essentially three approaches in controlling
multiple mobile robot formation, namely: leader-following,
behavior-based and virtual-structure (see, e.g., [3] and references therein). While the virtual structure approach utilizes
centralized controllers, the leader-following and behavioral
approaches often apply decentralized controllers using local information. To deal with collision avoidance, some researchers used optimal motion planing [9], [13], which may
be computationally expensive, while other investigators used
feedback control with reactive schemes [1], [2], [12]. These
feedback controllers come with formal proofs of satisfactory
system performance and formation establishment. One advantage of these schemes is that they can be applied to small,
heterogeneous robots with limited communication range.
In robotic formation control, the problem of collision
between robots in the transient phase remains important,
although has not been explicitly addressed. For the leaderfollowing approach, tracking control of multiple mobile robots
using virtual robots (VR) [8] combined with l-l control [2]
has been proposed in an obstacle-free environment. However,
it is observed that the VR control method does not necessarily
guarantee acceptable collision avoidance between robots in
cos i 0
(1)
qi = Bi ui = sin i 0 ui , i = 1, 2, . . . , n;
0
1
T
Proceedings of the IEEE Workshop on Distributed Intelligent Systems: Collective Intelligence and Its Applications (DIS06)
0-7695-2589-X/06 $20.00 2006
IEEE
(2)
q1
y13
Robot 1
l13
D
q3
l23
Robot 3
y23
q2
Robot 2
Fig. 2.
C. Collision Avoidance
In Fig.3, the required clearance between robots is represented by a circle in broken line, having radius d, while the
circle in solid line covers the whole region corresponding to
the robot itself, centering at the control point, having radius
D. Let (xi , yi ) and (xj , yj ) denote the control points of robot
i and j, then the distance between robot i and j is:
(5)
ij = (xi xj )2 + (yi yj )2 .
One has therefore,
ij
ij
> 2(D + d)
2(D + d)
safe
unsafe.
(6)
(7)
Reference
qr
ye
VR i
xe
Fig. 3.
qi
Follower i
Fig. 1.
VR tracking
B. l-l Control
The aim of this control [2] is to maintain the desired
d
d
and l23
of a robot from its two nearest ones,
distances, l13
which can be represented respectively by robot 3 with respect
to robots 2 and 1 as shown in Figure 2.
The kinematic equations for robot 3 are given as follows,
l13
l23
where i = i + i3 3 , (i = 1, 2).
(4)
Collision detection
In VR tracking [8], when collisions are detected, the follower robots with a lower priority should switch to l-l control
to avoid collision with those robots having higher priorities,
while the latter do not have to change their control laws. To
choose the desired distances for l-l control, two situations are
considered, referring to cases when the target is inside an
accessible area of the low priority robot (i.e., the shaded areas
in Figure 4); and when it is outside that area. Denoting T G1
and T G2 respectively the targets of follower 1 and 2, and Px
the point where follower 2 will be led to by using l-l control,
d
d
then depending on each situation, the design of l13
and l23
,
which is equivalent to the design of Px , shall be accomplished
accordingly [8].
III. VSS A PPROACH TO ROBOT T RACKING C ONTROL
The design of VSS with a sliding mode involves the design
of a sliding function S, and of the control inputs in the
Proceedings of the IEEE Workshop on Distributed Intelligent Systems: Collective Intelligence and Its Applications (DIS06)
0-7695-2589-X/06 $20.00 2006
IEEE
Reference
TG2
TG1
TG2
Px
_
R
Follower 1
Fig. 4.
Reference
Follower 2
Taking time-derivative of S:
Follower 1
TG1
uj =
Px
Follower 2
_
R
or
veq = vr cos e
eq =
u+
j (x) when Sj (x) > 0
u
j (x) when Sj (x) < 0,
(8)
(9)
S = Qsgn(S) KS ,
(10)
(11)
xvi
xr
exi
e = yvi yr = eyi , i = 1, 2, . . . , n.
vi
r
i
(12)
The time-derivative of the error model is:
cos i r cos i l sin i
vi
e = sin i r sin i + l cos i
i
0
1
cos r 0
vr
sin r 0
r
0
1
(13)
= Bi ui Br ur .
The sliding function used here is chosen as S = Ce,
where
1 0 |r| sin i
C=
0 1 |r| cos i
sin e +
(17)
ui = ueq + uR ,
(18)
B
@
|r| cos i
|r| sin i + l cos i
sin i
|r| sin i +
|r| cos i + l sin i
1
C
A
cos i
1
, (20)
|r| + l
S
) 2 S ,
2
(21)
l13
l13
=
and d =
,
d
l23
l23
(22)
v3
v1 cos 13
cos 1 D sin 1
=
cos 2 D sin 2
3
v2 cos 23
(23)
= Bu3 br .
For the error model e = d , with the sliding function S = e, one
can obtain
S = e = Bu3 br d = Bu3 br .
(24)
Using same method in described section III-A, one can derive the
following control,
(14)
Proceedings of the IEEE Workshop on Distributed Intelligent Systems: Collective Intelligence and Its Applications (DIS06)
IEEE
(16)
|r|(e +sgn(r))
|r|+l
2
sgn(r))
r r (e|r|+l
|r|
vr
|r|+l sin e + |r|+l r .
(15)
= Ce + Ce
,
= (CBi ui CBr ur Ce)
S
) S) ,
3
(25)
1
D sin 2 D sin 1
B1 =
,
(26)
cos 2
cos 1
D sin(2 1 )
the control is undened when sin(2 1 ) = 0 or when the third
robot is found on the line connecting its two leaders.
qr
xe
VR i
To overcome these situations, reactive control schemes are proposed. Firstly, if ei 2 then applying VR tracking may result in
increasing position tracking error in the follower robots. Therefore,
the VSS control will be applied in this case for orientation tracking
until orientation of the controlled follower robot is aligned with the
reference robot.
Secondly, should collision occur between any follower robot i and
the reference robot according to the collision detection criteria given
in [8], l-l control will be used to drive the follower robot away
from possible collision and also heading to the target position so
that collision will most likely not happen after switching back to VR
tracking. Here, a VR for the reference robot (VRR) [5] is dened
as a VR with -r and -l clearances from the reference robot, where
r-l are correspondingly the desired clearances of follower i. This
virtual robot will be placed at the desired position of follower i in
the formation. If a collision occurs between any follower robot and
the reference robot, the follower robot will switch to l-l control in
order to go to Px , as illustrated in Figure 6, by using two leaders:
d
d
the reference robot and the VRR, with l13
and l23
designed as:
d
l13
d
l23
VRR
= 2(D
+ d) + D +
= r2 + l2 2(D + d) D + .
d
l13
d
l23
Fig. 5.
Px
Follower i
qi
2(D+d)
Fig. 6.
Reference
ye
Reference
Follower i
(27)
= 2(D + d) + D +
= |rr1 2(D + d) D| + .
= 2(D + d) + D +
=.
IEEE
(29)
= 2(D + d) + D +
= 2(D + d) + D + .
(30)
V. S IMULATION RESULTS
A. Collision Avoidance
For the case of there is no parameter variations or external
disturbances, initial parameters are set as follows:
Proceedings of the IEEE Workshop on Distributed Intelligent Systems: Collective Intelligence and Its Applications (DIS06)
0-7695-2589-X/06 $20.00 2006
(28)
10
TG2
R
0
y(dm)
Reference
10
F2
F1
20
30
Follower 2
Follower 1
2(D+d)
50
Fig. 8.
20
60
70
80
90
100 110
x(dm)
120
130
140
150
F1
Fig. 7.
y(dm)
Px
20
- Common : D = 3, d = 1, = 0.3
- Reference : qr (0) = [100, 0, 0]T , ur = [2.5, 0]T
- Follower 1 : Q = diag(0.01, 0.01), K = diag(0.5, 0.5),
= 0.01, = 0.01, 1 = 0.005, 2 = 0.05,
H = diag(0.1, 0.1), = diag(0.6, 0.6).
- Follower 2 : Q = diag(0.01, 0.01), K = diag(0.5, 0.5),
= 0.01, = 0.01, 1 = 0.005, 2 = 0.05
H = diag(0.1, 0.1), = diag(0.6, 0.6).
It is assumed that follower robot 2 has the lowest priority and the
reference robot the highest one. The rst simulation demonstrates
the establishment of a column formation, shown in Figure 8. The
initial positions of the followers and formation parameters are given
as follows,
- Follower 1 : q1 (0) = [70, 10, 0]T , (r, l) = (0, 30),
- Follower 2 : q2 (0) = [50, 15, 0]T , (r, l) = (0, 15).
First, follower F2 had apparently an incident collision with follower F1 near x = 70 and y = 10, when attempting to go to
the desired position. It then applied the method described in (28) to
avoid collision with follower 1. After avoiding potential collision with
follower 1, follower 2 switched the control back to VR control and
went to the desired position for a column formation with reference
robot R.
The second simulation, shown in Figure 9, demonstrates the use
of the method described in Figure 7, in the establishment of a
line formation. The initial positions of the followers and formation
parameters are given as follows,
- Follower 1 : q1 (0) = [80, 20, 0]T , (r, l) = (10, 0),
- Follower 2 : q2 (0) = [90, 30, 0]T , (r, l) = (10, 0).
Follower 2 detected an incident collision with follower 1 near x =
100 and y = 10. It then decided to take the rear route because
follower 1 and the reference were too close, by applying the strategy
described in Figure 7. After a while, follower 2 went to the same side
as its desired position with respect to the line connecting follower 1
and the reference robot. It then applied VR tracking control again,
but potentially resulting in another collision possibility with follower
1 near x = 120 and y = 0. This incident collision was resolved by
applying the method described in Figure 6 to go around the reference
robot. Finally, follower 2 approached the desired position to establish
safely a line formation.
B. Robustness
Motivated by Ogren
and Leonard [12], the issue of uncertainties
in robots coordinates is also taken into account in this simulation.
It is assumed that parameter variations come from communication
channel with the reference robot, or the state vector of the reference
robot contains some sensing error. In other words,
qr = qr + .
(31)
F2
40
Fig. 9.
80
100
120
140
160
x(dm)
IEEE
200
220
Proceedings of the IEEE Workshop on Distributed Intelligent Systems: Collective Intelligence and Its Applications (DIS06)
0-7695-2589-X/06 $20.00 2006
180
16
Ex
15.5
15
14.5
14
100
120
140
160
180
200
160
180
200
Time(sec)
16
Ex
15.5
15
14.5
14
100
120
140
Time(sec)
Fig. 10. Distances from follower robot to the reference robot along X axis
using VR tracking (top) and VSS approach (bottom)
R EFERENCES
10.05
Ey
10
9.95
9.9
100
120
140
160
180
200
160
180
200
Time(sec)
10.05
Ey
10
9.95
9.9
100
120
140
Time(sec)
Fig. 11. Distances from follower robot to the reference robot along Y axis
using VR tracking (top) and VSS approach (bottom)
E0
0.05
0.05
100
120
140
160
180
200
160
180
200
Time(sec)
E0
0.05
0.05
100
120
140
Time(sec)
Fig. 12. Orientation difference between follower robot and the reference
robot using VR tracking (top) and VSS approach (bottom)
[12] P. Ogren
and N. E. Leonard, Obstacle avoidance in formation, Proc.
2003 IEEE Intl. Conf. Robotics and Automation, pp. 24922497, Taipei,
Taiwan, September 2003.
[13] J. A. Reeds and L. A. Shepp, Optimal paths for a car that goes both
forwards and backwards, Pacic Journal of Math., vol. 145, no. 2, pp.
367-393, 1990.
[14] H. Yamaguchi, A cooperative hunting behavior by mobile-robot
troops, Intl. Journal of Robotics Research, vol. 18, no. 8, pp. 931-940,
September 1999.
Proceedings of the IEEE Workshop on Distributed Intelligent Systems: Collective Intelligence and Its Applications (DIS06)
0-7695-2589-X/06 $20.00 2006
IEEE