摘要

针对存放大量杂物的室内环境或室外高楼林立的城市场景的复杂环境,提出一种以Theta*算法做全局路径规划、改进动态窗口法(DWA)追踪路径节点的方法来实现四旋翼在三维环境下的路径规划。相较于先全局静态路径规划后路径C2连续性优化的方法,所提方法可躲避地图中未知障碍物信息并且生成的曲线符合无人机(UAV)动力学约束,保证UAV能够跟随路径而不会发生速度剧烈变化导致姿态错乱的情况。算法最终不仅生成规划好的避障路径,而且也生成电机的转速变化。所提方法可实现在无干扰情况下,仅跟踪电机转速变化就能进行轨迹跟踪,简化了UAV的控制难度。