3维动态环境下的无人机路径跟踪算法

被引:25
作者
王怿 [1 ]
祝小平 [2 ]
周洲 [1 ]
张慧 [3 ]
机构
[1] 西北工业大学无人机特种技术重点实验室
[2] 西北工业大学无人机研究所
[3] 中国兵器工业第二〇五研究所
关键词
避障; 路径跟踪; 毕达哥拉斯速端曲线; 无人机;
D O I
暂无
中图分类号
V279 [无人驾驶飞机];
学科分类号
1111 ;
摘要
针对固定翼无人机在动态环境下沿参考轨迹飞行时可能与未知障碍物发生碰撞的问题,提出了可实时避障的路径跟踪算法.采用3维毕达哥拉斯速端曲线(PH)作为参考飞行路径.PH曲线具有曲率连续、曲线平滑等特性,能满足固定翼无人机运动学约束,适于无人机飞行跟踪控制实现.给出了3维空间内稳定跟踪参数化曲线路径的充分条件.设计了非线性模型预测控制器使无人机能稳定跟踪3维PH参考路径,并改进了目标函数形式使无人机在沿参考路径飞行时能及时避开环境中未知的大型静止障碍物和移动障碍物,在避障后继续朝目标点飞行.最后通过MATLAB仿真实验验证了算法的有效性.
引用
收藏
页码:83 / 91
页数:9
相关论文
共 7 条
[1]   移动机器人3维路径规划方法综述 [J].
陈洋 ;
赵新刚 ;
韩建达 .
机器人, 2010, 32 (04) :568-576
[2]  
航空飞行器飞行动力学[M]. 北京航空航天大学出版社 , 方振平, 2005
[3]  
On the Generation of Trajectories for Multiple UAVs in Environments with Obstacles[J] . Armando Alves Neto,Douglas G. Macharet,Mario F. M. Campos.Journal of Intelligent and Robotic Systems . 2010 (1)
[4]   Modelling of UAV formation flight using 3D potential field [J].
Paul, Tobias ;
Krogstad, Thomas R. ;
Gravdahl, Jan Tommy .
SIMULATION MODELLING PRACTICE AND THEORY, 2008, 16 (09) :1453-1462
[5]  
A survey of industrial model predictive control technology[J] . S.Joe Qin,Thomas A. Badgwell.Control Engineering Practice . 2002 (7)
[6]   The elastic bending energy of Pythagorean-hodograph curves [J].
Farouki, RT .
COMPUTER AIDED GEOMETRIC DESIGN, 1996, 13 (03) :227-241
[7]   HERMITE INTERPOLATION BY PYTHAGOREAN HODOGRAPH QUINTICS [J].
FAROUKI, RT ;
NEFF, CA .
MATHEMATICS OF COMPUTATION, 1995, 64 (212) :1589-1609