论文部分内容阅读
针对惯性导航单独定姿、定位产生漂移的问题,提出了一种磁力计、GPS辅助惯性导航的组合导航系统。对磁力计、陀螺仪数据进行预处理;推导了基于误差四元数的定姿系统方程和量测方程,使用卡尔曼滤波器融合陀螺仪与磁力计数据。建立定位系统方程和量测方程,使用GPS量测值辅助惯导、校正位置、速度信息。实验验证结果表明:组合导航系统有效地改善了惯性导航漂移问题,同时在GPS失效情况下仍能正常工作。