引用本文:方旭,刘金琨.四旋翼无人机三维航迹规划及跟踪控制[J].控制理论与应用,2015,32(8):1120~1128.[点击复制]
FANG Xu,LIU Jin-kun.Three-dimension path planning and trajectory tracking control for quadrotor unmanned aerial vehicle[J].Control Theory and Technology,2015,32(8):1120~1128.[点击复制]
四旋翼无人机三维航迹规划及跟踪控制
Three-dimension path planning and trajectory tracking control for quadrotor unmanned aerial vehicle
摘要点击 4806  全文点击 3713  投稿时间：2015-01-18  修订日期：2015-09-02
查看全文  查看/发表评论  下载PDF阅读器
DOI编号  10.7641/CTA.2015.50049
  2015,32(8):1120-1128
中文关键词  人工势场  航迹规划  空间圆弧插补  渐近稳定  控制算法  四旋翼无人机
英文关键词  artificial potential field  path planning  space circle interpolation  asymptotic stability  control algorithms  quadrotor unmanned aerial vehicles
基金项目  高等学校博士学科点专项科研基金(20121102110008)资助.
作者单位E-mail
方旭 北京航空航天大学 自动化科学与电气工程学院 fangxubuaa@126.com 
刘金琨* 北京航空航天大学 自动化科学与电气工程学院 ljk@buaa.edu.cn 
中文摘要
      无人机航迹规划是指根据地形和威胁分布, 规划出满足任务要求的合理航迹. 为了满足三维空间快速规划的需求, 提出了一种基于人工势场的三维航迹规划方法. 首先, 定义了目标和威胁物的虚拟力函数, 推导出了三维空间参数约束方程, 并采用联合威胁概念解决三维空间局部极小和振动问题; 其次, 引入空间圆弧插补技术生成光滑航迹; 此外，为方便跟踪控制，提出了航迹时域化方法; 最后, 利用动态系统全局渐近稳定定理, 设计具有全 局Lipschitz的闭环系统, 实现了具有内外环严格稳定性的双环轨迹跟踪控制. 仿真结果验证了航迹规划和跟踪算法 的有效性.
英文摘要
      Path planning of unmanned aerial vehicle (UAV) is to design a reasonable path which satisfies task requirements according to the distribution of terrains and threats. In order to meet three-dimension rapid path planning requirements, a three-dimension path planning method based on artificial potential filed is proposed. Firstly, the virtual force functions of goal and threats are defined, and three-dimension parameter constraint equations are deduced. The concept of combination of threats is proposed by us to deal with the space local minimal problem and the oscillation problem. Secondly, space circle interpolation is introduced to generate the smooth path. Besides, the time domain method for planning the smooth path is employed because it is convenient to UAV path tracking control. Finally, By virtue of global asymptotic stability theory, a closed-loop system that is global Lipschitz is designed, which guarantees the strict overall stability tracking control in the internal and the external loop. Simulations results validate the designed performance of path planning method and tracking control.