一种基于双通道航向匹配的车载惯性/卫星组合导航方法
Abstract:
本发明提供了一种基于双通道航向匹配的车载惯性/卫星组合导航方法,包括,计算动态航向匹配的航向量测量,计算卫星水平和速度,判断卫星水平和速度大于第一速度阈值时,计算卫星航迹角,将卫星航迹角转换到导航坐标系下获得卫星航向角,更新航向量测量;计算静态航向匹配的航向量测量,判断车体运动状态,若车体当前时刻处于静止状态,上一时刻处于运动状态,且曾经有卫星水平和速度大于第二速度阈值,锁存当前时刻导航解算输出的航向角,更新航向观测量;基于更新的航向量测量,进行组合卡尔曼滤波估计。本发明通过双通道航向匹配更新航向量测量,提高航向误差可观性,进而提高导航定位、定姿精度。
Patent Agency Ranking
0/0