作者:梅春波 秦永元 付强文 严恭敏动基座对准rodrigues参数非线性量测完整泰勒级数奇异点
摘要:对GPS辅助下,捷联惯导系统动基座对准问题进行了研究。利用姿态阵分解,将动态对准问题转换为一个常值姿态的估计,采用Rodrigues参数进行姿态描述,建立了系统方程线性,量测方程具有二阶非线性的对准模型,进而推导了基于二阶非线性量测完整泰勒级数展开的滤波算法。同时,对Rodrigues参数描述姿态时的奇异点问题进行了详细地讨论,设计了能自动判别并规避奇异点的滤波对准方案。以车辆典型机动轨迹为对象进行了蒙特卡洛仿真,结果表明,所设计算法能够在5 s内实现奇异点的判别及处理,且当GPS速度误差为0.1 m/s,位置误差为3 m,更新率为1 s时,惯性级捷联惯导系统在120 s时间内,可以达到水平姿态误差角均方根小于10″,方位误差角均方根小于4′的对准精度。
注:因版权方要求,不能公开全文,如需全文,请咨询杂志社