Professional Documents
Culture Documents
A Finite-Time Motion Control Strategy For Odor Source Localization @@ Q. Lu Q.L. Han X. Xie S. Liu
A Finite-Time Motion Control Strategy For Odor Source Localization @@ Q. Lu Q.L. Han X. Xie S. Liu
A Finite-Time Motion Control Strategy For Odor Source Localization @@ Q. Lu Q.L. Han X. Xie S. Liu
result in the disordered movement of the robot group such that II. DYNAMICS OF D IFFERENTIALLY
the characteristic of the wider detection region of the multirobot D RIVEN M OBILE ROBOT
system cannot be efficiently utilized. The first issue has been
For the mobile robots, such as P3-DX, the dynamics can be
dealt with in our previous research [14], [15] by proposing a
described by
“soft sensor” to observe the position of the odor source. In terms ⎛ ⎞ ⎛
of these research results, the second issue will be coped with in ṙxi ⎞ ⎛ 0 0
⎞
νi cos θi
this paper. ⎜ ṙyi ⎟ ⎜ νi sin θi ⎟ ⎜ 0 0 ⎟
⎜ ⎟ ⎟ ⎜ ⎟ Fi
⎜ θ̇i ⎟ = ⎜ ⎜ ⎟
Furthermore, because of the time-varying characteristic of ⎜ ⎟ ⎜ ωi ⎟ +
⎠ ⎜
0 0 ⎟ (1)
the plume, two cases need to be considered. One case is that ⎝ ν̇i ⎠ ⎝ 0 ⎝ m1 0 ⎠ τi
i
the multirobot system detects the chemical signal, whereas the 0 1
ω̇i 0 Ji
other case is that the multirobot system loses the chemical
signal. When the multirobot system receives the chemical where ri = (rxi , ryi )T is the position of the ith robot, θi
signal, the plume linking the odor source with the multirobot denotes the orientation, νi is the linear velocity, ωi is the angular
system provides an important clue for the position of the velocity, τi is the torque, Fi is the force, mi is the mass, and Ji
odor source. Moving along the plume is an efficient approach is the moment of inertia. Let yi = (ri , θi , νi , ωi )T be the state
to locate the odor source. When the multirobot system loses of the ith robot and Ii = (Fi , τi )T be the control input.
the chemical signal, circling a probable position of the odor Because nonholonomic systems cannot be stabilized with
source is an efficient approach to collect odor clues. Using the continuous static state feedback, we use the “hand position”
aforementioned idea, the design of controllers for the single instead of the “center position” of the robot [24]. The dynamics
robot should enable the robot group to move parallel for tracing of the hand position of the robot can be described by
the plume and to circularly move for searching for odor clues
ẋi = vi
such that the characteristic of the wider detection region of the (2)
v̇i = ui , i ∈ {1, 2, . . . , N }
multirobot system can be efficiently utilized. In fact, this idea
is proposed in [18]. However, in this paper, we will design a where xi and vi denote the position and velocity for robot i at
different control strategy to realize this idea. Recently, finite- the hand position, respectively, and N is the number of robots.
time controllers have gained increasing attention in literature Let Li be the distance between the hand position and the center
[3], [10], [11], [13] due to their higher control accuracy, better position along the line that is perpendicular to the wheel axis
performance in disturbance rejection, and robustness against [24]. The relationship between the hand position and the center
uncertainties. Then, in a dynamical and unknown environment, position can be described by
fast convergence for the multirobot system enables the robot
to get more odor information to precisely observe the position cos θi
xi = ri + Li (3)
of the odor source using the soft sensor [14], [15]. Next, a sin θi
few finite-time controllers are concerned with the collision
cos θi −Li sin θ νi
avoidance function in the controller design and are easy to be vi = . (4)
sin θi Li cos θi ωi
realized. Therefore, how to design a finite-time parallel motion
control algorithm with collision avoidance functions to control From (3) and (4), we can obtain the position and velocity of
the robot group to move along the plume and how to develop the hand position of the robot, and then, we can calculate the
a finite-time circular motion control algorithm with collision control law ui for the double-integrator system [see (2)]. Then,
avoidance functions to enable the robot group to search for odor we can obtain the following control input for the system [see (1)]:
clues are the main motivations of the current study. 1
To sum up, we will develop and analyze a finite-time motion cos θi − LJii sin θi −1
Ii = m1i Li
control strategy (FTMCS), which consists of the parallel and mi sin θi Ji cos θi
circular motions of the multirobot system. Therefore, we will
−νi ωi sin θi − Li ωi2 cos θi
first give a motion control architecture, which includes two × ui − . (5)
νi ωi cos θi − Li ωi2 sin θi
important modules, i.e., a coordinating control module and a
tracking control module. In the coordinating control module, Usually, the applied torque for the left wheel and that for the
we will design a finite-time coordinating control algorithm in right wheel can be calculated by
order to obtain the virtual velocity consensus and the virtual
Jwheel Fi τi l
shape formation decided by the potential function with collision τl = − (6)
avoidance functions in finite time. In the tracking control mod- b mi 2Ji
ule, we will develop a finite-time tracking control algorithm
Jwheel Fi τi l
in order to enable the real velocity and the real position to τr = + (7)
b mi 2Ji
track the virtual velocity and the virtual position in finite time,
respectively. On the basis of the given architecture, we will where b is the radius of the wheel, l denotes the axis length
propose a finite-time parallel motion control algorithm and a between the two wheels, Jwheel is the moment of inertia of
finite-time circular motion control algorithm. Finally, we will the wheel, and τl and τr refer to the applied torque for the left
illustrate the effectiveness of the FTMCS for the problem of wheel and that for the right wheel, respectively. In the following
odor source localization. simulations, the parameters for P3-DX are shown in Table I.
LU et al.: FTMCS FOR ODOR SOURCE LOCALIZATION 5421
TABLE I TABLE II
PARAMETERS OF THE P3-DX M OBILE ROBOTS S PECIFICATIONS OF THE M OBILE ROBOT
B. Potential Function
A. Motion Control Architecture
The potential functions have been widely used for robot
The proposed motion control architecture, which consists of
navigation and control. Various functions have been proposed
five modules, i.e., a sensing module, a soft sensor module, a
for different aims [4], [19], [23]. In this paper, we consider the
coordinating control module, a tracking control module, and an
following potential function form as
actuation module, is illustrated in Fig. 2.
1) Module Description: For the sensing module, the input J = f (xi − xj 2 )
data are from two aspects: 1) from the robot; and 2) from
the environment. Moreover, the sensing module enables trans- where f : R2 × R2 → R denotes a map, xi − xj 2 refers to
ferring the real velocity, the real position of the robot, and the distance between the ith robot and the jth robot, and · 2
environmental information as the output data into the tracking denotes the two-norm. Moreover, this kind of potential function
control module and the soft sensor module. For the coordinating should have the following properties.
control module, the input data are the position of the odor 1) Potential function J has the zero minimum at xi −
source, the virtual positions of other robots, and the virtual xj 2 = d, where d > 0 is a predefined constant.
velocities of other robots. Moreover, the virtual velocity and 2) There exists a constant c > 0 such that the potential
virtual position of the current robot as the output data of the function satisfies
module are transferred into the tracking control module. For the
N
tracking control module, the input data are the virtual velocity, ∂J 2
J ≤c
the virtual position, the real position, and the real velocity, ∂xi .
i=1 2
whereas the output data are the applied torque for the left
wheel and that for the right wheel of robots. In the proposed It is obvious that we can always build a potential function
motion control architecture, the soft sensor can be used to that possesses the aforementioned properties. For example,
“measure” the position of the odor source. In order to run the the potential function proposed by Olfati-Saber [21] has the
soft sensor, the input data, which are from the sensing module aforementioned properties.
and communication networks, are the positions of robots, the
odor concentration, and the wind velocity. In addition, the
C. Coordinating Control
output data are the positions of the odor source [14].
2) Specification of Mobile Robots: In order to enable the In the coordinating control module, we provide the following
motion control architecture to run at real mobile robots, the finite-time coordinating control algorithm, which can enable the
5422 IEEE TRANSACTIONS ON INDUSTRIAL ELECTRONICS, VOL. 61, NO. 10, OCTOBER 2014
Fig. 3. Parallel movement for three robots, where the blue “o” denotes the initial position, and the red “” denotes the end position. (a) Parallel movement.
(b) Linear velocity. (c) Angular velocity. (d) Heading.
virtual velocity consensus and the accurate formation shaped by k1 cannot be also given a bigger value. Consequently, we
the potential function to be reached within a finite-time interval usually set parameter k1 such that it can just barely meet the
p aforementioned condition.
∂J
x̂˙ i (t) = v̂i (t) − β (8a)
∂ x̂i
⎛ ⎞p IV. FTMCS
N
v̂˙ i (t) = γ ⎝ aij (v̂j − v̂i )⎠ (8b) In this section, we will give the FTMCS, which includes the
j=1
finite-time parallel motion control algorithm and the finite-time
circular motion control algorithm.
where p = ((2α − 1)/(2α + 1)), α > 0.5 and is an integer;
β > 0; γ > 0; x̂i (t) and v̂i (t) denote the virtual position and A. Finite-Time Parallel Motion Control
virtual velocity of the ith robot, respectively; and J is a poten-
tial function. If there exists a communication link between the In this section, we will propose a finite-time parallel motion
ith robot and the jth robot, aij = 1, and aij = 0 otherwise. control algorithm, which can coordinate the robot group to
Remark 1: Although this decoupling idea about virtual move parallel in order to trace the plume. The proposed finite-
control has been proposed in [3], we introduce the collision time parallel motion control algorithm consists of finite-time
functions in the controller design for odor source localization. tracking control algorithm (9) and the following finite-time
Moreover, the proposed finite-time coordinating control algo- coordinating control algorithm:
rithm is continuous and easy to be programmed compared with p
∂J
other finite-time control algorithms [3], [11], [13] due to no x̂˙ i (t) = v̂i (t) − β (10a)
∂ x̂i
“sign” function. ⎛ ⎞p
Remark 2: Due to the control saturation constraints of the
N
real robots and the characteristics of the odor source localiza- v̂˙i (t) = v̇c + γ ⎝ aij (v̂j − v̂i ) + λ(vc − v̂i )⎠ (10b)
tion problem that means that the robot cannot quickly move, j=1
parameters γ and β cannot be given bigger values. In the
following simulations, we usually set the two parameters within where λ > 0, x̂i (t) and v̂i (t) denote the virtual position and
(0, 1]. Considering to keep the better performance of finite- virtual velocity of the ith robot, respectively, and vc is the
time convergence and disturbance rejection, we usually set reference velocity and can be calculated based on the position
parameter α within [1, 5]. of the odor source. J is the potential function.
Remark 4: It should be pointed out that parameters p, β,
and γ in (10) are the same as the parameters in (8), whereas
D. Tracking Control parameter λ is usually set within (0, 1].
In order to enable the real velocity and the real position for Example 1: In this example, we will use a physics simulation
second-order dynamics (2) to track the virtual velocity and the platform provided by Microsoft Robotics Studio. Consider
virtual position, respectively, we give the following finite-time robot dynamics (1), and set parameters α = 4, β = 0.5, γ = 1,
tracking control algorithm, which is described by λ = 0.4, k1 = 2.5, r = 5, d = 2.8, and vc = [0.4, −0.2] for the
2q−1 finite-time parallel motion control algorithm. Fig. 3(a) shows
1
1 the parallel movement of three robots. The corresponding
ui (t) = v̂˙i − k (vi − v̂i ) q + k1q (xi − x̂i ) (9)
linear velocity, angular velocity, and heading are shown in
Fig. 3(b)–(d), respectively.
where xi and x̂i are the real and virtual positions of the ith
robot, respectively; vi and v̂i are the real and virtual velocities
of the ith robot, respectively; k1 > (21−q /q); k = k2 k3 ; k2 = B. Finite-Time Circular Motion Control
1/q
21−q (2 − q)k1 ; k3 = ((k1 q + 2q21−q + 21−q )/(1 + q)); and In this section, we will propose a finite-time circular mo-
q = ((2α − 1)/(2α + 1)) > 0.5, which means that α > 1.5 tion control algorithm, which can coordinate the robot group
and is an integer. to circle a predicted odor source position in order to search
Remark 3: Due to the same reasons as the parameters in (8), for odor clues. We first introduce a virtual robot that can
we usually set parameter α within [2, 5]. Moreover, parameter communicate with all real robots. Accordingly, the position
LU et al.: FTMCS FOR ODOR SOURCE LOCALIZATION 5423
Fig. 4. Circular movement for three robots, where the blue “o” denotes the initial position, and the red “” denotes the end position. (a) Circular movement. (b)
Linear velocity. (c) Angular velocity. (d) Heading.
where x̂i (t) and v̂i (t) denote the virtual position and virtual
velocity of the ith robot, respectively. J˘ is an extended potential
Fig. 5. Flowchart for the FTMCS.
function for all the robots, including the virtual robot.
Remark 5: It is worth mentioning that parameters p, β, γ,
and λ in (11) are the same as the parameters in (10). Moreover, where hir and ḣir denote the position and velocity of the ith
one can see that, in (11), we use an extended potential function virtual robot, respectively. Moreover, ḧir refers to the accelera-
˘ The difference between J˘ and J is that, for J,
J. ˘ we consider tion of the ith virtual robot.
N real robots plus a virtual robot, which means that the number
of robots is N + 1. The objective of the introduced virtual robot C. FTMCS
is to enable N robots to circle the predefined center under the
extended potential function J. ˘ The proposed FTMCS consists of the finite-time parallel
Example 2: In this example, we use the same simulation motion control algorithm and the finite-time circular motion
platform as Example 1 to test the proposed finite-time circular control algorithm. Under different environmental conditions,
motion control algorithm. Consider robot dynamics (1), and set the two algorithms start each other. Specifically, on one hand,
parameters α = 4, β = 0.3, γ = 1, λ = 0.6, k1 = 2.5, r = 9, when the robot group detects the odor clues, the finite-time
d = 2.8, R = 8, ω0 = 0.02, and hc = (0, 0) for the finite-time parallel motion control algorithm starts to run. On the other
circular motion control algorithm. Fig. 4(a) shows the circular hand, when the robot group loses the odor clues and the losing
movement of three robots. The corresponding linear velocity, time is more than 20 s, the finite-time circular motion algorithm
angular velocity, and heading are shown in Fig. 4(b)–(d), begins to run. Finally, the flowchart of the FTMCS can be found
respectively. in Fig. 5.
If the robots are required to be uniformly distributed around
the circle, then finite-time coordinating control algorithm (11) V. S TABILITY A NALYSIS
can be extended as
In this section, we will first give a definition of finite-time
p convergence and several lemmas, which can be used in the fol-
∂ Jˇ
x̂˙ i (t) =v̂i (t)−β (12a) lowing convergence analysis. Then, we introduce the concept of
∂ x̂
N i graph and communication topologies among robots. Next, we
will prove the convergence of finite-time coordinating control
v̂˙i (t) =ḧir +γ aij (v̂j − ḣjr )−(v̂i − ḣir )
algorithm (8) and finite-time tracking control algorithm (9). It
j=1
p should be pointed out that the proof processes of coordinating
+ λ(ḣir −v̂i ) (12b) control algorithms (10) and (11) are omitted because their
proofs are similar to that of finite-time coordinating control
5424 IEEE TRANSACTIONS ON INDUSTRIAL ELECTRONICS, VOL. 61, NO. 10, OCTOBER 2014
algorithm (8). Finally, the performance analysis of disturbance [v̂1 , . . . , v̂N ]T ∈ RN . Choose a Lyapunov candidate as
rejection for finite-time coordinating control algorithm (8) and
1
N
finite-time tracking control algorithm (9) is presented.
V = |φi |p+1 .
In the following, the definition of finite-time convergence and p + 1 i=1
three lemmas [5] are given.
Definition 1: Consider system ẋ = f (x(t)). The origin is It is obvious that V ≥ 0, and along the trajectory [see (8b)], we
said to be a finite-time-stable equilibrium if there exists an have
open neighborhood N ⊆ D of the origin and function T :
N \ {0} → (0, ∞), such that, for every x0 ∈ N \ {0}, x(t) is V̇ = −γφpT L(A)φp ≤ 0 (13)
defined for t ∈ [0, T (x0 )]; x(t) ∈ N \ {0}, for t ∈ [0, T (x0 )];
and limt→T (x0 ) x(t) = 0. If D = N = Rn , the origin is said to where φ̇ = [φ̇1 , . . . , φ̇N ]T , v̂˙ = [v̂˙ 1 , . . . , v̂˙ N ]T , and φp = [φp1 ,
be a globally finite-time-stable equilibrium. . . . , φpN ]T . The first inequality is from the fact that L(A) ≥ 0
Lemma 1: Suppose that there exist a continuously differen- by Lemma 4. Because V̇ < 0 at v̂i = v̂j , v̂i → v̂j is t → ∞.
tiable function V : D → R, real number k > 0 and α ∈ (0, 1), Velocity consensus algorithm (8b) is an asymptotical conver-
and a neighborhood U ⊂ D of the origin such that V is positive gence. Moreover, we suppose that V = 0, which implies that
definite on U and V̇ + kV α is negative semidefinite on U . φi = 0. Then, we can get
Then, the origin is a finite-time-stable equilibrium of system
ẋ = f (x(t)). Moreover, if T is the settling time, then T (x0 ) ≤ V̇ γφp T L(A)φp
− = 2p
(1/k(1 − α))V (x0 )1−α for all x0 in the open neighborhood of V
2p
p+1 N p+1 p+1
1
p+1 i=1 |φ i |
the origin.
Lemma 2: For any real numbers xi , i = 1, . . . , n, and 0 < γφp T L(A)φp
b ≤ 1, the following inequality holds: ≥
ρ1 N i=1 |φi |
2p
When b = p/q ≤ 1, where p > 0 and q > 0 are odd integers, where ρ1 = (1/(p + 1))(2p/(p+1)) . Let M = {ζ|ζ T ζ = 1 and
we have ζ = (φp /φp 2 )}, which is a bounded closed set. For any
x ∈ M , if xT L(A)x = 0, we will derive φp T L(A)φp = 0.
|xb − y b | ≤ 21−b |x − y|b . According to the proof process of asymptotical stability, we
have φ = 0, which implies that x = 0. Then, x ∈ / M , which is a
Lemma 3: Let c and d be positive real numbers, and contradiction. Therefore, for any x ∈ M , we have xT L(A)x =
γ(x, y) > 0 be a real-valued function. Then 0. Since function xT L(A)x, where xT L(A)x = 0, is conti-
nuous with respect to x and for any x ∈ M , minx∈M xT L(A)x,
cγ(x, y)|x|c+d dγ −c/d (x, y)|y|c+d which is denoted by k1 , exists and is larger than zero. Then,
|x|c |y|d ≤ + .
c+d c+d because (φp T /φp 2 ) ∈ M , we can get (φp T /φp 2 )L(A)
(φp /φp 2 ) ≥ k1 . Hence
Let G = (ν, E, A) be a weighted undirected graph of order
N with the set of nodes ν = {ν1 , ν2 , . . . , νN }, the set of γk1 φp 22 γk1 N i=1 |φi |
2p
γk1
edges E ⊆ ν × ν, and a weighted adjacency matrix A = [aij ] Π(φi ) ≥ N = N
= .
ρ1 i=1 |φi | 2p ρ1 i=1 |φi | 2p ρ1
with nonnegative adjacency elements aij . Let L(A) = [lij ] ∈
RN ×N denote the graph Laplacian of G = (ν, E, A). Graph Let k = (γk1 /ρ1) > 0, and then, we obtain V̇ +kV (2p/(p+1)) ≤ 0.
G = (ν, E, A) is used to model the communication topology By Lemma 1, v̂i → v̂j is t → ((1+p)/k(1−p))V(0)((1−p)/(1+p)) .
among the robots, and we have the following property [28]. Suppose that v̂i = v̂j = v0 = ẋ0 ∈ R2 when t > ((1 + p)/
Lemma 4: If G = (ν, E, A) is undirected and connected, k(1 − p))V (0)((1−p)/(1+p)) . We can make this assumption be-
then eigenvalue 0 is algebraically simple, and all other eigen- cause (8a) and (8b) is decoupled. Let ξi (t) = x̂i (t) − x0 (t), and
values are positive for L(A). then, get
The following theorem will show that coordinating control p
algorithm (8) converges in finite time. ∂J
ξ˙i (t) = −β . (14)
Theorem 1: Consider coordinating control algorithm (8). ∂ξi
If the interaction topology G(ν, E, A) among the robots is
undirected and connected, the finite-time coordinating control Choose a Lyapunov candidate as
algorithm guarantees that potential J is minimized and that
v̂i → v̂j ∀ j ∈ {1, 2 . . . , N } within a finite-time interval. V = J.
Proof: For coordinating control algorithm (8), the virtual
position and the virtual velocity are decoupled. Hence, we will Along the state trajectory [see (14)], we can derive
first show thevirtual velocity consensus in finite time. N p+1
Let φi = N
∂J 2 2
j=1 aij (v̂j − v̂i ) (i = 1, . . . , N ), and then, ob- V̇ ≤ −β (15)
∂ξi
tain φ = −L(A)v̂, where φ = [φ1 , . . . , φN ]T ∈ RN , and v̂ = i=1 2
LU et al.: FTMCS FOR ODOR SOURCE LOCALIZATION 5425
1 x2 1−q where hi and di (t) are the external disturbance of the ith robot,
1 ∂x∗ q
s q − x∗2 1/q and we assume that |hi (t)| ≤ l1 < +∞ and that |di (t)| ≤
1
− (2 − q)x2 2 ds. (17)
k2 ∂x1 l2 < +∞ for i ∈ {1, 2, . . . , N }. If the interaction topology
x∗
G(ν, E, A) among the robots is undirected and connected, the
2
Proof: The analysis procedure is similar to that of the Case 2 : |ξ2 |d ≤ (((1 + q)l)/(k2 (k1 q − 21−q )))((q+1)/(2q−1)) .
proof of Theorem 1, except for the appearance of the distur- Then, we can obtain |ξ1 |d ≥ (((1 + q)l)/(k2 (k1 q −
bance. Substituting the protocol [see (19)] into V̇ in (13) and 21−q )))((q+1)/(2q−1)) . Substituting the aforementioned
following similar steps, we have inequality into (22), we obtain V̇ < 0. Similarly, when
t > t∗ , (x1 , x2 ) ∈ Q1 . From Theorem 2, one can see
V̇ = −γφpT L(A)φp − φpT L(A)d
that V d/2 ≤ k d/2 (|ξ1 |d + |ξ2 |d ), which implies that V <
√
≤ −γk1 φ2p p k(((1 + q)l)/(k2 (k1 q − 21−q )))(2/(2q−1)) when t > t∗ .
2 + L(A) l2 N φ2
Therefore, we will calculate the tracking errors in the
√
where d = [d1 , . . . , dN ], and d2 ≤ l2 N . If the velocity following:
mismatch φi of the ith robot satisfies φi ∈/ Q1 , we have 2q−1
√
1
(1 + q)l
√ p1 |x1 | ≤ 2k .
L(A) l2 N k2 (k1 q − 21−q )
φ2 >
γk1 ∗1/q
In (16), we have |s1/q − x2 | ≥ (2q−1 |s − x∗2 |)1/q . As-
sume that x2 ≥ x∗2 , and then, derive c1 V (t) ≥ |x2 − x∗2 |2/q ,
which can derive V̇ < 0. Therefore, the velocity mismatch of
where c1 = (((k2 )/q)2((q −2q+2)/q) ). When x2 ≤ x∗2 , the same
2
γk1 and l1 < β, then convergence regions Q1 and Q2 can be |x2 | ≤ c12 + k1 2 2 k 2 .
k2 (k1 q − 21−q )
rendered as small as desired, where √ Q1 and Q2 are defined
in Theorem 3. When L(A)2 l2 N γk1 and l1 β, the This theorem is finished.
finite-time coordinating control algorithm does not have any Remark 7: Similar to Remark 6, in this case, we can select
prominent advantages over the asymptotically linear coordinat- q to approximate to 0.5 such that expression
√ 1/(2q − 1) in Ω1
ing control algorithm. However, due to the control saturation is bigger than 1, which can√ make 2k(((1 + q)l)/(k2 (k1 q −
constraints, γ and β are not selected to be sufficiently large. 21−q )))(1/(2q−1)) ((2l 2k)/(k2 (k1 − 1))) if we assume
In this case, adjusting parameter p can obviously improve the that (((1 + q)l)/(k2 (k1 q − 21−q ))) < 1.
performance of disturbance rejection of the finite-time coordi-
nating control algorithm.
VI. O DOR S OURCE L OCALIZATION
Theorem 4: Consider the system [see (2)] with disturbance
di (t) that satisfies |di (t)| ≤ l < +∞. The convergence region In this section, we will first introduce Farrell’s odor model
of tracking errors is given by and illustrate the influence of wind and temperature on odor
2q−1 dispersion. Then, the simulation is divided into two parts, i.e.,
√
1
(1+q)l one part where the simulation environment is without obstacles
Ω1 = |xi − x̂i | ≤ 2k |vi − v̂i |
k2 (k1 q−21−q ) and the other part where the simulation environment is with
q q 2qq−1 obstacles. It should be pointed out that the parameters of the
q (1+q)l FTMCS are set in the following. For the parallel motion, the
≤ c1 +k1 2 2 k 2
2
If (x1 , x2 ) ∈
/ Q1 , we have |ξ1 |d + |ξ2 |d ≥ ((1 + q)l/k2 (k1 q − In terms of odor dispersion studies, Farrell et al. [6] modeled
1−q ((q+1)/(2q−1))
2 )) . Moreover, consider the following two the movement of the filaments released by the odor source (see
cases. [6] for details), which is given by
Case 1 : |ξ2 |d ≥ (((1 + q)l)/(k2 (k1 q − 21−q )))((q+1)/(2q−1)) . ṗi = va + vi (23)
Then, we can derive that |ξ2 |d ≥ (((1 + q)l)/(k2 (k1 q −
21−q )))|ξ2 |2−q , which implies that V̇ < 0. Hence, there where pi = (x, y) is the ith filament location, vi = (vix , viy )
exists time t∗ such that we have (x1 , x2 ) ∈ Q1 when t > t∗ . presents the dispersion velocity of the ith filament relative to the
LU et al.: FTMCS FOR ODOR SOURCE LOCALIZATION 5427
TABLE III illustrate the comparison results between the proposed FTMCS
PARAMETERS OF FARRELL’ S O DOR D ISPERSION M ODEL
and the other chosen algorithms under the search environment
without obstacles.
The search process of the robot group controlled by the
FTMCS is illustrated in Fig. 6. In Fig. 6(a), the initial positions
of the robot group are set at the upper right-hand corner in the
search region. In Fig. 6(b), the parallel motion is used to track
the plume and move along the plume according to the probable
positions of the odor source. In Fig. 6(c), the circular motion
TABLE IV
E IGHT S CENARIOS
is used to search for odor clues. In particular, in the circular
motion, we use (12) as the coordinating control algorithm.
Finally, in Fig. 6(d), the robot group finds the odor source.
Then, we will compare the search efficiency of the multirobot
system coordinated by the FTMCS with several selected algo-
rithms that include the charged PSO (CPSO) algorithm [12], the
probability PSO with information-sharing mechanism (PPSO-
IM) algorithm [16], the wind utility I angle = 45 (WUI-45)
[12], the wind utility II (WUII) [12], the learning PSO (LPSO)
centerline and can be modeled by using a colored noise process algorithm [17], and the PSO algorithm [20]. The parameters
with a given spectral density (σix , σiy ), and va = (vax , vay ) of the six algorithms can be found in [12], [16], [17], and
denotes the advection velocity, which is calculated by [20], respectively. For all the algorithms, the robot group will
search for odor clues along the direction of the y-axis from the
∂vax ∂vax ∂vax 1 ∂ 2 vax 1 ∂ 2 vax initial positions (the upper right-hand corner) to (80 m, 0 m).
=−vax −vay + Kx + K y
∂t ∂x ∂y 2 ∂x2 2 ∂y 2 Once odor clues are detected by any robot, these algorithms
∂vay ∂vay ∂vay 1 ∂ 2 vay will start to run. In Table V, the success rates obtained by
=−vax −vay + Kx
∂t ∂x ∂y 2 ∂x2 the seven algorithms are shown. Fig. 7 shows less search time
2 obtained from the FTMCS. In Fig. 8, one can see that the robots
1 ∂ vay
+ Ky (24) coordinated by the FTMCS consume lesser energy than those
2 ∂y 2
coordinated by other compared algorithms.
where Kx and Ky represent diffusivity and are assumed to be
the constants.
We will use Farrell’s odor dispersion model to build the sim- C. Motion Process and Results With Obstacles
ulation environment whose parameters are shown in Table III, In this section, we consider two types of obstacles, i.e.,
where C1, C2, C3, and C4 denote the different initial wind the rectangle and ellipse obstacles. Because the ellipse can be
velocities, and σ1 , σ2 , σ3 , and σ4 refer to the different spectral contained by a rectangle, the rectangle obstacle, as an example,
densities. In the odor model, the time-varying wind has been is used to illustrate how the multirobot system controlled by the
considered in (24), which means that the aerodynamics have proposed FTMCS avoids obstacles. In order to avoid rectangle
been considered. In addition, the temperature will put an impact obstacles, we use the method in [21] to extend the potential
on dispersion velocity vi in (23), which means that the higher function.
temperature will enable the filaments to quickly disperse. In ad- In the following, we choose two scenarios to test the pro-
dition, the dispersion velocity can be estimated by the different posed FTMCS. Each scenario has eight obstacles that can be
spectral density shown in Table III. The higher spectral density used to describe the trees and buildings. Fig. 9 shows the
means a faster dispersion velocity. first scenario, where five robots run at the environment with
In the following simulations, we will validate the influence of rectangle and ellipse obstacles. In Fig. 9, the parallel and
environmental characteristics, such as aerodynamics, tempera- circular motions have been explicitly shown. Similarly, Fig. 10
ture, and obstacles, on the proposed FTMCS. In Table IV, we shows the simulation results for scenario 2. In particular, in
have listed eight cases where the aerodynamics and temperature Fig. 10(b), the circular motion is used to search for odor clues,
of the search environment have been considered. For example, whereas the parallel motion is employed to trace the plume
for Case 4, the wind velocity is faster, and the dispersion veloc- in Fig. 10(c). Fig. 11 gives the results of eight cases for the
ity is also faster, which will result in a wider and fast fluctuant search time and consumed energy for the two scenarios. From
plume. On the other hand, for Case 2, the wind velocity and the the simulation results, one can see that the proposed FTMCS
dispersion velocity are smaller, which will result in a narrower has better robustness for the environment with obstacles.
and gradually changed plume. Correspondingly, the other cases,
such as Cases 4 and 2, can be explained.
VII. C ONCLUSION
B. Search Process and Comparison Results Without Obstacles We have developed an FTMCS to deal with the problem
In this section, we will first show the search process of the of odor source localization. First, we have proposed a motion
robot group controlled by the proposed FTMCS. Then, we will control architecture where there are two important modules,
5428 IEEE TRANSACTIONS ON INDUSTRIAL ELECTRONICS, VOL. 61, NO. 10, OCTOBER 2014
Fig. 6. Search process of five robots under the environment without obstacles. (a) T = 0 s. (b) T = 61 s. (c) T = 143 s. (d) T = 162 s.
TABLE V
S UCCESS R ATES ( IN PERCENTAGES ) BASED ON 50 RUNS
Fig. 7. Search time for the eight cases. (a) Case 1. (b) Case 2. (c) Case 3. (d) Case 4. (e) Case 5. (f) Case 6. (g) Case 7. (h) Case 8.
Fig. 8. Consumed energy for the eight cases. (a) Case 1. (b) Case 2. (c) Case 3. (d) Case 4. (e) Case 5. (f) Case 6. (g) Case 7. (h) Case 8.
Fig. 9. Search process of five robots under the environment with obstacles for scenario 1. (a) T = 0 s. (b) T = 125 s. (c) T = 157 s. (d) T = 173 s.
LU et al.: FTMCS FOR ODOR SOURCE LOCALIZATION 5429
Fig. 10. Search process of five robots under the environment with obstacles for scenario 2. (a) T = 0 s. (b) T = 75 s. (c) T = 143 s. (d) T = 157 s.
Fig. 11. Search time and the consumed energy of five robots for the eight cases for scenarios 1 and 2. (a) Search time for scenario 1. (b) Consumed energy for
scenario 1. (c) Search time for scenario 2. (d) Consumed energy for scenario 2.
i.e., a coordinating control module and a tracking control [11] Q. Hui, “Finite-time rendezvous algorithms for mobile autonomous
module. In the coordinating control module, we have devel- agents,” IEEE Trans. Autom. Control, vol. 56, no. 1, pp. 207–211,
Jan. 2011.
oped a finite-time coordinating control algorithm such that the [12] W. Jatmiko, K. Sekiyama, and T. Fukuda, “A PSO-based mobile robot
virtual shape decided by the potential function and the virtual for odor source localization in dynamic advection-diffusion with obstacles
velocity consensus can be reached in finite time. In the tracking environment: Theory, simulation and measurement,” IEEE Comput. Intell.
Mag., vol. 2, no. 2, pp. 37–51, May 2007.
control module, we have derived a finite-time tracking control [13] S.-H. Li, H.-B. Du, and X.-Z. Lin, “Finite-time consensus for multi-agent
algorithm such that the real velocity and the real position can systems with double-integrator dynamics,” Automatica, vol. 47, no. 8,
track the virtual velocity and the virtual position, respectively. pp. 1706–1712, Aug. 2011.
[14] Q. Lu and Q.-L. Han, “Cooperative control of a multi-robot system for
Second, on the basis of the motion control architecture, we odor source localization,” in Proc. 37th Annu. Conf. IEEE Ind. Electron.
have developed a finite-time parallel motion control algorithm Soc., Melbourne, Vic., Australia, 2011, pp. 2284–2289.
and a finite-time circular motion control algorithm. Finally, we [15] Q. Lu and Q.-L. Han, “Decision-making in a multi-robot system for odor
source localization,” in Proc. 37th Annu. Conf. IEEE Ind. Electron. Soc.,
have illustrated the effectiveness of the FTMCS for odor source Melbourne, Vic., Australia, 2011, pp. 74–79.
localization. [16] Q. Lu and Q.-L. Han, “A probability particle swarm optimizer
with information-sharing mechanism for odor source localization,” in
Proc. 18th World Congr. Int. Fed. Autom. Control, Milan, Italy, 2011,
R EFERENCES pp. 9440–9445.
[1] I. Bayezit and B. Fidan, “Distributed cohesive motion control of flight [17] Q. Lu and P. Luo, “A learning particle swarm optimization for odor
vehicle formations,” IEEE Trans. Ind. Electron., vol. 60, no. 12, pp. 5763– source localization,” Int. J. Autom. Comput., vol. 8, no. 3, pp. 371–380,
5772, Dec. 2013. Aug. 2011.
[2] Y. Cao and W. Ren, “Distributed coordinated tracking with reduced in- [18] Q. Lu, S. Liu, X. Xie, and J. Wang, “Decision-making and finite-time
teraction via a variable structure approach,” IEEE Trans. Autom. Control, motion control for a group of robots,” IEEE Trans. Cybern., vol. 43, no. 2,
vol. 57, no. 1, pp. 33–48, Jan. 2012. pp. 738–750, Apr. 2013.
[3] Y. Cao, W. Ren, and Z.-Y. Meng, “Decentralized finite-time sliding mode [19] R. C. Luo and O. Chen, “Mobile sensor node deployment and asyn-
estimators and their applications in decentralized finite-time formation chronous power management for wireless sensor networks,” IEEE Trans.
tracking,” Syst. Control Lett., vol. 59, no. 4, pp. 522–529, Sep. 2010. Ind. Electron., vol. 59, no. 5, pp. 2377–2385, May 2012.
[4] K. D. Do, “Flocking for multiple elliptical agents with limited com- [20] L. Marques, U. Nunes, and A. T. de Almeida, “Particle swarm-based
munication ranges,” IEEE Trans. Robot., vol. 27, no. 5, pp. 931–942, olfactory guided search,” Auton. Robots, vol. 20, no. 3, pp. 277–287,
Oct. 2011. Jun. 2006.
[5] H. Du, S. Li, and C. Qian, “Finite-time attitude tracking control of space- [21] R. Olfati-Saber, “Flocking for multi-agent dynamic systems: Algorithms
craft with application to attitude synchronization,” IEEE Trans. Autom. and theory,” IEEE Trans. Autom. Control, vol. 51, no. 3, pp. 401–420,
Control, vol. 56, no. 11, pp. 2711–2717, Nov. 2011. Mar. 2006.
[6] J. A. Farrell, J. Murlis, X. Z. Long, W. Li, and T. Ring, “Filament-based [22] S. Pang and J. A. Farrell, “Chemical plume source localization,” IEEE
atmospheric dispersion model to achieve short time-scale structure of odor Trans. Syst., Man, Cybern. B, Cybern., vol. 36, no. 5, pp. 1068–1080,
plumes,” Environ. Fluid Mech., vol. 2, no. 1/2, pp. 143–169, Jun. 2002. Oct. 2006.
[7] J. L. Fernández-Martínez and E. García-Gonzalo, “Stochastic stability [23] B. Ranjbar-Sahraei, F. Shabaninia, A. Nemati, and S.-D. Stan, “A novel
analysis of the linear continuous and discrete PSO models,” IEEE Trans. robust decentralized adaptive fuzzy control for swarm formation of multi-
Evol. Comput., vol. 15, no. 3, pp. 405–423, Jun. 2011. agent systems,” IEEE Trans. Ind. Electron., vol. 59, no. 8, pp. 3124–3134,
[8] J. Ferruz, V. M. Vega, A. Ollero, and V. Blanco, “Reconfigurable control Aug. 2012.
architecture for distributed systems in the hero autonomous helicopter,” [24] W. Ren and R. Beard, Distributed Consensus in Multi-Vehicle Cooperative
IEEE Trans. Ind. Electron., vol. 58, no. 12, pp. 5311–5318, Dec. 2011. Control–Theory and Applications. Berlin, Germany: Springer-Verlag,
[9] S. Hong, Y. Oh, D. Kim, and B.-J. You, “Real-time walking pattern 2008.
generation method for humanoid robots by combining feedback and feed- [25] H. Rezaee and F. Abdollahi, “A decentralized cooperative control scheme
forward controller,” IEEE Trans. Ind. Electron., vol. 61, no. 1, pp. 355– with obstacle avoidance for a team of mobile robots,” IEEE Trans. Ind.
364, Jan. 2014. Electron., vol. 61, no. 1, pp. 347–354, Jan. 2014.
[10] X. Huang, W. Lin, and B. Yang, “Global finite-time stabilization of a class [26] Z. Wang and D. Gu, “Cooperative target tracking control of multiple
of uncertain nonlinear systems,” Automatica, vol. 41, no. 5, pp. 881–888, robots,” IEEE Trans. Ind. Electron., vol. 59, no. 8, pp. 3232–3240,
May 2005. Aug. 2012.
5430 IEEE TRANSACTIONS ON INDUSTRIAL ELECTRONICS, VOL. 61, NO. 10, OCTOBER 2014
[27] A. Widyotriatmo and K.-S. Hong, “Navigation function-based control of Xiaogao Xie (M’10) received the B.Sc., M.Sc.,
multiple wheeled vehicles,” IEEE Trans. Ind. Electron., vol. 58, no. 5, and Ph.D. degrees in electrical engineering from
pp. 1896–1906, May 2011. Zhejiang University, Hangzhou, China, in 1997,
[28] F. Xiao, L. Wang, J. Chen, and Y.-P. Gao, “Finite-time formation control 2000, and 2005, respectively.
for multi-agent systems,” Automatica, vol. 45, no. 11, pp. 2605–2611, From 2005 to 2007, he was a Postdoctoral Fellow
Nov. 2009. with the College of Electrical Engineering, Zhejiang
[29] S. Yang, A. Zhu, and G. Yuan, “A bioinspired neurodynamics-based ap- University. In 2007, he joined Hangzhou Dianzi
proach to tracking control of mobile robots,” IEEE Trans. Ind. Electron., University, Hangzhou, China, where he is currently
vol. 59, no. 8, pp. 3211–3220, Aug. 2012. an Associate Professor with the School of Automa-
[30] H. Zhang, F. L. Lewis, and Z. Qu, “Lyapunov, adaptive, and optimal tion. His research interests include nonlinear control,
design techniques for cooperative systems on directed communication efficiency power conversion, and renewable-energy
graphs,” IEEE Trans. Ind. Electron., vol. 59, no. 7, pp. 3026–3041, conversion technology.
Jul. 2012.