Cooperative Path Planning for Aerial Recovery of a UAV Swarm Using Genetic Algorithm and Homotopic Approach
Abstract
:1. Introduction
2. Preliminaries and Problem Statement
- Trajectory assumption. The trajectory of the mother aircraft is predefined and it is projected to a two dimensional plane for consideration. The aerial recovery process is considered to be a long-range mission and the execution time of the process is concerned with the mother aircraft trajectory.
- Homogeneous assumption. UAVs in the swarm are homogeneous and fly at the same constant velocity, i.e., they can be recovered by the mother aircraft in an arbitrary sequence.
- Recovery assumption. The mother aircraft employs the airborne actuators to recover the UAVs when they rendezvous at specified recovery positions with the same orientation in the sequence.
- Communication assumption. The mother aircraft is always connected to the UAVs and the communication is perfect without delay and any other unfavorable factors.
- Based on the assumptions, the schematic of the aerial recovery process is illustrated in Figure 1.
2.1. Recovery Scheduling
2.2. Path Planning
- , , .
- , , , .
- is a continuous curve and it has a continuous first derivative.
3. Recovery Planning Framework
3.1. Recovery Scheduling Layer
- In stage 1, the recovery time windows of the UAV swarm are calculated. Since the flight path of the mother aircraft is predetermined, the position of the mother aircraft at any time is fixed. The basic idea of this stage is that when a UAV following a feasible path is capable of arriving at a position earlier than the mother aircraft, the arrival time of the mother aircraft is contained in the recovery time window of the UAV. The UAV can reach the position at this arrival time following a new path with a longer length, in order to rendezvous with the mother aircraft and facilitate a successful recovery.
- In stage 2, the recovery sequence is optimized using a GA. Even with relatively few UAVs, finding the optimal recovery sequence is quite complicated. The GA is an efficient heuristic searching algorithm, and it is suitable enough to solve this scheduling problem. The execution process of the GA is given in Section 4.
- In stage 3, the recovery schedule for the UAVs is generated based on the optimal recovery sequence, based on a similar iteration to Equation (7). Since the mother aircraft trajectory is predefined, the recovery positions on the mother aircraft trajectory can be obtained based on the recovery schedule. Further, the recovery path lengths for the UAVs are obtained since the velocity of the UAVs is known in advance. These results, at this stage, are directly passed to the path planning layer as the input.
3.2. Path Planning Layer
- In stage 1, the Dubins paths bridging the initial position of the UAV and each position of the predefined mother aircraft trajectory are generated based on a sample distance. Given the boundary constraints, the Dubins path was proven to be the shortest curvature-bounded path with the minimum flight time [42] and it has been applied extensively in path planning [43,44]. Combined with the above discussion for the recovery time windows, we can obtain the maximum recovery time window with the Dubins path. As shown in Figure 2, the path estimation results are passed back to the scheduling layer to calculate the recovery time windows.
- In stage 2, the path with the expected length for each UAV is planned based on the recovery position and recovery path length. Only the Dubins path connecting the initial position and recovery position of a UAV is selected from stage 1 of this layer to construct the path homotopy. Then, the homotopic path planning approach is employed to generate a path with the expected length for the UAV. In the end, the related control parameters of the ideal path are transmitted to the control system for path tracking.
4. Methodology
4.1. Genetic Algorithm
- Encoding. To accomplish the genetic operation, an effective representation of the chromosomes must be proposed. As discussed in the second section, each chromosome can be directly encoded by a recovery sequence . The encoding method is, to a certain extent, similar to the path representation in the traveling salesman problem.
- Initialization. In the GA, the searching space, which is called the population, is the collection of recovery sequences. Utilizing the encoding method, the recovery sequences in the original population are randomly created to guarantee the diversity.
- Objective evaluation. During the aerial recovery process, the UAVs need to keep a safe distance between each other to avoid collisions. The fitness value of each recovery sequence can be obtained from Equation (10) if the corresponding trajectories will not cause collisions. Conversely, the recovery sequences that will cause collisions are penalized with the “death penalty”, i.e., they are given a fitness value of −1. Thus, these invalid recovery sequences are eliminated during the evolutionary process.
- Elitism. In each generation, the best recovery sequences form the elite group, and the elite group is copied to the next generation without any other genetic operations. By applying the elite mechanism, the good recovery sequences are reserved during the evolutionary process so that the optimal recovery sequence can be obtained faster.
- Crossover. To perform the crossover operation, two recovery sequences are first selected based on the roulette wheel operator. The order crossover operator (OX1) is used to carry out the crossover operation due to its convenience [45] and the two recovery sequences are applied with the crossover operation, with a relatively high probability . Figure 4 shows an example of the crossover operation. During the crossover operation, a sub-sequence is selected from one of the recovery sequences and it is copied to the same location of the offspring. Then, the other recovery serial numbers are filled with the same order as they appear in another recovery sequence starting from the second crossover point. The other offspring is created through the same process.
- Mutation. The exchange mutation operator (EM) is selected to perform the mutation operation and each recovery serial number is affected by the mutation operator with a low probability . As demonstrated in Figure 5, the mutated recovery serial number swaps its position with another randomly selected recovery serial number in the same recovery sequence.
4.2. Homotopic Path Planning Approach
- .
- and .
- is the space of all curvature-bounded paths between and .
5. Simulation Results
5.1. Evaluation of the Path Length Coverage
5.2. Verification of the Recovery Scheduling
5.3. Overall Performance of the Recovery Planning Framework
6. Conclusions
Author Contributions
Funding
Acknowledgments
Conflicts of Interest
References
- Wu, H.S.; Li, H.; Xiao, R.B.; Liu, J. Modeling and simulation of dynamic ant colony’s labor division for task allocation of UAV swarm. Physica A 2018, 491, 127–141. [Google Scholar] [CrossRef]
- Huang, S.A.; Teo, R.S.H.; Kwan, J.L.P.; Liu, W.Q. Distributed UAV Loss Detection and Auto-replacement Protocol with Guaranteed Properties. J. Intell. Robot. Syst. 2019, 93, 303–316. [Google Scholar] [CrossRef]
- Gremlins. Available online: https://www.darpa.mil/program/gremlins (accessed on 3 May 2020).
- Sun, L.; Beard, R.W.; Colton, M.B.; McLain, T.W. Dynamics and control of cable-drogue system in aerial recovery of micro air vehicles based on Gauss’s principle. In Proceedings of the American Control Conference, St. Louis, MO, USA, 10–12 June 2009. (accessed on 9 April 2020). [Google Scholar]
- Sun, L.; Beard, R.W.; Colton, M.B. Motion planning and control for mothership-cable-drogue systems in aerial recovery of micro air vehicles. In Proceedings of the American Control Conference, Baltimore, MD, USA, 30 June–2 July 2010. (accessed on 15 April 2020). [Google Scholar]
- Sun, L.; Beard, R.W. Towed-body trajectory tracking in aerial recovery of micro air vehicle in the presence of wind. In Proceedings of the American Control Conference, San Francisco, CA, USA, 29 June–1 July 2011. (accessed on 11 April 2020). [Google Scholar]
- Carlson, D.C.; Colton, M.B. Out-of-plane orbit estimation and tracking for aerial recovery of micro air vehicles. In Proceedings of the IEEE International Conference on Robotics and Automation, Anchorage, AK, USA, 3–8 May 2010. (accessed on 3 April 2020). [Google Scholar]
- Dumas, Y.; Desrosiers, J.; Gelinas, E.; Solomon, M.M. An optimal algorithm for the traveling salesman problem with time windows. Oper. Res. 1995, 43, 367–371. [Google Scholar] [CrossRef] [Green Version]
- Balas, E.; Simonetti, N. Linear time dynamic-programming algorithms for new classes of restricted TSPs: A computational study. INFORMS J. Comput. 2001, 13, 56–75. [Google Scholar] [CrossRef] [Green Version]
- Desrochers, M.; Desrosiers, J.; Solomon, M.M. A new optimization algorithm for the vehicle routing problem with time windows. Oper. Res. 1992, 40, 342–354. [Google Scholar] [CrossRef]
- Mathew, N.; Smith, S.L.; Waslander, S.L. Multirobot Rendezvous Planning for Recharging in Persistent Tasks. IEEE Trans. Robot. 2015, 31, 128–142. [Google Scholar] [CrossRef]
- D’Ariano, A.; Pacciarelli, D.; Pranzo, M. A branch and bound algorithm for scheduling trains in a railway network. Eur. J. Oper. Res. 2007, 183, 643–657. [Google Scholar] [CrossRef]
- Qin, H.; Zhang, Z.Z.; Lim, A.; Liang, X.C. An enhanced branch-and-bound algorithm for the talent scheduling problem. Eur. J. Oper. Res. 2016, 250, 412–426. [Google Scholar] [CrossRef] [Green Version]
- Kis, T.; Kova´cs, A. A cutting plane approach for integrated planning and scheduling. Comput. Oper. Res. 2012, 3, 320–327. [Google Scholar] [CrossRef]
- Karimi-Nasab, M.; Seyedhoseini, S.M. Multi-level lot sizing and job shop scheduling with compressible process times: A cutting plane approach. Eur. J. Oper. Res. 2013, 231, 598–616. [Google Scholar] [CrossRef]
- Tahar, D.N.; Yalaoui, F.; Chu, C.B.; Amodeo, L. A linear programming approach for identical parallel machine scheduling with job splitting and sequence-dependent setup times. Int. J. Prod. Econ. 2006, 99, 63–73. [Google Scholar] [CrossRef]
- Montero, A.; Méndez-Díaz, I.; Miranda-Bront, J.J. An integer programming approach for the time-dependent traveling salesman problem with time windows. Comput. Oper. Res. 2017, 88, 280–289. [Google Scholar] [CrossRef]
- Yang, J.B. GA-based discrete dynamic programming approach for scheduling in FMS environments. IEEE Trans. Syst. Man Cybern. Part B-Cybern. 2001, 31, 824–835. [Google Scholar] [CrossRef]
- Jin, Z.P.; Shima, T.; Schumacher, C.J. Optimal Scheduling for Refueling Multiple autonomous aerial vehicles. IEEE Trans. Robot. 2006, 22, 682–693. [Google Scholar]
- Shima, T.; Rasmussen, S.J.; Sparks, A.G.; Passino, K.M. Multiple task assignments for cooperating uninhabited aerial vehicles using genetic algorithms. Comput. Oper. Res. 2006, 33, 3252–3269. [Google Scholar] [CrossRef]
- Wei, H.J.; Li, S.B.; Jiang, H.M.; Hu, J.; Hu, J.J. Hybrid genetic simulated annealing algorithm for improved flow shop scheduling with makespan criterion. Appl. Sci. 2018, 8, 2621. [Google Scholar] [CrossRef] [Green Version]
- Liu, Y.B.; Qi, N.M.; Yao, W.R.; Liu, Y.F.; Li, Y. Optimal scheduling for aerial recovery of multiple unmanned aerial vehicles using genetic algorithm. Proc. Inst. Mech. Eng. Part G-J. Aerosp. Eng. 2019, 233, 5347–5359. [Google Scholar] [CrossRef]
- Gajpal, Y.; Rajendran, C. An ant-colony optimization algorithm for minimizing the completion-time variance of jobs in flowshops. Int. J. Prod. Econ. 2006, 101, 259–272. [Google Scholar] [CrossRef]
- Vlachos, A. Ant Colony System algorithm solving a Thermal Generator Maintenance Scheduling Problem. J. Intell. Fuzzy Syst. 2013, 24, 713–723. [Google Scholar] [CrossRef]
- Ponnambalam, S.G.; Jawahar, N.; Aravindan, P. A simulated annealing algorithm for job shop scheduling. Prod. Plan. Control 1999, 10, 767–777. [Google Scholar] [CrossRef]
- Cruz-Chávez, M.A.; Martınez-Rangel, M.G.; Cruz-Rosales, M.H. Accelerated simulated annealing algorithm applied to the flexible job shop scheduling problem. Int. Trans. Oper. Res. 2017, 24, 1119–1137. [Google Scholar] [CrossRef]
- Cruz-Chávez, M.A.; Peralta-Abarca, J.C.; Cruz-Rosales, M.H. Cooperative Threads with Effective-Address in Simulated Annealing Algorithm to Job Shop Scheduling Problems. Appl. Sci. 2019, 9, 3360. [Google Scholar] [CrossRef] [Green Version]
- Shutler, P.M.E. A priority list based heuristic for the job shop problem: Part 2 tabu search. J. Oper. Res. Soc. 2004, 55, 780–784. [Google Scholar] [CrossRef]
- Raza, S.A.; Akgunduz, A.; Chen, M.Y. A tabu search algorithm for solving economic lot scheduling problem. J. Heuristics 2006, 12, 413–426. [Google Scholar] [CrossRef]
- Meyer, Y.; Isaiah, P.; Shima, T. On Dubins paths to intercept a moving target. Automatica 2015, 53, 256–263. [Google Scholar] [CrossRef]
- Schumacher, C.; Chandler, P.R.; Rasmussen, S.J.; Walker, D. Path Elongation for UAV Task Assignment. In Proceedings of the AIAA Guidance, Navigation, and Control Conference, Austin, TX, USA, 11–14 August 2003. [Google Scholar]
- Yao, W.R.; Qi, N.M.; Zhao, J.; Wan, N. Bounded curvature path planning with expected length for Dubins vehicle entering target manifold. Robot. Auton. Syst. 2017, 97, 217–229. [Google Scholar] [CrossRef]
- Sun, X.J.; Wang, G.F.; Fan, Y.S.; Mu, D.D.; Qiu, B.B. An Automatic Navigation System for Unmanned Surface Vehicles in Realistic Sea Environments. Appl. Sci. 2018, 8, 193. [Google Scholar]
- Stodola, P. Route Optimization for Cooperative Aerial Reconnaissance. In Proceedings of the Modelling and Simulation for Autonomous Systems, Rome, Italy, 24–26 October 2017. [Google Scholar]
- Shao, S.K.; Peng, Y.; He, C.L.; Du, Y. Efficient path planning for UAV formation via comprehensively improved particle swarm optimization. ISA Trans. 2020, 97, 415–430. [Google Scholar] [CrossRef]
- Thanh, H.L.N.N.; Hong, S.K. Completion of Collision Avoidance Control Algorithm for Multicopters Based on Geometrical Constraints. IEEE Access 2018, 6, 27111–27126. [Google Scholar] [CrossRef]
- Ha, L.N.N.T.; Bui, D.H.P.; Hong, S.K. Nonlinear Control for Autonomous Trajectory Tracking While Considering Collision Avoidance of UAVs Based on Geometric Relations. Energies 2019, 12, 1551. [Google Scholar] [CrossRef] [Green Version]
- Cong, Y.Z.; Du, H.B.; Jin, Q.C.; Zhu, W.W.; Lin, X.Z. Formation control for multiquadrotor aircraft: Connectivity preserving and collision avoidance. Int. J. Robust Nonlinear Control 2020, 30, 2352–2366. [Google Scholar] [CrossRef]
- Vachtsevanos, G.; Tang, L.; Drozeski, G.; Gutierrez, L. From mission planning to flight control of unmanned aerial vehicles: Strategies and implementation tools. Annu. Rev. Control 2005, 29, 101–115. [Google Scholar] [CrossRef]
- Shanmugavel, M.; Tsourdos, A.; White, B.; Żbikowski, R. Co-operative path planning of multiple UAVs using Dubins paths with clothoid arcs. Control Eng. Pract. 2010, 18, 1084–1092. [Google Scholar] [CrossRef]
- Yao, W.R.; Qi, N.M.; Wan, N.; Liu, Y.B. An iterative strategy for task assignment and path planning of distributed multiple unmanned aerial vehicles. Aerosp. Sci. Technol. 2019, 86, 455–464. [Google Scholar] [CrossRef]
- Dubins, L.E. On curves of minimal length with a constraint on average curvature, and with prescribed initial and terminal positions and tangents. Am. J. Math. 1957, 79, 497–516. [Google Scholar] [CrossRef]
- Manathara, J.G.; Ghose, D. Rendezvous of multiple UAVs with collision avoidance using consensus. J. Aerosp. Eng. 2012, 25, 480–489. [Google Scholar] [CrossRef] [Green Version]
- Wang, Y.; Wang, S.; Tan, M.; Zhou, C.; Wei, Q.P. Real-time dynamic Dubins-Helix method for 3-D trajectory smoothing. IEEE Trans. Control Syst. Technol. 2014, 23, 730–736. [Google Scholar] [CrossRef]
- Larranaga, P.; Kuijpers, C.M.H.; Murga, R.H.; Inza, I.; Dizdarevic, S. Genetic algorithms for the travelling salesman problem: A review of representations and operators. Artif. Intell. Rev. 1999, 13, 129–170. [Google Scholar] [CrossRef]
Index | Coordinate of the Recovery Position (km) | Heading Angle of the Recovery Position (Degree) |
---|---|---|
(a) | (12.5,0) | 45 |
(b) | (12.5,0) | 135 |
(c) | (12.5,0) | −135 |
(d) | (12.5,0) | −45 |
(e) | (25,0) | 45 |
(f) | (25,0) | 135 |
(g) | (25,0) | −135 |
(h) | (25,0) | −45 |
Index | Path Length Coverage Interval of Path Homotopy 1 (km) | Path Length Coverage Interval of Path Homotopy 2 (km) |
---|---|---|
(a) | [0, 19.63] | [12.56, +∞) |
(b) | [0, 19.70] | [12.56, +∞) |
(c) | [0, 19.76] | [12.56, +∞) |
(d) | [0, 19.83] | [12.56, +∞) |
(e) | [0, 26.79] | [12.56, +∞) |
(f) | [0, 26.84] | [12.56, +∞) |
(g) | [0, 26.89] | [12.56, +∞) |
(h) | [0, 26.94] | [12.56, +∞) |
UAV Index | Initial Position (km) | Initial Direction (Degree) |
---|---|---|
1 | (8,52) | 11.25 |
2 | (80,65) | 56.25 |
3 | (10,30) | −90 |
UAV Index | Initial Position (km) | Initial Direction (degree) |
---|---|---|
1 | (112.14,8.81) | −126.32 |
2 | (15.92,33.11) | 76.14 |
3 | (58.20,53.44) | 2.34 |
4 | (80.60,139.85) | −166.28 |
5 | (196.66,14.64) | 126.41 |
6 | (47.16,143.79) | 85.46 |
7 | (110.57,149.48) | 100.87 |
8 | (66.92,67.88) | −175.92 |
9 | (62.24,89.75) | 14.43 |
10 | (64.45,10.75) | 168.71 |
11 | (67.24,166.73) | 125.25 |
12 | (109.31,92.17) | −170.33 |
13 | (122.10,177.38) | −113.12 |
14 | (3.52,41.84) | −24.50 |
15 | (64.07,110.61) | 106.88 |
16 | (147.39,9.81) | 116.26 |
17 | (138.77,155.22) | 11.44 |
18 | (146.05,62.70) | −68.80 |
19 | (178.55,82.65) | 130.13 |
20 | (108.69,154.81) | −31.60 |
21 | (145.63,34.32) | 90.13 |
22 | (194.31,109.47) | −104.30 |
23 | (34.63,180.37) | 23.16 |
24 | (173.51,179.49) | 98.03 |
25 | (38.05,27.44) | −62.11 |
26 | (199.72,62.28) | 116.80 |
27 | (95.72,187.33) | 41.86 |
28 | (45.29,171.27) | −47.51 |
29 | (78.91,66.34) | −42.99 |
30 | (33.04,150.45) | 2.809 |
Parameter | Ng | Np | Ne | Pc | Pm |
---|---|---|---|---|---|
Value | 3000 | 100 | 3 | 0.95 | 0.01 |
Objective Value 1 | Non-Maneuvering Mother Aircraft | Maneuvering Mother Aircraft | ||||
---|---|---|---|---|---|---|
N = 10 | N = 20 | N = 30 | N = 10 | N = 20 | N = 30 | |
Mean | 52.56 | 72.82 | 71.50 | 72.66 | 88.65 | 90.77 |
St Dev | 0 | 0 | 1.73 | 0 | 0.35 | 2.29 |
Best | 52.56 | 72.82 | 73.66 | 72.66 | 89.22 | 92.97 |
© 2020 by the authors. Licensee MDPI, Basel, Switzerland. This article is an open access article distributed under the terms and conditions of the Creative Commons Attribution (CC BY) license (http://creativecommons.org/licenses/by/4.0/).
Share and Cite
Liu, Y.; Qi, N.; Yao, W.; Zhao, J.; Xu, S. Cooperative Path Planning for Aerial Recovery of a UAV Swarm Using Genetic Algorithm and Homotopic Approach. Appl. Sci. 2020, 10, 4154. https://doi.org/10.3390/app10124154
Liu Y, Qi N, Yao W, Zhao J, Xu S. Cooperative Path Planning for Aerial Recovery of a UAV Swarm Using Genetic Algorithm and Homotopic Approach. Applied Sciences. 2020; 10(12):4154. https://doi.org/10.3390/app10124154
Chicago/Turabian StyleLiu, Yongbei, Naiming Qi, Weiran Yao, Jun Zhao, and Song Xu. 2020. "Cooperative Path Planning for Aerial Recovery of a UAV Swarm Using Genetic Algorithm and Homotopic Approach" Applied Sciences 10, no. 12: 4154. https://doi.org/10.3390/app10124154
APA StyleLiu, Y., Qi, N., Yao, W., Zhao, J., & Xu, S. (2020). Cooperative Path Planning for Aerial Recovery of a UAV Swarm Using Genetic Algorithm and Homotopic Approach. Applied Sciences, 10(12), 4154. https://doi.org/10.3390/app10124154