主权项 |
一种数字磁罗盘的校准补偿方法,其特征在于,所述方法包括以下步骤:根据用户输入的校准指令,控制传感器采集三维姿态数据;接收并处理经过信号放大电路放大的所述三维姿态数据,利用所述三维姿态数据中的当前磁场强度信号,并结合常温校准时、X轴的最大磁场强度和最小磁场强度、Y轴的最大磁场强度和最小磁场强度,计算温度补偿系数;利用所述温度补偿系数以及所述三维姿态数据,计算得到当前的方位角;其中,所述计算温度补偿系数的步骤包括:计算所述X轴的最大磁场强度和最小磁场强度的第一差值;计算所述Y轴的最大磁场强度和最小磁场强度的第二差值;计算所述第一差值与所述第二差值的比值,得到硬磁干扰定标因子;计算所述X轴的最大磁场强度和最小磁场强度的平均值,并计算所述Y轴的最大磁场强度和最小磁场强度的平均值与所述硬磁干扰定标因子之积,得到常温校准时磁场强度曲线的圆心坐标;计算所述第一差值的1/2,得到所述常温校准时磁场强度曲线的半径;将所述X轴的当前磁场强度信号作为X轴的当前磁场强度值,将所述Y轴的当前磁场强度信号与所述硬磁干扰定标因子的乘积作为Y轴的当前磁场强度值;利用所述常温校准时的磁场强度曲线与温度变化时的磁场强度曲线之间的关系方程式,求解得到温度补偿系数。 |