1. Science and Technology on UAV Laboratory at Northwestern Polytechnical University, Xi'an 710072, China;
2. UAV Research Institute, Northwestern Polytechnical University, Xi'an 710072, China;
3. Xi'an Institute of Applied Optics, Xi'an 710065, China
When flying in dynamic environment, fixed-wing UAV (unmanned aerial vehicle) following the reference path will collide with unknown obstacles. To solve the problems, a real-time obstacle avoidance path following algorithm is proposed. Firstly, 3-D Pythagorean hodograph (PH) is adopted as a reference flight path for its continuous curvature and smoothness, which is able to meet the kinematical constraint of fixed-wing UAV and is more suitable for path following. Then, sufficient conditions of stably following a parameterized path in three dimensions are given. A nonlinear model predictive controller is designed for 3-D PH path following, in which the form of objective function is modified to make the UAV timely avoid large unknown static and moving obstacles and fly towards the target after obstacle avoidance during path following. Finally, MATLAB based simulation experiments are performed to demonstrate the effectiveness of the algorithm.
 Zheng C W, Xu F J, Hu X H, et al. Online route planner for unmanned air vehicle navigation in unknown battlefield environment[C]//Computational Engineering in Systems Applications, IMACS Multiconference. Piscataway, USA: IEEE, 2006: 814-818. Wang X H, Yadav V, Balakrishnan S N. Cooperative UAV formation flying with obstacle/collision avoidance[J]. IEEE Transactions on Control Systems Technology, 2007, 15(4): 672-679.  Nikolos I K, Valavanis K P, Tsourveloudis N C, et al. Evolutionary algorithm based offline/online path planner for UAV navigation[J]. IEEE Transactions on Systems, Man, and Cybernetics, Part B: Cybernetics, 2003, 33(6): 898-912.  Paul T, Krogstad T R, Gravdahl J T. Modelling of UAV formation flight using 3D potential field[J]. Simulation Modelling Practice and Theory, 2008, 16(9): 1453-1462.  Shah M A, Aouf N. Dynamic cooperative perception and path planning for collision avoidance[C]//ISMA'09 on Mechatronics and Its Applications. Piscataway, USA: IEEE, 2009: 1-7. 陈洋, 赵新刚, 韩建达.移动机器人3维路径规划方法综述[J].机器人, 2010, 32(4):568-576.Chen Y, Zhao X G, Han J D. Review of 3D path planning methods for mobile robot[J]. Robot, 2010, 32(4): 568-576. Qin S J, Badgwell T A. A survey of industrial model predictive control technology[J]. Control Engineering Practice, 2003, 11: 733-764. Kang Y, Hedrick J K. Design of nonlinear model predictive controller for a small fixed-wing unmanned aerial vehicle[R]. Reston, USA: AIAA, 2006. Tsourdos A, White B, Shanmugavel M. Cooperative path planning of unmanned aerial vehicle[M]. Hoboken, USA: John Wiley & Sons Inc., 2011: 19-20. Farouki R T, Sakkalis T. Pythagorean hodographs[J]. IBM Journal of Research and Development, 1990, 34(5): 736-752.  Farouki R T. The elastic bending energy of Pythagorean hodograph curves[J]. Computer Aided Geometric Design, 1996, 13(3): 227-241.  Farouki R T, Neff C A. Hermite interpolation by Pythagorean hodograph quintics[J]. Mathematics of Computation, 1995, 64(212): 1589-1609.  Armando A N, Douglas G M, Mario F M C. On the generation of trajectories for multiple UAVs in environments with obstacles[J]. Journal of Intelligent & Robotic Systems, 2010, 57(1/2/3/4): 123-141. 方振平, 陈万春, 张曙光.航空飞行器飞行动力学[M].北京:北京航空航天大学出版社, 2005: 93-116.Fang Z P, Chen W C, Zhang S G. Flight dynamics of aircraft[M]. Beijing: Beihang University Press, 2005: 93-116.