摘要
针对多无人机协同定位时,轮询通讯架构下传统滤波方法无法抑制惯性导航系统误差累积发散的问题,提出了一种基于相对距离信息辅助的多无人机协同优化方法。以惯性导航系统为核心构建惯性预积分因子节点和相对距离信息协同因子节点组成因子图优化模型,引入时间滑动窗口,构建量测残差代价函数,利用Gauss-Newton最小二乘迭代对无人机的最优状态进行求解。仿真实验表明,在轮询通讯架构下,所提出的方法能够实现多无人机编队的高精度协同定位,达到广播式通讯架构定位精度水平,相较传统扩展卡尔曼滤波(EKF)方法,定位误差降低了73.8%。
-
单位南京航空航天大学; 自动化学院