基于光纤陀螺、速度传感器和GPS的实时精确位姿估计方法

摘要

本发明提供一种基于光纤陀螺、速度传感器和GPS的实时精确位姿估计方法，其中基于车体运动模型的无人车局部定位算法主要基于二维平面的航迹推算原理，通过前一时刻的车体传感器的速度、航向信息估计车体当前的局部位姿，并利用线性模型补偿陀螺航向的累积误差，提高了局部定位系统的精度；而利用迭代最近点算法配准GPS和局部位姿测量系统的位姿估计方法能够校正局部定位的累积误差，有效消除GPS的随机噪声，并在GPS完全失效或者出现故障的情况下保持位姿的精度，跑车试验结果表明，本发明提出的方法能够很好的融合多传感信息，在多树木、多建筑物的城区环境中可以为无人车提供可靠连续的定位信息，此外，该方法还具有很好的实时性。