一种基于数据链测距的多无人车协同导航方法
摘要:
本发明公开了一种基于数据链测距的多无人车协同导航方法。本发明适用于卫星拒止环境下的无人车编队协同导航,利用数据链对无人车之间相对距离进行测量,进而通过多导航传感器信息融合方法对编队中每辆无人车节点的位置进行估计。无人车编队中每辆无人车节点搭载惯性导航系统、车辆里程计、数据链收发装置,首先通过卡尔曼滤波器对每辆无人车节点中的惯性导航系统、车辆里程计进行融合,得到每辆无人车节点的速度、位置、姿态信息;进而利用数据链测得的无人车之间的距离信息,通过等式约束对每辆无人车的位置估计结果进行优化。通过本方法能够提高无人车编队在卫星拒止条件下的导航定位精度。
公开/授权文献
0/0