一种姿态检测系统中初始姿态自动标定方法及系统

摘要

本发明公开了一种姿态检测系统中的初始姿态自动标定方法及系统，将姿态测量单元固定在被测物体表面，进行测量，连续采样姿态测量单元处于当前姿态时的测量值，计算姿态测量单元处于当前姿态时，连续采样获得的测量值的平均值；计算姿态测量单元处于当前状态时，重力场和磁力场在载体坐标系各坐标轴的标准化分量；计算姿态检测系统在姿态检测单元处于当前姿态与混合磁场下的偏移欧拉角；按照姿态检测单元初始状态下的偏移欧拉角修正姿态检测算法，根据修正后的姿态检测算法进行被测物体的姿态检测。