a synchronization approach to trajectory tracking of multiple mobile robots while maintaining...
TRANSCRIPT
-
8/13/2019 A Synchronization Approach to Trajectory Tracking of Multiple Mobile Robots While Maintaining Time-V-JL0
1/13
1074 IEEE TRANSACTIONS ON ROBOTICS, VOL. 25, NO. 5, OCTOBER 2009
A Synchronization Approach to Trajectory Trackingof Multiple Mobile Robots While Maintaining
Time-Varying FormationsDong Sun, Senior Member, IEEE, Can Wang, Wen Shang, and Gang Feng, Fellow, IEEE
AbstractIn this paper, we present a synchronization approachto trajectory tracking of multiple mobile robots while maintainingtime-varying formations. The main idea is to control each robotto track its desired trajectory while synchronizing its motion withthose of other robots to keeprelative kinematics relationships, as re-quired by the formation. First, we pose the formation-control prob-lem as a synchronization control problem and identify the synchro-nization control goal according to the formation requirement. Theformation error is measured by the position synchronization error,which is defined based on the established robot network. Second,
we develop a synchronous controller for each robots translation toguarantee that both position and synchronization errors approachzero asymptotically. The rotary controller is alsodesignedto ensurethat the robot is always oriented toward its desired position. Bothtranslational and rotary controls are supported by a centralizedhigh-level planer for task monitoring and robot global localization.Finally, we perform simulations and experiments to demonstratethe effectiveness of the proposed synchronization control approachin the formation control tasks.
Index TermsFormation, multiple mobile robots, synchroni-zation.
I. INTRODUCTION
STUDY on the formation control of swarms of mobile robotshas received increasing attention in recent years. Examples
of formation-control tasks include assignment of feasible forma-
tions, moving into a formation, maintenance of formation shape,
and switching between formations. In this paper, we will focus
on how to maintain the networked robots in a time-varying for-
mation while performing a group task as a whole. The relevant
applications include exploration [1], cooperative robot recon-
naissance [2] and manipulation [3], formation flight control [4],
satellite clustering [5], and control of groups of unmanned ve-
hicles [6], [7].
Numerous approaches to the formation control of multiple
mobile robots have been reported in the literature, such as
Manuscript received January 21, 2009; revised May 5, 2009 andJuly 2, 2009.First published August 4, 2009; current version published October 9, 2009. Thispaper was recommended for publication by Associate Editor G. Antonelli andEditor L. Parker upon evaluation of the reviewers comments. This work wassupported in part by the Research Grants Council of the Hong Kong SpecialAdministrative Region, China, under Grant CityU 119907 and in part by theCity University of Hong Kong under Grant 7002461.
The authors are with the Department of Manufacturing Engineering andEngineering Management,City University of HongKong, Kowloon, HongKong(e-mail: [email protected]; [email protected]; [email protected]; [email protected]).
Color versions of one or more of the figures in this paper are available onlineat http://ieeexplore.ieee.org.
Digital Object Identifier 10.1109/TRO.2009.2027384
behavior-based control, virtual structure approach, and leader-
following strategy, to name a few. In the behavior-based con-
trol [2], [8][11], several desired behaviors are prescribed for
each agent, and the final control is derived from a weighting of
the relative importance of each behavior. With this method, it
might be difficult to describe thedynamicsof thegroup andguar-
antee the stability of the whole system [12]. In the virtual struc-
ture approach [13][16], the entire formation is treated as a sin-
gle entity. The desired motion is assigned to the virtual structurethat traces out the trajectory for each member of the formation
to follow. However, the controller is not in decentralized archi-
tecture and may encounter difficulty in some applications [12].
With the leader-following strategy [3], [12], [17][20], some
robots are designed as leaders, while others are designed as fol-
lowers. This strategy is easily implemented by using two con-
trollers only and is suitable to describe the formation of robots,
but it is hard to take into account the functioning capabilities
of different robots, i.e., ability gap of a robot [12]. There also
exist some other approaches, such as artificial-potential-based
methods [21], [22] and graph-theory-based methods [23][29].
A recent approach to convex optimization strategies for coordi-
nating large-scale robot formations was reported in [30], whereshape transitions were discussed for mobile robot teams, albeit
from a high-level planner perspective.
In this paper, we propose to use a synchronization control
strategy to address the multirobot formation control problem,
thus utilizing the concept of cross-coupling approach [31]. Our
basic idea, which was first reported in [32], is that a team of
mobile robots track each individuals desired trajectory while
synchronizing motions among the robots to keep relative kine-
matics relationship for maintaining the desired, and perhaps
time-varying, formation. A relevant work was reported in [33],
where a group of mobile agents stays connected while achiev-
ing some performance objective. Traditionally, the control loopof each robot receives only local feedback from the controlled
robot and aims to achieve the desired tracking task without
responding to any other robots. With the proposed synchroniza-
tion control, the control loop of each robot receives feedback
from itself, as well as the others in trajectory tracking, which
is termed as the first task; meanwhile, it takes care of the other
robots to meet the formation requirement, which is termed as the
second task. In other words, under the synchronization control,
not only the convergence of the position errors to zero but how
these position errors converge to zero will also be considered at
the same time. A pure position control without synchronization
may succeed in the first task of the trajectory tracking but, in
1552-3098/$26.00 2009 IEEE
AlultIXDoM1a1UfIX Ra
-
8/13/2019 A Synchronization Approach to Trajectory Tracking of Multiple Mobile Robots While Maintaining Time-V-JL0
2/13
SUNet al.: SYNCHRONIZATION APPROACH TO TRAJECTORY TRACKING OF MULTIPLE MOBILE ROBOTS 1075
general, cannot guarantee accomplishment of the second task
of formation maintenance during the motion, due to the lack
of effort in synchronizing the robots motions. A pure position
control can only achieve the desired formation when the posi-
tion errors converge to zero but not during the whole motion.
In many applications, the robots are required to maintain the
desired formation during the whole motion period rather than
at the final time only. The proposed synchronization control
strategy is ideally suited to the formation tasks of underlying
trajectory controls of multiple mobile robots while following
desired time-varying formations.
The cross-coupling control technology provides advantages
and opportunities to design such a synchronized controller. Over
the past decades, the cross-coupling concept has been widely
used in multiaxis motion applications, such as reducing con-
touring errors of computer numerically controlled (CNC) ma-
chines [34][39]. The concept was also incorporated into adap-
tive control architecture to solve position synchronization of
multiple axes [40], [41]. The cross-coupling technology has
been used in robotics, such as controls of mobile robots [42]and robot manipulators [43]. Very recently, a combined synchro-
nization and tracking control law was reported in [44] and [45]
for multiple Lagrangian systems in a general setup that includes
complex configurations and different coupling links, such as di-
rectional couplings. To avoid the usage of the system dynamic
models, model-free cross-coupling controllers were introduced
in [46] and [47]. The effort to examine the stability and robust-
ness of the cross-coupled control system was reported in [48].
This paper has made the following contributions.
First, we successfully extend the synchronization approach to
formation control applications and pose the formation control
problem as a motion synchronization problem. As in [43], asynchronization control goal is determined first, based on the
formation requirement in the established robot network. Then,
we divide the motion control of each robot into two parts: One
is to drive the robot along the desired trajectory to achieve the
tracking control goal, which is defined as the first task, and
the other is to synchronize each robots motion with that of
two nearby robots to achieve the synchronization goal, which
is defined as the second task. To measure the synchronicity of
the networked robots, the concept of the synchronization error is
introduced as in [41] and[43], which is definedas the differential
position error between every pair of two neighboring robots.
Second, we develop a decentralized cross-coupled controller
for each robot to achieve its position tracking while synchro-nizing its motion with those of other robots for the desired
formation. The control algorithm utilizes feedback of both posi-
tion and synchronization errors, requires the information of the
two neighboring robots only, and responds to all linked robots
via the group network. It is proven that the proposed controller
can guarantee asymptotic convergence to zero of both position
and synchronization errors.
Third, simulations and experiments are performed on swarms
of mobile robots to demonstrate the effectiveness of the pro-
posed approach. A generalized superellipse with varying pa-
rameters is utilized to present a range of curves and, therefore,
establish a useful mathematic model to define time-varying for-
Fig. 1. Group of two-wheel mobile robots.
mations. The result for a skewed superellipse formation was
also reported in [49].
The advantages of applying our proposed synchronization
approach to the formation control are threefold. First, the syn-
chronization control goal is determined based on the desired
formation and is then divided into a number of subgoals foreach individual robot, without discrimination in job assignment.
The potential of robots capability is not overlooked. Also, the
formation strategy can be well prescribed. Second, a synchro-
nization controller can be constructed to guarantee asymptotic
convergence to zero of both position tracking and formation
errors in a decentralized architecture for time-varying forma-
tions. The controller consists of two parallel actions for both
trajectory tracking and formation, and the weighting of the two
actions is adjustable via tuning the control parameter. Third, the
synchronization controller can be simplified by synchronizing
the motion of each robot with that of two neighboring robots. In
other words, the control of each robot requires the informationof two nearby robots only.
II. MULTIROBOTFORMATION VIASYNCHRONIZATION
Fig. 1 illustrates a group of two-wheel mobile robots, where
qi = [ xi yi]T
denotes the position coordinate of theith robotinxyplane, andi denotes the heading angle. To simplify theanalysis, we assume that the center of the mass of each robot
locates at the geometrical center of the robot. In this way, the
centripetal and Coriolis effects are not considered in the robot
dynamics, and the robot is further simplified as a point mass
robot with the following dynamics:
Miqi = q i , Ii i =i (1)
whereMiandIidenote the inertia of the robot with fixed terms,and qi andi are torque control inputs with respect to qi andi , respectively.
Consider the control problem of guiding and positioning a
group ofn mobile robots, as shown in Fig. 1, along the boundary(curve) of a 2-D compact set. In a similar manner to [50], we
introduce a time-varying desired shape for each robot, which
is denoted by S(, t), where denotes a 2-D position vectorandt the time. The boundary ofS(, t) is parameterized by a2-D planar curve, which is denoted byS(, t) = 0. Assign the
target position qdi to the ith robot, and q
di must be located on
AlultIXDoM1a1UfIX Ra
-
8/13/2019 A Synchronization Approach to Trajectory Tracking of Multiple Mobile Robots While Maintaining Time-V-JL0
3/13
1076 IEEE TRANSACTIONS ON ROBOTICS, VOL. 25, NO. 5, OCTOBER 2009
the curve such thatS(qdi, t) = 0. Our objective is to determinethe appropriate control inputs for dynamics (1) such that the
ith robot converges to its target position qdi while maintainingits position in the desired shape S(, t). Note that althoughonly the position qi is explicitly controlled in the formation,
the orientationi affects the formation implicitly. In this study,the desired heading
d
i of the
ith robot is defined such that the
robot is always oriented toward the robots desired position qdi.
di keeps updated during the motion. When the robot is exactlylocated at its desired position, the desired heading di is the sameas the actual headingi , and no update is needed.
Define the position and heading errors of the ith robot asei =q
di qi andi =
di i , respectively. Besides the tra-
ditional robot control goal of ei 0 and i 0 as timet , the robots here are also required to achieve a formationcontrol goal of maintaining on the desired curve, which can be
formulated asqi , S(qi , t) = 0, wherei = 1, . . . , n.In this paper, we propose to utilize the synchronization control
concept to solve the formation control problem. The basic idea
of the synchronization control is to regulate the motions of therobots while they track the desired positions qdi to ensure the
robots to maintain in the required boundary (curve) such that
S(qi , t) = 0. Note that a pure position control for qi qdicannot guarantee the formation control goal to be achieved,
because the curveS(qi , t) = 0 is dependent on not only theposition qi but on the relative relationship ofqi as well, with
respect to the others at timet.To measure the synchronicity of the robots, we introduce the
concept of the position synchronization error, which arises from
the synchronization constraint, as required by the formation
goal.The following example will show howthis synchronization
constraint is determined based on the formation control goalS(qi , t) = 0. Another example was reported in [51].ExampleConsider thatnrobots are required to maintain in
an ellipse curve during the motions. The coordinate qi of the
ith robot is required to meet the following constraint:
S(qi , t) = 0 :qi (t) =
xi (t)
yi (t)
=
cos i (t)
sin i (t)
a(t)
b(t)
=Ai (t)
a(t)
b(t)
(2)
where a and b denote the longest and the shortest radii ofthe ellipse, respectively, and i = tanh (b sin i /a cos i ),withi = tanh [yi /xi ], denotes the angle of the robot lying on theellipse with respect to the center of the ellipse. Assume that the
robots are not located in the longest or the shortest axis of the
ellipse such that the inverse ofAiexists. Then, the synchroniza-tion constraint toqi can be derived as follows:
A11 q1 =A12 q2 = = A
1n qn =
a
b
. (3)
From the aforementioned example, it is seen that the synchro-
nization constraint can be generally represented in the form
c1q1 =c2q2 = = cnqn (4)
whereci denotes the coupling parameter of theith robot, and itsinverse exists based on (3). Further, (4) holds at all the desired
coordinatesqdi, namely
c1qd1 =c2q
d2 = = cnq
dn . (5)
Subtracting (4) from (5) yields the following synchronization
goal:
c1e1 =c2e2 = = cnen . (6)
Implicitly, (6) represents the formation control goal, which
can be further divided intonsubgoals ofciei =ci+1 ei+ 1 . Notethat wheni = n, we denoten+1 as 1.
Then, the position synchronization errors can be defined as
a subset of all possible pairs of two neighboring robots in the
following way [52]:
1 =c1e1 c2e2
2 =c2e2 c3e3
...
n =cnen c1e1 (7)
whereidenotes the synchronization error of theith robot. Ob-viously, if the synchronization error i = 0for alli= 1, . . . , n,the synchronization goal (6) is achieved automatically.
It is worth noting that thesynchronization error is used to mea-
sure the formation effect and is not equivalent to the position-
tracking error. For systems having closed-loop chain structures,
employment of the synchronization error provides each robot
with motion information both from itself and from the other
robots, and hence, the motions of all robots in the group arecoordinated.
Remark 1:The topology of the networked robots is designed
in terms of the robots physical positions in the group when
performing the group task. A principle that may be followed is
that the two physically close robots are coded as two neighbors
for easy sensorial connection. As a result, all robots in one group
are linked, either directly or indirectly, as a whole. Thenecessary
requirement for the applied shapeS(, t)is that the shape canbe represented mathematically such that the synchronization
constraint (4) can be given.
Remark 2: In some formations, the two neighborly coded
robots may be spatially far and, hence, not sensorially con-
nected. This usually happens when the formation shape is notgeometrically closed, e.g., in a line formation, the first robot
(robot 1) and the last robot (robot n) are far apart but codedas two neighbors. In case there exists a sensorial problem be-
tween these two robots, we can utilize a high-level planner (as
seen in Fig. 2) to globally localize the two robots such that
the two robots can know the information between each other.
Alternatively, we can also simply remove the direct synchro-
nization request between these two robots, since the two robots
synchronize with the other robots, respectively, and the whole
group of the robots are still linked as a whole. Removal of the
synchronization between the two robots can be mathematically
achieved by setting the synchronization error between these two
AlultIXDoM1a1UfIX Ra
-
8/13/2019 A Synchronization Approach to Trajectory Tracking of Multiple Mobile Robots While Maintaining Time-V-JL0
4/13
SUNet al.: SYNCHRONIZATION APPROACH TO TRAJECTORY TRACKING OF MULTIPLE MOBILE ROBOTS 1077
Fig. 2. Block diagram of the overall control architecture.
robots to zero. In the relevant work [33], sensorial connection
was analytically studied.
Now, the control problem becomes to drive both the position
errorei and the synchronization error i to zero. Theith robotcan be designed to approach its desired positionqdi while syn-
chronizing its motion with those of its two connected robots
i 1and i+ 1. In this way, the control of each robot does not
require the information of all robots except for its neighbors,and hence, the implementation is simplified.
III. CONTROLDESIGN
Fig. 2 illustrates a block diagram of a two-level control ar-
chitecture used for the formation control. In level 1, there is
a centralized high-level planer for task command generation,
task monitoring (such as detecting malfunctioned robots and
responding), and global localization of the robots. In level 2,
there are decentralized servo controls of the robots and senso-
rial connection among them. Between the two levels is a data
server. Obviously, these two levels have different functions in
accomplishing complex formation control tasks.This section will focus on the decentralized servo controls of
the robots in level 2. A synchronous tracking controller for the
robots translation is developed. The robots orientation is con-
trolled to be always oriented toward the robots desired position.
The issue of how the robot group responds to the malfunctioned
robot will also be discussed briefly at the end of this section.
Without loss of generality, we assume that each robot can obtain
the position information of its two nearby robots, via global or
local localization in the two-level control frame, as shown in
Fig. 2. The relevant works on localization (such as ours [53])
have been reported in the literatures.
A. Synchronous Formation Controller
To make the position and synchronization errors ei and iboth converge to zero, we define a coupled position error Eithat links these two errors into one equation, i.e.,
Ei =ciei +
t0
(i i1 ) d (8)
whereis a diagonal positive gain matrix. As is seen from (7)and (8), this coupled position error for robot i feeds back theinformation of the two neighboring robotsi 1andi+ 1. Note
that wheni = 1, we denotei 1asn.
DifferentiatingEi with respect to time yields
Ei = ciei + ciei+ (i i1 ) . (9)
To achieve Ei 0 and Ei 0, we introduce a commandvectorui that leads to a combined position and velocity error,
which is expressed as follows:
ui =ciqdi + ciei+ (i i1 ) + Ei (10)
where is a diagonal positive gain matrix. Definition ofui in(10) leads to the following position/velocity vectors:
ri =ui ciqi =ciei+ ciei + (i i1 ) + Ei
= Ei + Ei . (11)
We then design a controller to drive ri to zero, such that
the coupled errors Ei and Ei tend to zero as well. For easyimplementation, such a controller is ideally designed in a de-
centralized architecture, thus considering the synchronization
between each robot and its two neighbors only.
We finally design a torque input for controlling the robots
translation as follows:
qi= Mi c1i (ui ciqi) + Kr i c
1i ri+ c
Ti K (i i1 ) (12)
whereKr i andK are positive feedback control gains. The lastterm in (12) is used to compensate for the effect due to addition
of the cross-coupling control to the overall system dynamics.
The necessity of introducing this term will be shown in the
stability analysis.
Substituting (12) into the robot translational dynamics in (1)
yields the following closed-loop dynamics:
Mi c1i ri+ Kr i c
1i ri + c
Ti K (i i1 ) = 0. (13)
Theorem 1:The proposed synchronous controller (12) leadsto asymptotic convergence of both the position tracking and syn-
chronization errors to zero, namely, ei 0 and i 0as timet , under the conditions that the control gain Kri is largeenough to satisfy mi n(Kr i ) ma x
Mi (d/dt)
c1i
ci
,
where mi n()and ma x()denote the minimum and maximumeigenvalues of the matrices, respectively.
Proof:Define a Lyapunov function candidate as
V =n
i=1
1
2
c1i ri
TMi c
1i ri+
1
2
Ti Ki
+
ni=1
1
2 t
0(i i1 ) d
TK
t0
(i i1 ) d.
(14)
DifferentiatingVwith respect to time yields
V =n
i=1
c1i ri
TMi c
1i ri+
c1i ri
TMi
d
dt
c1i
ri
+Ti Ki
+n
i= 1
(i i1 )TK
t
0
(i i1 ) d. (15)
AlultIXDoM1a1UfIX Ra
-
8/13/2019 A Synchronization Approach to Trajectory Tracking of Multiple Mobile Robots While Maintaining Time-V-JL0
5/13
1078 IEEE TRANSACTIONS ON ROBOTICS, VOL. 25, NO. 5, OCTOBER 2009
Multiplying both sides of (13) by
c1i riT
yields
c1i ri
TMi c
1i ri+
c1i ri
TKr i c
1i ri+ r
Ti K(i i1 )
= 0. (16)
Substituting (16) into (15) yields
V =n
i=1
c1i ri
T Kr i Mi
d
dt
c1i
ci
c1i ri
n
i=1
rTi K(i i1 )
+
ni=1
Ti Ki
+n
i=1
(i i1 )TK
t0
(i i1 ) d. (17)
We now analyze the termn
i= 1rTi K(i i1 )in (17). It
directly follows that
ni= 1
rTi K(i i1 )
=rT1K1 rT1Kn + r
T2K2 r
T2K1
+ rTnKn rTnKn 1
=rT1K1 rT2K1 + r
T2K2 r
T3K2
+ rTnKn rT1Kn
=
ni=1
(ri ri+ 1 )T Ki . (18)
Utilizing (7)(9) and (11), we have
ri ri+1
= Ei + Ei Ei+1 Ei+1
= ciei+ ciei ci+ 1ei+1 ci+1 ei+ 1+ (2i i1 i+ 1 )
+ (ciei ci+1 ei+ 1 ) +
t0
(2i i1 i+1 ) d
= i + (2i i1 i+ 1 ) + i
+
t0
(2i i1 i+ 1 ) d. (19)
Then, substituting (19) into (18) yields
ni= 1
rTi K(i i1 )
=
ni= 1
Ti Ki +
ni= 1
Ti Ki
+
ni=1
(i i+1 )TK(i i+1 )
+n
i=1
(i i+1 )TK
t
0
(i i1 ) d. (20)
In (20), we utilize the result that
ni=1
(2i i1 i+ 1 )Ti =
ni= 1
(i i+ 1 )T (i i+1 ).
Finally, substituting (20) into (17) and utilizing the condition
of Theorem 1, we have
V n
i=1
c1i ri
Tm in (Kr )
ma x
Mi
d
dt
c1i
ci
c1i ri
n
i= 1
Ti Ki
ni= 1
i i+1
TK (i i+1 )
0. (21)
It is thus concluded that the defined Lyapunov function (14)
has negative semidefinite time derivative. From (21), we know
that ri and i are bounded. From (13), we know that ri isbounded. From (19), we know that i is bounded. Therefore, riand i are uniformly continuous since ri and i are bounded.Then, from Barbalats lemma, ri 0 and i 0 as timet . The synchronization goal (6) is achieved.
We now prove ei = 0 when ri = 0 and i = 0. From (11),ri = 0implies Ei = 0whent . Combining all equationsin (8) from 1 ton, we have
c1e1 + c2e2 + +cnen = 0. (22)
Substituting (6) into (22) yields c1e1 =c2e2 = =cnen = 0. Since the inverse of ci exists, ei = 0. Therefore,
Theorem 1 is proved. It appears that the control parametersin (8) andK in (12)
dominate the control of the synchronization error. As seen in
(8), the value ofdetermines the weight of the synchroniza-tion error i in the coupled position error Ei and, thus, affects
the synchronization effort in the whole control action. As increases, the synchronization will be enhanced. In practical
applications,should be chosen by taking a balance betweenposition and synchronization controls. The parameter K , ac-companied by i i1 in (12), ensures the stability of thesystem when adding the cross-coupling control with to theoverall system dynamics. It will be further discussed how to
get the desired boundedness of the synchronization error by
adjustingK in Section III-B.To control the robots heading, we propose to utilize a general
computed torque approach to design of the control input i , i.e.,
i =Ii
di +kv i i + kpi i
(23)
wherekv i andkpi are computed torque control gains. The de-sired headingdi, as said before, is defined such that the robot isalways oriented toward its desired position. In other words, the
orientation control serves to achieve the robots translation.
Substituting (23) into the robot rotational dynamics in (1)
yields the closed-loop dynamics as follows:
i+ kv i i+ kpi i = 0. (24)
AlultIXDoM1a1UfIX Ra
-
8/13/2019 A Synchronization Approach to Trajectory Tracking of Multiple Mobile Robots While Maintaining Time-V-JL0
6/13
SUNet al.: SYNCHRONIZATION APPROACH TO TRAJECTORY TRACKING OF MULTIPLE MOBILE ROBOTS 1079
This directly yields i = 0 and i = 0 as time t and guarantees the stability properties of the rotation.
Remark 3: If robot i malfunctions, e.g., lags much behindon its trajectory, the other robots will respond under the syn-
chronization control. The centralized high-level planar in level
1 will monitor the task and make the decision whether robot iis
still suitable to remain in the team. The decision making will bebased on the facts whether the robot loses capabilities to execute
the task (i.e., drive the position error to zero) and communicate
with the other robots. If robot i has to be abandoned by theteam, the other robots will treat robot i as a virtual robot andassume its position error to be zero in the follow-on motion.
In this way, the remaining robots can still follow the previous
network topology.
B. Discussions
Two issues are further discussed in this section. One is the
boundedness on the formation error. Another is the robustness
achieved by adaptive synchronization control.1) Boundedness: We now analyze the boundedness through-
out the transient response. Given a upper bound on the formation
error, in the following, we will discuss the lower bound on the
control parameter that achieves the desired upper bound on the
error.
Since the system is asymptotically stable, as concluded from
Theorem 1, given an upper bound i on i , there exists a finite
timeT >0 such that after t > T, one hasi (t) i . Inaddition, att = T
V(T) =n
i= 1 1
2 c1i (T)ri (T)
TMi c
1i (T)ri (T)
+
ni= 1
1
2
Ti (T)Ki (T)
+n
i= 1
1
2
T0
(i i1 ) d
T
K
T0
(i i1 ) d (25)
which is bounded. If we define the first term on the right-hand
side of (25) as A, it then follows from (25) that
V(T) A
=
ni= 1
1
2
Ti (T)Ki (T)
+n
i= 1
1
2
T0
(i i1 ) d
TK
T0
(i i1 ) d
n
i= 1
1
2K i
2
+
ni= 1
1
2K (2 i T)
2
=K 1
2+ 2 T2
n
i= 1
i 2
. (26)
Finally, the lower bound forK can be determined as
K V(T) A
12
+ 2 T2n
i=1 (i 2 )
. (27)
2) Adaptive Control for Robustness: In the controller (12),
the robot inertia Mi is assumed to be known. In practice, the
inertia Mi may be uncertain. Define Mi (t) as the estimate ofthe robot inertiaMi . An adaptive control can be designed as
qi = Mi (t)c1i (ui ciqi ) +Kr i c
1i ri+ c
Ti K (i i1 ).
(28)
The estimated inertia Mi (t)is subject to the adaptation law
Mi (t) = i c
1i (ui ciqi )c
1i ri (29)
wherei is a diagonal positive-definite control gain. Define theestimation error as
Mi (t) =Mi Mi (t). (30)
Then, the adaptive control law can be rewritten as
Mi (t) =i c1i (ui ciqi )c
1i ri . (31)
Substituting the controller (28) into the robot dynamics model
leads to the following closed-loop dynamics:
Mi c1i ri + Kr i c
1i ri+ c
Ti K (i i1 )
= Mi (t)
c1i (ui ciqi )
. (32)
In a similar manner to Theorem 1 and [43], we can prove that
the aforementioned adaptive control law leads to asymptotic
convergence to zero of both the position tracking and synchro-
nization errors.
The aforementioned analysis indicates that an adaptive con-
trol can be well incorporated into the developed synchronization
scheme. Although only inertia uncertainty is discussed here, the
method can be extended to the cases with more complex mod-
eling uncertainty and/or some external disturbances.
IV. SIMULATIONS
Simulations were performed first to verify the effectiveness
of the proposed synchronization control approach. It is assumed
that all the required formations are composed of regular closed,
smooth, and simple planar curves. A generalized superellipsewith varying parameters, as seen later, is used to represent dif-
ferent kinds of formation curvesxia
2/m + yib
2/m = 1 (33)which can also be represented as
xi =a cosm i
yi =b sinm i
(34)
wheremdenotes the exponent index that may be time-varying,and a, b, and i have been defined in (2). In the simulations,
i is fixed, and its value can be known at the beginning. Based
AlultIXDoM1a1UfIX Ra
-
8/13/2019 A Synchronization Approach to Trajectory Tracking of Multiple Mobile Robots While Maintaining Time-V-JL0
7/13
1080 IEEE TRANSACTIONS ON ROBOTICS, VOL. 25, NO. 5, OCTOBER 2009
Fig. 3. Switch from an ellipse to a rounded rectangle.
oni , each robot can be indexed. Besides the exponent m, thevariation of radiia and b also affects the curve significantly. Astudy on switch between two different ellipses with exchanged
radiiaandb was reported in [32].With different exponent m, (33) and (34) represent a range
of shapes including rectangles, ovals, ellipses, and diamonds, in
categories of hyperellipses (m < 1) and hypoellipses (m >1).The following simulation study will consider a switch from an
ellipse (m0 = 1) to a rounded rectangle(mf = 1/8), as seen inFig. 3, wherea andb are fixed.
In the simulation, there are in total 20 mobile robots, which
are denoted by little squares in Fig. 3, all located on an ellipse
curve at the beginning time. During the switch, all the robots
are required to maintain in a desired time-varying hyperellipse
curve, with the exponent index changed in the following way:
m(t) =m0 + (mf m0 )
1 et
(35)
wherem0 = 1andmf = 1/8denote the initial and final valuesof the exponent index. All the 20 robots have different inertia
Mi , which is expressed by Mi = diag{0.5 + 0.075i, 0.5 +0.075i}, wherei = 1, . . . , 20.
The desired trajectory of the ith robot is designed accordingto the required formation task (34) and is given as
qdi(t) =
xdi(t)
ydi(t)
=
cosm (t) i
sinm (t) i
a
b
=Ai (t)
a
b
. (36)
The coupling parameter matrix was then defined as
ci (t) =A1i (t) =
cosm (t) i
sinm (t) i
1. (37)
The sampling period was set to 0.005 s in the simulation.
Two control algorithms were applied in the simulation for
comparison purpose: One was the proposed synchronous con-
Fig. 4. Formation switchfroman ellipse toa rounded rectangleandtrajectoriesof robots, with synchronous control.
trol (12), and the other was the nonsynchronous control by re-
moving all kinds of coupling among the robots in the controller,
which was equivalent to a standard feedforward plus a feedback
control. The control parameters of the synchronous controller
(12) were chosen as = diag{15, 15}, = diag{35, 35},K = diag{10, 10}, andKr i = diag{120, 120}. To implementthe nonsynchronous control, the control parameters were chosen
as = diag{0, 0}, = diag{35, 35}, K = diag{0, 0}, andKri = diag{120, 120}. Note that the same coupling parametermatrix ciwas used to calculate the synchronization error in bothcases for a fair comparison.
Fig. 4 illustrates the actual formation shapes and the trajec-tories of the robots in the switch from the initial ellipse to the
final rounded rectangle under the synchronous control. Fig. 5(a)
and (b) illustrates the position and synchronization errors inx-and y-direction of the 20 robots under the proposed synchronouscontrol. Both the position and synchronization errors grow from
zero up to some nonzero values and, subsequently, decrease and
converge to zero upon reaching thefinal desired formation. Fig. 6
illustrates the results of the nonsynchronous control. It is seen
that the robots have large transient synchronization errors under
nonsynchronous control, which degrades the performance of
the formation. With the proposed synchronous control, the syn-
chronization errors are greatly reduced, and therefore, a better
formation can be achieved.We further study how the robot group responds to a particular
robot that is observed to malfunction. Assume that robot 18 was
found to lag much behind its desired trajectory soon after the
task started. Due to the use of synchronization control, all the
other robots had to slow down to wait for this robot to catch the
team. After recognizing that robot 18 could not resume working
properly, the group decided to abandon this robot at 0.75 s. The
remaining 19 robots then continued the movement and treated
robot 18 as a virtual robot with an assumption that its position
error was zero. Fig. 7(a) and (b) illustrates the position and
synchronization errors of the case. It is seen that due to failure
of robot 18, the position and synchronization errors of all the
AlultIXDoM1a1UfIX Ra
-
8/13/2019 A Synchronization Approach to Trajectory Tracking of Multiple Mobile Robots While Maintaining Time-V-JL0
8/13
SUNet al.: SYNCHRONIZATION APPROACH TO TRAJECTORY TRACKING OF MULTIPLE MOBILE ROBOTS 1081
Fig.5. Results of synchronouscontrol.(a) Positionerrors. (b) Synchronizationerrors.
robots in the group increased significantly until robot 18 was
abandoned after 0.75 s.
V. EXPERIMENTS
We further carried out experiments on a group of three mobile
robots to verify the proposed synchronous control method. The
three robots are P3DX mobile robots, as shown in Fig. 8. The
control inputs qi and i were obtained by the inputs actingon the left and the right driving wheels, which are denoted by
li and r i , as given in the Appendix. The experiments were
performed in two cases.
A. Case 1: Triangle Formation
In this case, the three robots were controlled to maintain a se-
ries of equilateral triangles. The three robots were located at the
three vertices of the equilateral triangle. Define a circumcircle
that connects the three vertices of the triangle. The center of the
circumcircle locates at the geometrical central point of the tri-
angle. The switch among the equilateral triangles was modeled
as the switch among the circumcircles with time-varying radius
and orientation, as shown in Fig. 9. Taking reference of (2), the
coordinateqi of theith robot, wherei = 1, . . . , 3, was subject
Fig. 6. Results of nonsynchronous control. (a) Position errors. (b) Synchro-nization errors.
to the following constraint:
S(qi , t) = 0 :qi (t) =
xi (t)
yi (t)
=
cos i (t)
sin i (t)
R(t)
R(t)
=Ai (t)
R(t)
R(t)
(38)
whereR(t) is the time-varying radius of the circumcircle, andi (t)was defined in (2). Since a = b = R(t),i (t) =i .
In the experiment, both the size and the orientation of the
triangle were changed by varying R(t)and i (t), respectively.R(t)was scheduled to change in the following way:
R(t) =R0 + (Rf R0 ) t
t+e1t (39)
where R0 and Rf denote the initial and the final radii of thecircumcircle and were chosen asR0 = 2.4 mandRf = 4.8 m,respectively.i (t)was scheduled to change as
i (t) =i0 + (if i0 ) t
t+e1t (40)
where i0 and if are the initial and the final values for theith robot and were chosen as10 = 0
,1f= 120,20 = 0
,
2f =120, and 30 = 0
, 3f = 0. After system calibra-
tion, the inertia of each robot was estimated as 1.8 kgm2
.
AlultIXDoM1a1UfIX Ra
-
8/13/2019 A Synchronization Approach to Trajectory Tracking of Multiple Mobile Robots While Maintaining Time-V-JL0
9/13
1082 IEEE TRANSACTIONS ON ROBOTICS, VOL. 25, NO. 5, OCTOBER 2009
Fig. 7. Results when dealing with the failed robot. (a) Position errors.(b) Synchronization errors.
Fig. 8. Three mobile robots in the experiment.
Define the coupling parameter matrix as
ci (t) =A1i (t) =
cos i (t)sin i (t)
1
.
Fig. 9. Switch among triangle formations.
The sampling time period was chosen as 200 ms. The control
parameters used in the synchronous controller are
= diag{1, 1}, = diag{2, 2}, K = diag{5, 5}
Kr1 = diag{5, 5}, Kr 2 = diag{5, 5}, Kr 3 = diag{5, 5}.
As in the simulations, two control algorithms of the pro-
posed synchronous control (12) and the nonsynchronous con-
trol were implemented, respectively. To implement the non-
synchronous controller, the coupling among the robots was re-
moved, and the parameters were chosen as = diag{0, 0}andK = diag{0, 0}, and and Kr i were the same as in the syn-chronous case. Note that the same coupling parameter ci wasused to calculate the synchronization error for both the syn-
chronous and nonsynchronous cases. The robots were localized
based on their initial positions and the moving distances mea-
sured by the motor encoders.
The right-hand side of Fig. 9 illustrates the legend of the tri-
angle formation change in the experiment. Fig. 10 illustrates
the position and synchronization errors of the three robots inx- and y-direction, respectively, under the proposed synchro-nization control (12). Fig. 11 illustrates the position and syn-
chronization errors of the robots under the nonsynchronous
control. It is seen that both the control methods could ensure
good convergence of the robot position errors. The synchro-
nization errors under the synchronous controller were much
smaller than those under the nonsynchronous controller. The
synchronization errors actually represent the formation errors.
Fig. 12 illustrates the heading angle errors of the three robots
under the computed torque controller (23), where the control
gains wereKp1 = diag{10, 10}, Kp2 = diag{10, 10}, Kp 3 =
diag{10, 10}, Kv 1 = diag{10, 10}, Kv 2 = diag{10, 10}, andKv 3 = diag{10, 10}. Fig. 13 illustrates the control inputs liandr i on the two wheels of each robot, respectively, under thesynchronous control.
B. Case 2: Ellipse Formation
To further verify the robustness of the proposed adaptive
synchronization control (28) and (29) to the model uncertainty,
the three robots were controlled to form a part of ellipse (see
Fig. 14) and then switch among a series of ellipse formations.
At the beginning, the robots were in a straight line with the
same heading angle, as shown on the left-hand side of Fig. 15.
Then, the robots spread out to explore a series of formations
AlultIXDoM1a1UfIX Ra
-
8/13/2019 A Synchronization Approach to Trajectory Tracking of Multiple Mobile Robots While Maintaining Time-V-JL0
10/13
SUNet al.: SYNCHRONIZATION APPROACH TO TRAJECTORY TRACKING OF MULTIPLE MOBILE ROBOTS 1083
Fig. 10. Synchronous control results. (a) Position errors. (b) Synchronizationerrors.
that are all part of ellipses. The coordinate qi of theith robot issubject to (2). The longest and the shortest radii of the ellipse
were changed as
a(t) =a0 + (af a0 ) t
t+e1t (41)
b(t) =b0 + (bf b0 ) tt+e1t
(42)
wherea0 = 3 mand af = 5 mare the initial and the final de-sired longest radii of the ellipse, and b0 = 1 m andbf = 3 mare the initial and the final desired shortest radii of the ellipse.
In the experiment, leti [as defined in (2)] change to
i (t) =i0 + (if i0 ) t
t+e1t (43)
where we chose 10 = 30, 1f = 75
, 20 = 0, 2f =25
,
and30 =30,3f =75
. All inertias of the robots were
estimated to be zero at the beginning. Define the same cou-
pling coefficient as in case 1. The control gains were chosen as
Fig. 11. Nonsynchronous control results. (a) Position errors. (b) Synchroniza-tion errors.
Fig. 12. Heading angle errors of the three robots.
AlultIXDoM1a1UfIX Ra
-
8/13/2019 A Synchronization Approach to Trajectory Tracking of Multiple Mobile Robots While Maintaining Time-V-JL0
11/13
1084 IEEE TRANSACTIONS ON ROBOTICS, VOL. 25, NO. 5, OCTOBER 2009
Fig. 13. Control torques.
Fig. 14. Three robots in an ellipse.
Fig. 15. Switch among formations.
Fig. 16. Adaptive synchronous control results. (a) Position errors. (b) Syn-chronization errors.
follows:
= diag{1, 1}, = diag{1.3, 1.3}, K = diag{1, 1}
Kr 1 = diag{10, 10}, Kr2 = diag{10, 10}
Kr 3 = diag{10, 10}, i = diag{0.1, 0.1}.
The sampling time period was 200 ms.
The right-hand side of Fig. 15 illustrates the legend of the
ellipse formation change in the experiment. Fig. 16 illustrates
good convergence of the position and synchronization errors
of the three robots under the proposed adaptive synchronous
control, although all inertias of the robots were assumed to be
unknown. These results demonstrate the validity of incorpora-
tion of adaptive control into synchronization approach to solve
the model uncertainty problem.
AlultIXDoM1a1UfIX Ra
-
8/13/2019 A Synchronization Approach to Trajectory Tracking of Multiple Mobile Robots While Maintaining Time-V-JL0
12/13
SUNet al.: SYNCHRONIZATION APPROACH TO TRAJECTORY TRACKING OF MULTIPLE MOBILE ROBOTS 1085
VI. CONCLUSION
This paper presents a synchronization control approach to
controlling swarms of mobile robots to track the desired trajec-
tories while synchronizing the motions among them to maintain
relative kinematics relationships, as required by the formation.
The formation control problem is successfully posed as a syn-
chronization control problem. The concept of the position syn-chronization error, which is defined as differential position error
between every pair of two neighboring robots, is introduced to
measure the performance of the formation. The proposed syn-
chronous controller guarantees asymptotic convergence to zero
of both position and synchronization errors of each robot in
translation. A rotary controller drives the robot to always be
oriented toward its desired position. Both simulation and ex-
perimental studies are finally performed to demonstrate the ef-
fectiveness of the proposed approach. The future work includes
incorporation of the robot nonholonomic dynamics into the syn-
chronization control, topology design of the networked robots,
and a study on robustness to the environmental uncertainties.
APPENDIX
Define the torque inputs acting on the left and the right driving
wheels of theith robot asli and r i . The transformation matrixfrom (li ,r i ) to (qi ,i ) is expressed as
Bi (i ) = 1
d
cos i cos i
sin i sin i
R R
(44)
wheredandRhave been shown in Fig. 1. Based on Bi (i ),qiandi can be derived as
qi =
qi (x)
qi (y)
=
cos
r (li + ri )
sin
r (li + r i )
(45)
i =R
r(li r i ). (46)
The inverse relationship from (qi ,i ) to (li ,r i ) can beobtained by
li = r
2qi (x)
cos
+i
R
r i = r
2
qi (x)
cos
iR
(47)
or
li = r
2
qi (y)
sin +
iR
r i = r
2
qi (y)
sin
iR
. (48)
To avoid singularity, (47) should be used when i is aroundzero or 180, and (48) should be used wheni is around 90
or
270
.
REFERENCES
[1] D. Fox, W. Burgard, H. Kruppa, and S. Thrun, A probabilistic approachto collaborative multi-robot localization, Auton. Robots, vol. 8, no. 3,pp. 325344, Jun. 2000.
[2] T. Balch and R. Arkin, Behavior-based formation control for multi-robotsystems, IEEE Trans. Robot. Autom., vol. 14, no. 6, pp. 926939, Dec.1998.
[3] H. G. Tanner, S. G. Loizou, and K. J. Kyriakopoulos, Nonholonomic
navigation and control of multiple mobile manipulators, IEEE Trans.Robot. Autom., vol. 19, no. 1, pp. 5364, Feb. 2003.
[4] M. Mesbahi and F. Hadaegh, Formation flying of multiple spacecraft viagraphs, matrix inequalities, and switching, AIAA J. Guid., Control, Dyn.,vol. 24, pp. 369377, Mar. 2001.
[5] C. R. McInnes, Autonomous ring formation for a planar constellation ofsatellites, AIAA J. Guid., Control, Dyn., vol. 18, no. 5, pp. 12151217,1995.
[6] F. Giulietti, L. Pollini, and M. Innocenti, Autonomous formation flight,IEEE Control Syst. Mag., vol. 20, no. 6, pp. 3444, Jun. 2000.
[7] D. J. Stilwell and B. E. Bishop, Platoons of underwater vehicles, IEEEControl Syst. Mag., vol. 20, no. 6, pp. 4552, Dec. 2000.
[8] J. R. T. Lawton, R. W. Beard, and B. J. Young, A decentralized approachto formation maneuvers, IEEE Trans. Robot. Autom., vol. 19, no. 6,pp. 933941, Dec. 2003.
[9] L. E. Parker, ALLIANCE: An architecture for fault tolerant multirobot
cooperation, IEEE Trans. Robot. Autom., vol. 14, no. 2, pp. 220240,Apr. 1998.[10] S. Berman, Y. Edan, and M. Hamshidi, Navigation of decentralized au-
tonomous automatic guided vehicles in material handling, IEEE Trans.Robot. Autom., vol. 19, no. 4, pp. 743749, Aug. 2003.
[11] M. Long, A. Gage, R. Murphy, and K. Valavanis, Application of thedistributed field robot architecture to a simulated deming task, in Proc.
IEEE Int. Conf. Robot. Autom., Barcelona, Spain, Apr. 2005, pp. 32043211.
[12] H. Takahashi, H. Nishi, and K. Ohnishi, Autonomous decentralized con-trol for formation of multiple mobile robots considering ability of robot,
IEEE Trans. Ind. Electron., vol. 51, no. 6, pp. 12721279, Dec. 2004.[13] M. A. Lewis and K. H. Tan, High precision formation control of mobile
robots using virtual structures, Auton. Robot., vol. 4, pp. 387403, 1997.[14] M. Egerstedt and X. Hu, Formation constrained multi-agent control,
IEEE Trans. Robot. Autom., vol. 17, no. 6, pp. 947951, Dec. 2001.[15] R. W. Beard, H. Lawton, and F. Y. Hadaegh, A coordination architecture
for spacecraft formation control, IEEE Trans. Control Syst. Technol.,vol. 9, no. 6, pp. 777790, Nov. 2001.
[16] W. Kang, N. Xi, and A. Sparks, Formation control of autonomous agentsin 3D workspace, inProc. IEEE Int. Conf. Robot. Autom., San Francisco,CA, Apr. 2000, pp. 17551760.
[17] J. P. Deasi, V. Kumar, and P. Ostrowski, Modeling and control of for-mations of nonholonomic mobile robots, IEEE Trans. Robot. Autom.,vol. 17, no. 6, pp. 905908, Dec. 2001.
[18] A. K. Das, R. Fierro, V. Kumar, J. P. Ostrowski, J. Spletzer, and C. J.Taylor, A vision-based formation control framework, IEEE Trans.
Robot. Autom., vol. 18, no. 5, pp. 813825, Oct. 2002.[19] J. Huang, S. M. Farritor, A. Qadi, and S. Goddard, Localization and
follow-the-leader control of a heterogeneous group of mobile robots,IEEE/ASME Trans. Mechatron., vol. 11, no. 2, pp. 205215, Apr. 2006.
[20] J. Chen, D. Sun, J. Yang, and H. Chen, A leader-follower formationcontrol of multiple nonholonomic mobile robots incorporating receding-
horizon scheme, Int. J. Robot. Res., vol. 28, 2009.[21] P. Ogren, E. Fiorelli, and N. E. Leonard, Cooperative control of mobilesensor networks: Adaptive gradient climbing in a distributed environ-ment, IEEE Trans. Autom. Control, vol. 40, no. 8, pp. 12921302, Aug.2004.
[22] R. Sepulchre, D. Paley, and N. E. Leonard, Stabilization of planar col-lective motion: All-to-all communication, IEEE Trans. Autom. Control,vol. 52, no. 5, pp. 811824, May 2007.
[23] J. A. Fax and R. M. Murray, Information flow and cooperative controlof vehicle formations, IEEE Trans. Autom. Control, vol. 49, no. 9,pp. 14651476, Sep. 2004.
[24] A. Jadbabaie, J. Lin, and A. S. Morse, Coordination of groups of mobileautonomous agents using nearest neighbor rules, IEEE Trans. Autom.Control, vol. 48, no. 9, pp. 9881001, Sep. 2003.
[25] L. Moreau, Stability of multiagent systems with time-dependent commu-nication links, IEEE Trans. Autom. Control, vol. 50, no. 2, pp. 169182,Feb. 2005.
AlultIXDoM1a1UfIX Ra
-
8/13/2019 A Synchronization Approach to Trajectory Tracking of Multiple Mobile Robots While Maintaining Time-V-JL0
13/13
1086 IEEE TRANSACTIONS ON ROBOTICS, VOL. 25, NO. 5, OCTOBER 2009
[26] R. Olfati-Saber and R. M. Murray, Consensus problems in networks ofagents with switching topology and time-delays, IEEE Trans. Autom.Control, vol. 49, no. 9, pp. 101115, Sep. 2004.
[27] R. Olfati-Saber, Flocking for multi-agent dynamic systems: Algorithmsand Theory, IEEE Trans. Autom. Control, vol. 51, no. 3, pp. 401420,Mar. 2006.
[28] W. Ren and R. W. Beard, Consensus seeking in multi-agent systemsunder dynamically changing interaction topologies,IEEE Trans. Autom.Control, vol. 50, no. 5, pp. 655661, May 2005.
[29] C. Belta and V. Kumar, Optimal motion generation for groups of robots:A geometric approach, ASME J. Mech. Des., vol. 126, pp. 6370, 2004.
[30] J. C. Derenick and J. R. Spletzer, Convex optimization strategies forcoordinating large-scale robot formations, IEEE Trans. Robot., vol. 23,no. 6, pp. 12521259, Dec. 2007.
[31] Y. Koren, Cross-coupled biaxial computer controls for manufacturingsystems, ASME J. Dyn. Syst., Meas., Control, vol. 102, pp. 265272,1980.
[32] D. Sun and C. Wang, Controlling swarms of mobile robots for switchingbetween formations using synchronization concept, in Proc. IEEE Int.Conf. Robot. Autom., Rome, Italy, Apr. 2007, pp. 23002305.
[33] M. Ji and M. Egerstedt, Distributed coordination control of multi-agentsystems while preserving connectedness, IEEE Trans. Robot., vol. 23,no. 4, pp. 693703, Aug. 2007.
[34] A. Rodriguez-Angeles and H. Nijmeijer, Mutual synchronization ofrobots viaestimated statefeedback: A cooperativeapproach, IEEETrans.
Control Syst. Technol., vol. 12, no. 4, pp. 542554, Jul. 2004.[35] Q. Zhong, Y. Shi, J. Mo, and S. Huang, A linear cross coupled controlsystem for high speed machining, Int. J. Adv. Manuf. Technol., vol. 19,pp. 558563, 2002.
[36] S. S. Yeh and P. L. Hsu, Estimation of the contouring error vector for thecross-coupled control design, IEEE/ASME Trans. Mechatron., vol. 7,no. 1, pp. 4451, Mar. 2002.
[37] M.T.Yan, M.H. Lee, andP. L. Yen,Theoryandapplication ofa combinedself-tuning adaptive control and cross coupling control in a retrofit millingmachine, Mechatron., vol. 15, no. 2, pp. 193211, Mar. 2005.
[38] T. C. Chiu and M. Tomizuka, Contouring control of machine tool feeddrive systems: A task coordinate frame approach, IEEE Trans. ControlSyst. Technol., vol. 9, no. 1, pp. 130139, Jan. 2001.
[39] D. Sunand M. C. Tung,A synchronization approach forthe minimizationof contouring errors of CNC machine tools, IEEE Trans. Autom. Sci.
Eng., vol. 6, no. 4, Oct. 2009.[40] M. Tomizuka, J. S. Hu, and T. C. Chiu, Synchronization of two motion
control axes under adaptive feedforward control, ASME J. Dyn. Syst.,Meas., Control, vol. 114, no. 2, pp. 196203, 1992.
[41] D. Sun, Position synchronization of multiple motion axes with adaptivecoupling control, Automatica, vol. 39, no. 6, pp. 9971005, Jun. 2003.
[42] L. Feng, Y. Koren, and J. Borenstein, Cross-coupling motion controllerfor mobile robots, IEEE Control Syst., vol. 13, no. 6, pp. 3543, Dec.1993.
[43] D. Sun and J. K. Mills, Adaptive synchronized control for coordinationof multi-robot assembly tasks, IEEE Trans. Robot. Autom., vol.18, no. 4,pp. 498510, Aug. 2002.
[44] S. J Chung and J. J. E. Slotine, Cooperative robot control and concurrentsynchronization of Lagrangian systems, IEEE Trans. Robot., vol. 25,no. 3, pp. 686700, Jun. 2009.
[45] S. J.Chung, U.Ahsun, andJ. J. E. Slotine, Applicationof synchronizationto formation flying spacecraft: Lagrangian approach, AIAA J. Guid.,Control Dyn., vol. 32, no. 2, pp. 512526, Sep. 2008.
[46] Y. Koren and C. C. Lo, Variable-gain cross-coupling controller for con-touring, Ann. CIRP, vol. 40, no. 1, pp. 371374, 1991.[47] D. Sun, X. Y. Shao, and G. Feng, A model-free cross-coupled control for
positionsynchronizationof multi-axis motions:Theory andExperiments,IEEE Trans. Control Syst. Technol., vol. 15,no. 2, pp.306314, Mar. 2007.
[48] S. Yeh and P. Hsu, Analysis and design of integrated control for multi-axis motion systems, IEEE Trans. Control Syst. Technol., vol. 11, no. 3,pp. 375382, May 2003.
[49] D. A. Paley, N. E. Leonard, and R. Sepulchre, Stabilization of symmetricformations to motion around convex loops, Syst. Control Lett., vol. 57,pp. 209215, 2008.
[50] M. Y. Hsieh and V. Kumar, Pattern generation with multiple robots, inProc. IEEE Int. Conf. Robot. Autom., May 2006, pp. 24422447.
[51] Y. Su, D. Sun, L. Ren, and J. K. Mills, Integration of saturated PI syn-chronous control and PD feedback for control of parallel manipulators,
IEEE Trans. Robot., vol. 22, no. 1, pp. 202207, Feb. 2006.[52] D. Sun, L. Ren, J. K. Mills, and C. Wang, Synchronous tracking control
of parallel manipulators using cross-coupling approach, Int. J. Robot.Res., vol. 25, no. 11, pp. 11371148, Nov. 2006.
[53] H. Chen, D. Sun, and J. Yang, Global localization of multirobot forma-tions using ceiling vision SLAM strategy, Mechatron., vol. 19, no. 5,pp. 618628, Aug. 2009.
Dong Sun (S95M00SM08) received the Bach-elors and Masters degrees in mechatronics and
biomedical engineering from Tsinghua University,Beijing, China, and the Ph.D. degree in robotics andautomation from the Chinese University of HongKong, Hong Kong.
He was a Postdoctoral Researcher with the Uni-versity of Toronto, Toronto, ON, Canada, where heis currently an Adjunct Professor. He was a Researchand Development Engineer in Ontario industry. Since2000, he has been with the Department of Manufac-
turing Engineering and Engineering Management, City University of HongKong, Kowloon, Hong Kong, where he is currently a Full Professor. His currentresearch interests include robotics manipulation, multirobot systems, motioncontrols, and biological processing automation.
Prof. Sun is a Professional Engineer in the province of Ontario. From 2004to 2008, he was an Associate Editor of the IEEE TRANSACTIONS ONROBOTICS.
Can Wang received the B.S. degree from the De-partment of Electrical Engineering, Zhejiang Uni-versity, Hangzhou, China, in 2001, the M.S. de-gree in system-on-chip from Lund University, Lund,Sweden, in 2005, and the Ph.D. degree with the De-partment of Manufacturing Engineering and Engi-neering Management, City University of HongKong,Kowloon, Hong Kong, in 2009.
His current research interests include coordinationof multiple robot systems, synchronization control,and neural networks.
Wen Shangreceived the B.Sc. degree in automationfrom Shandong University, Jinan, China, in 1999 andthe Ph.D. degree in automatic control from SoutheastUniversity, Nanjing, China, in 2005.
She is currently a Senior Research Associate withSuzhou Research Center, City University of HongKong, Kowloon, Hong Kong. Her current researchinterests include mobile robots, multirobot learningcontrol, and multirobot coordination.
Gang Feng(S90M92SM95F09) received theB.Eng. and M.Eng. degrees in automatic controlfrom Nanjing Aeronautical Institute, Nanjing, China,in 1982 and 1984, respectively, and the Ph.D. de-
gree in electrical engineering from the University ofMelbourne, Melbourne, Vic., Australia, in 1992.
Since 2000, he has been with the City Universityof Hong Kong, Kowloon, Hong Kong, where he iscurrently a Chair Professor and an Associate Provost.During 19921999, he was a Lecturer/Senior Lec-turer with the School of Electrical Engineering, Uni-
versity of New South Wales, Sydney, N.S.W., Australia. He was an AssociateEditor of theJournal of Control Theory and Applications. He is an AssociateEditor ofMechatronics. His current research interests include piecewise linearsystems, robot networks, and intelligent systems and control.
Prof. Feng received an Alexander von Humboldt Fellowship during 19971998 and the IEEE TRANSACTIONS ON FUZZY SYSTEMS Outstanding PaperAward in 2007. He was an Associate Editor of the IEEE TRANSACTIONS ONSYSTEMS, MAN, AND CYBERNETICS, PARTC and was a member of the Confer-ence Editorial Board of the IEEE Control Systems Society. He is an AssociateEditor of the IEEE TRANSACTIONS ON AUTOMATIC CONTROL and the IEEETRANSACTIONS ONFUZZYSYSTEMS.