[发明专利]一种利用三轴加速度计检测倾角的处理方法

摘要

本发明涉及一种利用三轴加速度计检测倾角的处理方法，所述方法包括：（1）分别对被测倾角的X轴/Y轴/Z轴倾角进行粗调；（2）分别对被测倾角的X轴/Y轴/Z轴倾角进行细调；（3）得到被测倾角数据。本发明提供的处理方法，是利用三轴加速度计配合粗调加细调的本发明独特的算法对相应的设备或产品进行全方位、高精度、高灵敏度及快速动态的倾角检测。本发明的突出特点在于：全方位的检测范围，整个球面的不同角度都能高分辨率的检测；高精度检测，加速度计内置的十二位高精度运动检测得出的原始采集数据；通过粗调加细调的独特算法体现高灵敏度检测；通过粗调算法体现快速动态检测。

主权项

1.一种利用三轴加速度计检测倾角的处理方法，其特征在于：所述方法包括如下步骤：（1）分别对被测倾角的X轴/Y轴/Z轴倾角进行粗调，所述的对被测倾角粗调采用算法公式：|Cd_n-Pd_n|>=Th，其中：n是对应三轴的某一轴X轴/Y轴/Z轴，Cd_n是当前三轴加速度计采集到的X轴/Y轴/Z轴的输出值，Pd_n是上一次三轴加速度计采集到的X轴/Y轴/Z轴的输出值，Th是设置的阈值；（2）分别对被测倾角的X轴/Y轴/Z轴倾角进行细调，所述的对被测倾角细调采用算法公式：Cd_n = Pd_n+( Cd_n – Pd_n)/AverTimes，其中：n是对应三轴的某一轴X轴/Y轴/Z轴，AverTimes是调整分辨率的平均次数的参数，Pd_n是上一次三轴加速度计采集到的X轴/Y轴/Z轴输出数据，Cd_n是当前三轴加速度计采集到的X轴/Y轴/Z轴输出数据；（3）采用如下的算法得到被测倾角数据：，，，其中：Ax、Ay、Az分别是三轴加速度计X轴/Y轴/Z轴输出值经过上述步骤（1）粗调和步骤（2）细调后的Pd_X、Pd_Y、Pd_Z，即上述步骤（2）细调公式中的Pd_n值，θ是X轴和水平面的夹角，Ψ是Y轴和水平面的夹角，Φ是Z轴和水平面垂直面的倾角。