Professional Documents
Culture Documents
15ICUASpp1025 1030
15ICUASpp1025 1030
net/publication/281029980
CITATIONS READS
30 809
4 authors:
All content following this page was uploaded by Xiang Yu on 05 October 2015.
Abstract— In this paper, a leader-follower formation control practical issues including collision avoidance and fault tol-
of multiple unmanned aerial vehicles (UAVs) design methodol- erant control (FTC). The formation control researches with
ogy is proposed to keep the desired formation, while simultane- collision avoidance capability can be found in [15], [16],
ously deal with the potential collision and actuator faults. The
proposed formation control is divided into outer-loop and inner- [17], [18], while faults in formation control are considered
loop controllers. First, a leader-follower control structure is in other researches including communication faults (dropout,
constructed as the outer-loop controller. Then, an adaptive fault delay, failure, etc.) [19], [20], [21] and actuator faults [22],
tolerant control (FTC) scheme along with a collision avoidance [23], [24]. The aforementioned formation control applica-
strategy are combined as the inner-loop controller. Simulation tions can effectively eliminate the influences of faults or
validations are conducted to demonstrate the effectiveness of
this presented design method. obstacles, whilst maintain the formation stability. However,
the combination of the collision avoidance and FTC abilities
in formation control has not been presented, which is critical
I. INTRODUCTION
for formation control.
The coordination of multiple unmanned aerial vehicles This paper proposes a leader-follower formation control
(UAVs) has attracted a great deal of attention, due to the methodology with collision avoidance and FTC capabilities.
potentially significant benefits offered by a group of UAVs This method is intended to ensure all UAVs in the desired for-
deploying in an organized topology [1]. These benefits in- mation while remaining free of collisions from both environ-
clude various practical applications, such as forest fire/health ment and inter-formation, and guarantee the system stability
surveillance [2], border patrol [3], natural resources explo- in the event of actuator faults. The proposed approach con-
ration [4], as well as search and rescue [5]. However, the sists of two main portions: a FTC mechanism and a collision
malfunctions of actuators in UAVs can not only adversely avoidance mechanism. The operational procedure of these
affect the task performance, but also lead to the disastrous mechanisms can be outlined as follows: 1) when a follower
consequences. In addition, collision avoidance is likewise an UAV encounters actuator faults, the FTC mechanism will be
important aspect since it can prevent vehicles from disrupting activated to accommodate the faults; 2) the collision may
or destroying each other and surrounding objects. These occur among the UAVs, environmental obstacles, and the
problems severely threaten the safety of personnels from faulty UAV, a collision avoidance function in the threatened
ground and other manned aircrafts, natural environment, UAVs is then activated and the collision avoidance action is
and infrastructures. Thus, the safety of UAVs should be conducted; 3) when all obstacles have been voided, all UAVs
guaranteed in the course of formation control. ultimately return to the desired formation.
In the past decade, numerous studies are carried out on The contribution of this paper covers: 1) a PI control
UAVs formation control. Various methods are adopted in approach is designed as the outer-loop controller to guaran-
this application, such as: proportional-integral (PI) control tee the good formation keeping performance and eliminate
[8], [13], robust control [9], [10], linear quadratic (LQ) the steady-state error of trajectory tracking; 2) a collision
control [6], [7], feedback linearization [14], hybrid super- avoidance mechanism is incorporated to avoid both the
visory control [12], backstepping [17], and sliding mode environmental obstacles and inner-formation vehicles. It is of
control (SMC) [11]. In addition, tremendous attention is significance that the formation can be still kept without any
also paid on the formation control with consideration of collision when one follower UAV deviates from its expected
trajectory in the presence of actuator faults
1 Z. X. Liu is a PhD student with Department of Mechanical The remainder of this paper is organized as follows:
and Industrial Engineering, Concordia University, Montreal, Canada, Section 2 provides necessary preliminaries. The detailed
l zhixia@encs.concordia.ca
2 X. Yu is a Post-doc Fellow with Department of Mechanical design procedure of the proposed control scheme is described
and Industrial Engineering, Concordia University, Montreal, Canada, in Section 3. Simulation results are presented in Section 4,
xiangyu1110@gmail.com while the conclusion is summarized in the last section.
3 C. Yuan is a PhD student with Department of Mechanical
and Industrial Engineering, Concordia University, Montreal, Canada,
chi yua@encs.concordia.ca II. PRELIMINARIES
4 Y. M. Zhang is a Professor currently with the Department of Information
and Control Engineering, Xi’an University of Technology, Xi’an, Shaanxi A. Outer-Loop UAV Kinematics
710048, China and on sabbatical leave from the Department of Mechan-
ical and Industrial Engineering, Concordia University, Montreal, Canada, In this paper, the considered flight formation is leader-
youmin.zhang@concordia.ca follower structure which consists of i (i ≥ 2) UAVs. The
kinematic model of each individual UAV is: where σ = diag{σ1 , σ2 , ..., σm } is the failure pattern matrix.
σi = 1 when the ith actuator fails, otherwise σi = 0.
ẋi = vi cosψi Thus, system (4) in the presence of actuator faults can be
ẏi = vi sinψi (1) rewritten as:
ψ̇i = ωi , ẋ(t) = Ax(t) + B(I − σ)v(t) + Bσ ū. (6)
where (xi , yi ), vi , ψi , and ωi are the position, forward III. FORMATION CONTROLLER DESIGN
velocity, heading angle, and angular velocity of the ith UAV, A. Outer-Loop Controller Design
respectively.
Let (xL , yL ) be the actual position of leader UAV. As 1) Rigid Formation Control Strategy: Defining vi∗ and ωi∗
illustrated in Fig. 1, the actual distances between the leader to be the expected control laws distributing to inner-loop
and the ith UAV along the forward and lateral directions can controller of each follower. (3) can then be reconstructed as:
then be described as: ėf i −vL − dli ωL
=
ėli df i ωL
df i =(xi − xL )cosψi + (yi − yL )sinψi
cos(ψi − ψL ) −Dsin(ψi − ψL ) vi∗
+ Dcos(ψi − ψL ) +
(2) −sin(ψi − ψL ) −Dcos(ψi − ψL ) ωi∗
dli =(xi − xL )sinψi + (yi − yL )cosψi
cos(ψi − ψL ) −Dsin(ψi − ψL ) vi − vi∗
− Dsin(ψi − ψL ), +
−sin(ψi − ψL ) −Dcos(ψi − ψL ) ωi − ωi∗
−vL − dli ωL
where D is the distance between the control point and the =
df i ωL
centre of mass [25].
cos(ψi − ψL ) −Dsin(ψi − ψL ) vi∗
Defining the separation distance errors between the desired + .
and actual distances in forward and lateral directions to be −sin(ψi − ψL ) −Dcos(ψi − ψL ) ωi∗
(7)
ef i = df i −ddf i and eli = dli −ddli , where ddf i and ddli namely
To guarantee the effective trajectory tracking performance
represent the desired distances along the forward and lateral
while eliminating the steady-state error of trajectory tracking,
directions. Moreover, let vL , ψL , and ωL denote the forward
a P I controller is applied. The outer-loop controller is
velocity, heading angle, and angular velocity of leader UAV,
thereby designed as:
respectively. The derivation of ef i and eli with regard to time ∗
can then be obtained: vi coseψ −sineψ
=
ωi∗ −D 1
sineψ − D 1
coseψ
ėf i −vL − dli ωL R (8)
= −(k1P ef i + k1I eRf i dt) + vL + dli ωL
ėli df i ωL × ,
−(k2P eli + k2I eli dt) − df i ωL
cos(ψi − ψL ) −Dsin(ψi − ψL ) vi
+ . where eψ = ψi −ψL , k1P , k1I , k2P , k2I > 0 are the feedback
−sin(ψi − ψL ) −Dcos(ψi − ψL ) ωi
(3) gains.
1026
Formation Obstacles
Specifications Other
Vehicles
Environmental
Obstacles &
Other UAVs
Out-loop dL dR
Controller
ψL ψR
(vf ωf)
Collision
Avoidance
Mechanism (vv ωv) (v ω) dmin
dmax
Inner-loop
Controller
(x y)
ith UAV
Fig. 3: Illustration of the collision avoidance mechanism
1027
Firstly, a reference model is constructed as follows:
Af 0 Bf 0
A= ,B =
ẋm (t) = Am xm (t) + Bm r(t), (14) 0 Al 0 Bl
−0.0334 −2.977 0 −9.81
−0.0016 −4.133 0.98 0
where xm (t) ∈ <n , Am ∈ <n×n , Bm ∈ <n×m , r(t) ∈ <m Af =
is a bounded reference input. 0.0077 −140.2 −4.435 0
0 0 1 0
Since the objective of the state feedback state tracking
(SFST) adaptive control [27] is to match the nominal system −0.732 −0.0143 −0.996 0.0706
(6) and reference model (14), if there exist state feedback −893 −9.059 2.044 0
Al =
101.673 0.0186 −1.283
gain Ks and direct adaptive gains Kad1 and Kad2 along 0
with an ideal control law v(t) = KsT x(t) + Kad1 r(t) + Kad2 0 0 1 0
such that the following matching conditions are satisfied: −1.075 −0.2453
0.347 −4.133
Bf =
−140.22
A + B(I − σ)KsT = Am ; B(I − σ)Kad1 = Bm ; 0
(15) 0 0
B(I − σ)Kad2 = −Bσ ū.
0 0.244
328.653 308.498
When the adaptive feedback control law is considered as: Bl =
47.528 102.891
0 0
v(t) = K̂sT x(t) + K̂ad1 r(t) + K̂ad2 , (16) C=
1 0 0 0 0 0 0 0
0 0 0 0 −1 0 0 1
where K̂s , K̂ad1 , and K̂ad2 denote the estimates of Ks , The desired forward and angular velocities of the leader
Kad1 , and Kad2 . The error between (6) and (14) is e(t) = ∗ ∗
UAV are vL = 10m/s and ωL = 0.5deg/s. The desired
x(t) − xm (t), the derivative of e(t) can then be obtained: distances between the leader UAV and Follower-1 in forward
and lateral directions are ddf 1 = −100m and ddl1 = −100m,
ė(t) = Am e(t) + B(I − σ)(K̃sT x(t) + K̃ad1 r(t) + K̃ad2 ), while the expected distances between the leader UAV and
(17) Follower-2 with regard to forward and lateral directions are
where the errors between the estimated and actual values are ddf 2 = −100m and ddl2 = 100m. The starting positions
represented as K̃s = K̂s − Ks , K̃ad1 = K̂ad1 − Kad1 , and of leader, Follower-1, and Follower-2 UAVs are (0m, 0m),
K̃ad2 = K̂ad2 − Kad2 . (−100m, −100m), and (−100m, 100m), respectively. The
values of other adopted parameters for the controller design
Consequently, adopting the general adaptive scheme to are all summarized in Table I.
update the parameter estimates of adaptive feedback control
law (16), the adaptation laws can be given by: TABLE I: Parameter values
1028
3500
Leader
Follower−1 Reference Leader Follower−1 Follower−2
3000
Follower−2 30
Obstacle
V (m/s)
2500 20
2000 10
Y Axis (m)
0
1500 0 20 40 60 80 100 120
Obstacle’s trajectory Time (s)
−80
Whilst with the assistance of collision avoidance mechanism,
−100 the Follower-1 UAV can promptly detect the Follower-2
is approaching and maneuver correspondingly to a safe
−120 distance. In addition, the faulty UAV can accommodate the
Follower−1 to Leader
actuator fault and ultimately maintain keeping the expected
Follower−2 to Leader
−140 formation. Fig. 9 shows the corresponding performance of
0 50 100 150 200
Time (s) forward velocities and bank angles of the three UAVs while
200 Follower-2’s actuator fails.
Lateral Distance (m)
100
3500
Leader
0
Follower−1
3000
−100 Follower−2
−200 2500
0 50 100 150 200
Time (s)
2000
Y Axis (m)
C. Scenario 2 V. CONCLUSIONS
Fig. 7 shows a satisfied performance of both obstacle In this paper, a leader-follower formation control scheme
avoidance and FTC strategies while maintaining a rigid with integration of FTC and collision avoidance strategies is
formation after a certain period of regulation. As revealed presented. The characteristics of the proposed method are: 1)
in Fig. 8, when the actuator in Follower-2 UAV is stuck at a FTC function is designed to accommodate the unexpected
60th second, the distances between it and the leader UAV actuator faults so that the formation control can still be
in forward and lateral directions are significantly changed. maintained; 2) a collision avoidance mechanism is developed
1029
Lateral Distance (m) Forward Distance (m) [6] F. Giulietti, M. Innocenti, M. Napolitano, and L. Pollini, “Dynamic and
−80 control issues of formation flight,” Aerospace Science and Technology,
−100 vol. 9, no. 1, pp. 65-71, 2005.
[7] F. Giulietti, L. Pollini, and M. Innocenti, “Autonomous formation
−120 flight,” IEEE Control Systems Magazine, vol. 20, no. 6, pp. 34-44,
Follower−1 to Leader
2000.
−140 Follower−2 to Leader [8] M. Pachter, J. J. Azzo, and A. W. Proud, “Tight formation flight
0 50 100 150 200 control,” AIAA Journal of Guidance, Control, and Dynamics, vol. 24,
Time (s) no. 2, pp. 246-254, 2001.
200 [9] D. M. Stipanovic, G. Inalhan, R. Teo, and C. J. Tomlin, “Decentralized
overlapping control of a formation of unmanned aerial vehicles,”
0 Automatica, vol. 40, no. 8, pp. 1285-1296, 2004.
[10] S. N. Singh, R. Zhang, P. Chandler, and S. Banda, “Decentralized
−200 nonlinear robust control of UAVs in close formation,” International
Journal of Robust and Nonlinear Control, vol. 13, no. 11, pp. 1057-
0 50 100 150 200 1078, 2003.
Time (s) [11] S. N. Singh, M. Pachter, P. Chandler, S. Banda, S. Radmussen, and
C. Schumacher, “Input-output invertibility and sliding mode control
Fig. 8: Distances between the leader and follower UAVs for close formation flying of multiple UAVs,” International Journal of
Robust and Nonlinear Control, vol. 10, no. 10, pp. 779-797, 2000.
[12] A. Karimoddini, H. Lin, B. M. Chen, and T. H. Lee, “Hybrid three-
dimensional formation control for unmanned helicopters,” Automatica,
Reference Leader Follower−1 Follower−2
vol. 49, no. 2, pp. 424-433, 2013.
[13] Y. Gu, B. Seanor, G. Campa, M. R. Napolitano, L. Rowe, S. Gururajan,
30 and S. Wan, “Design and flight testing evaluation of formation control
V (m/s)
100
Fault occurs formation flying with obstacle/collision avoidance,” IEEE Transactions
on Control Systems Technology, vol. 15, no. 4, pp. 672-679, 2007.
50 [16] N. Michael, D. Mellinger, Q. Lindsey, and V. Kumar, “The grasp
multiple micro-UAV testbed,” IEEE Robotics & Automation Magazine,
vol. 17, no. 3, pp. 56-65, 2010.
0 [17] J. Shin, and H. J. Kim, “Nonlinear model predictive formation flight,”
0 50 100 150 200 IEEE Transactions on Systems, Man and Cybernetics, Part A: Systems
Time (s) and Humans, vol. 39, no. 5, pp. 1116-1125, 2009.
[18] T. Paul, T. R. Krogstad, and J. T. Gravdahl, “Modelling of UAV for-
Fig. 9: Forward velocity and bank angle of each UAV in mation flight using 3D potential field,” Simulation Modelling Practice
and Theory, vol. 16, no. 9, pp. 1453-1462, 2008.
formation [19] H. A. Izadi, B. W. Gordon, and Y. M. Zhang, “Decentralized receding
horizon control for cooperative multiple vehicles subject to commu-
nication delay,” AIAA Journal of Guidance, Control, and Dynamics,
vol. 32, no. 6, pp. 1959-1965, 2009.
to re-plan a feasible reference so as to ensure UAVs’ safety [20] A. Abdessameud, and A. Tayebi, “Formation control of VTOL un-
in the presence of potential collision. Two scenarios of manned aerial vehicles with communication delays,” Automatica, vol.
numerical simulation are carried out with consideration of 47, no. 11, pp. 2383-2394, 2011.
[21] H. A. Izadi, B. W. Gordon, and Y. M. Zhang, “Hierarchical decentral-
actuator faults and avoiding obstacles, and the effectiveness ized receding horizon control of multiple vehicles with communication
of the proposed approach is verified. failures,” IEEE Transactions on Aerospace and Electronic Systems,
vol. 49, no. 2, pp. 744-759, 2013.
[22] H. Yang, M. Staroswiecki, B. Jiang, and J. Y. Liu, “Fault tolerant
R EFERENCES cooperative control for a class of nonlinear multi-agent systems,”
Systems and Control Letters, vol. 60, no. 4, pp. 271-277, 2011.
[1] X. Yu, and Y. M. Zhang, “Sense and avoid technologies with applica-
[23] M. M. Tousi, and K. Khorasani, “Optimal hybrid fault recovery in
tions to unmanned aircraft systems: Review and prospects,” Progress
a team of unmanned aerial vehicles,” Automatica, vol. 48, no. 2, pp.
in Aerospace Sciences, vol. 74, pp. 152-166, April 2015.
410-418, 2012.
[2] D. W. Casbeer, D. B. Kingston, R. W. Beard, and T. W. McLain, [24] Q. Xu, H. Yang, B. Jiang, D. Zhou, and Y. M. Zhang, “Fault tolerant
“Cooperative forest fire surveillance using a team of small unmanned formation control of UAVs subject to permanent and intermittent
air vehicles,” International Journal of Systems Science, vol. 37, no. 6, faults,” Journal of Intelligent & Robotic Systems, vol. 73, no. 1-4,
pp. 351-360, 2006. pp. 589-602, 2014.
[3] D. Kingston, R. W. Beard, and R. S. Holt, “Decentralized perimeter [25] F. Fahimi, “Non-linear model predictive formation control for groups
surveillance using a team of UAVs,” IEEE Transactions on Robotics, of autonomous surface vessels,” International Journal of Control, vol.
vol. 24, no. 6, pp. 1394-1404, 2008. 80, no. 8, pp. 1248-1259, 2007.
[4] A. Rango, A. Laliberte, J. E. Herrick, C. Winters, K. Havstad, C. [26] C. De La Cruz, and R. Carelli, “Dynamic model based formation
Steele, and D. Browning, “Unmanned aerial vehicle-based remote control and obstacle avoidance of multi-robot systems,” Robotica, vol.
sensing for rangeland assessment, monitoring, and management,” 26, no. 3, pp. 345-356, 2008.
Journal of Applied Remote Sensing, vol. 3, no. 1, pp. 33542-33542, [27] G. Tao, S. H. Chen, X. D. Tang, and S. M. Joshi, Adaptive control of
2009. systems with actuator failures, London: Springer, 2004.
[5] M. A. Goodrich, B. S. Morse, D. Gerhardt, J. L. Cooper, M. Quigley,
J. A. Adams, and C. Humphrey, “Supporting wilderness search and
rescue using a camera-equipped mini UAV,” Journal of Field Robotics,
vol. 25, no. 1-2, pp. 89-110, 2008.
1030