一种基于微惯性和地磁技术的自适应三维姿态定位方法

摘要

本发明公开一种基于微惯性和地磁技术的自适应三维姿态定位方法，包括：1)利用微惯性测量装置中的传感器感应载体的运动姿态；2)设置装置的初始姿态及全局坐标系下的加速度和地磁场信息；3)对装置的姿态值进行求解；4)同时利用三轴微陀螺传感器数据对装置姿态值进行预测；5)对三轴微加速度传感器和三轴磁场传感器数据进行置信判定，检测周围环境干扰，设置自适应参数；6)利用步骤5处理后的三轴微加速度传感器数据和三轴磁场传感器数据获得装置姿态误差值；7)对步骤4得到的姿态预测值以及步骤6得到的更正信息以及步骤5得到的自适应参数进行融合，获得装置姿态值；8)输出姿态信息。