无人机自适应平滑切换姿态融合算法研究

针对GPS信号丢失导致组合导航算法精度降低甚至发散的难题,开展一种高效的自适应平滑切换融合算法研究.在GPS信号正常情况下,采用基于GPS量测的高阶组合导航算法估计姿态信息;在GPS信号丢失时,停止高阶滤波算法并切换为基于四元数的低阶姿态估计算法;当GPS信号恢复后,将低阶姿态估计算法的估计值作为高阶滤波算法初值,实现姿态估计算法的平滑切换.仿真结果和试飞试验表明,该切换策略具有较好的估计精度和可实现性,且切换过程中姿态角跳变小于0.5°,收敛时间小于0.1 s,有效地提高了有、无GPS信号情况下无人机的姿态估计精度.     

基于综合改进RRT算法的无人机三维航路规划

针对复杂飞行环境下的无人机三维航路规划问题,提出了一种基于快速扩展随机树(RRT)的综合改进航路规划算法.根据实际复杂任务环境,建立三维任务空间模型,并考虑无人机性能约束;通过引入基于概率的启发式策略引导节点扩展方向,加人贪婪策略提高终点扩展方向节点生长速度;提出动态引力步长策略在保证节点搜索概率完备性的同时,降低节点扩展方向的随机性;设计平滑度优化方法改善规划航路曲折问题.仿真结果表明,综合改进RRT算法整体性能较好,具有良好的避障特性.