Trajectory Planning and Interactive Simulation Software Design for Flight Vehicle with Specified Terminal Time

doi:10.16182/j.issn1004731x.joss.201808018

Abstract

Abstract: Specified terminal time is a special requirement in some path planning problems. It is difficult to solve in real time with specified time, angle and multiple no-fly zones considered. A practical path model is utilized, and a nonlinear optimization problem with respect to waypoints is reformulated. The requirements on time, angle and obstacle avoidance for original path planning problem are converted into constraints of the proposed optimization after geometrical relationships are identified. The optimization problem is established and met the form of sequential quadratic programming problem which is solved by SNOPT (Sparse Nonlinear OPTimizer) package. A computer-aid interactive simulation platform based on Windows OS is designed by MFC (Microsoft Foundation Classes). Simulations verify the effectiveness of the proposed algorithm and the flexibility of the interactive platform.

Key words: specified terminal time, path planning, no-fly zones, nonlinear programming, interactive platform

CLC Number:

TP391.72

Sun Mingwei, Ma Shunjian, Chen Zengqiang, Hu Chaofang. Trajectory Planning and Interactive Simulation Software Design for Flight Vehicle with Specified Terminal Time[J]. Journal of System Simulation, 2018, 30(8): 2966-2972.

References

[1] 刘钢, 老松杨, 谭东风, 等. 反舰导弹航路规划问题的研究现状与进展[J]. 自动化学报, 2013, 39(4): 347-359.
Liu G, Lao S Y, Tan D F, et al.Research Status and Progress on Anti-Ship Missile Path Planning[J]. Acta Automatica Sinica, 2013, 39(4): 347-359.
[2] 杨润洲, 丁勇, 张承果. 基于DTW的改进A*算法在航迹规划中的应用[J]. 电光与控制, 2016, 23(6): 5-10.
Yang R Z, Ding Y, Zhang C G.Application of the Improved A* Algorithm Based on DTW in Route Planning[J]. Electronics Optics & Control, 2016, 23(6): 5-10.
[3] 占伟伟, 王伟, 陈能成, 等. 一种利用改进A*算法的无人机航迹规划[J]. 武汉大学学报(信息科学版), 2015, 40(3): 315-320.
Zhan W W, Wang W, Chen N C, et al.Path Planning Strategies for UAV Based on Improved A* Algorithm[J]. Geomatics and Information Science of Wuhan University, 2015, 40(3): 315-320.
[4] 何兵, 刘刚, 赵鹏涛, 等. 基于改进量子遗传算法的巡航导弹水平航迹规划[J]. 计算机仿真, 2010, 29(9): 106-109.
He B, Liu G, Zhao P T, et al.Horizontal Route Planning of Cruise Missile Based On the Improved Quantum Genetic Algorithm[J]. Computer Simulation, 2010, 29(9): 106-109.
[5] 张玉广, 谢文俊, 赵晓林. 基于改进粒子群算法的无人机作战飞机航迹规划[J]. 现代计算机(专业版), 2015(8): 14-18.
Zhang Y G, Xie W J, Zhao X L.Route Planning of Unmanned Combat Aerial Vehicles Based on Improved Particle Swarm Optimization Algorithm[J]. Modern Computer, 2015(8): 14-18.
[6] She H P, Yang S X, Ni H, et al.A Nonlinear Optimal Guidance Law with Terminal Impact Angle Constraint[J]. International Journal of Computational Intelligence Systems (S1875-6891), 2011, 4(6): 1319-1324.
[7] Wang X L, Zhang Y, Wu H L.Sliding mode control based impact angle control guidance considering the seeker?s field-of-view constraint[J]. ISA Transactions (S0019-0578), 2016, 61: 49-59.
[8] Zhang Y X, Sun M W, Chen Z Q.Finite-time convergent guidance law with impact angle constraint based on sliding-mode control[J]. Nonlinear Dynamics (S0924-090X), 2012, 70(1): 619-625.
[9] Zhao Y, Sheng Y Z, Liu X D.Trajectory reshaping based guidance with impact time and angle constraints[J]. Chinese Journal of Aeronautics (S1000-9361), 2016, 29(4): 984-994.
[10] 张友安, 张友根, 李恒. 基于CCC路径规划的撞击时间与撞击角度控制[C]//第三十一届中国控制会议, 中国: 合肥, 2012: 4300-4305.
Zhang Y A, Zhang Y G, Li H.Impact Time and Impact Angle Control Based on CCC Path Planning[C]// 31st Chinese Control Conference, Hefei, China, 2012, 4300-4305.
[11] 方研, 马克茂, 陈宇青. 带有攻击角度和时间约束的协同制导律设计[J]. 系统仿真学报, 2014, 26(10): 2434-2441.
Fang Y, Ma K M, Chen Y Q.Cooperative Guidance Laws with Constraints on Impact Time and Terminal Angle[J]. Journal of System Simulation , 2014, 26(10): 2434-2441.
[12] Zhang L M, Sun M W, Chen Z Q, et al.Receding Horizon Trajectory Optimization with Terminal Impact Specifications[J]. Mathematical Problems in Engineering (S1024-123X), 2014, 2014: 604705.
[13] Yeol J W, Hwang Y W.Parametrization of nonlinear trajectory for time optimal 2D path planning for Unmanned Aerial Vehicles[C]//Proceedings of the 2016 2nd International Conference on Control, Automation and Robotics, 2016: 28-30.
[14] Wilson R B.A Simplicial Algorithm for Concave Programming [D]. Boston: Harvard University, 1963.
[15] Han S P.A Globally Convergent Method for Nonlinear Programming[J]. Journal of Optimization Theory and Applications (S0022-3239), 1977, 22(3): 297-309.
[16] Powell M J D. A Fast Algorithm For Nonlinearly Constrained Optimization Calculations[M]. Berlin, Heidelberg: Springer. 1978: 144-157.
[17] Chamberlain R M, Powell M J D, Lemarechal C, et al. The watchdog technique for forcing convergence in algorithms for constrained optimization[M]. Berlin, Heidelberg: Springer, 1982: 1-17.
[18] 吕鸿雁, 曹达敏, 赵琳. 基于SQP寻优的飞行轨迹规划方法研究[J]. 计算机仿真, 2015, 32(1): 99-102.
Lv H Y, Cao D M, Zhao L.Study of Flight Trajectory Optimization Based on SQP[J]. Computer Simulation, 2015, 32(1): 99-102.
[19] Gill P E, Wong E.Sequential Quadratic Programming Methods[M]. New York: Springer New York, 2012: 147-224.
[20] 刘鹏, 赵吉松, 谷良贤. 三维高超声速飞行器再入轨迹快速优化[J]. 飞行力学, 2012, 30(3): 263-266.
LIU Peng, ZHAO Jisong, GU Liangxian.Rapid Approach for Three-Dimensional Trajectory Optimization of Hypersonic Reentry Vehicles[J]. Flight Dynamics, 2012, 30(3): 263-266.
[21] Gill P E, Murray W, Saunders M A, et al.User's Guide for SNOPT Version 7.5: Software for Large-Scale Nonlinear Programming [R]. UCSD-CCoM Technical Report 15-4, University of California, San Diego, 2015.
[22] 杨建昌. GDI+高级编程[M]. 北京: 清华大学出版社, 2010.
Yang J C.GDI+ Advanced Programming [M]. Beijing: Tsinghua University Press, 2010.