一种多源融合导航系统的导航方法和装置
摘要:
本发明公开了一种多源融合导航系统的导航方法和装置,包括:构造零速检测统计量;构造因子图;构造零速修正因子节点;因子图的计算。本发明利用输出的位姿变化量作为检测量进行广义似然比零速检测,检测到载体处于零速时,不增加新的因子节点,有效减轻了因子图的存储量和计算量;多源融合导航系统的测量值仍然对系统状态进行约束和更新,保证了零速时系统状态值估计的正确性。
公开/授权文献
0/0