[发明专利]一种利用三轴加速度计检测倾角的处理方法有效
申请号: | 201310020669.2 | 申请日: | 2013-01-21 |
公开(公告)号: | CN103105160A | 公开(公告)日: | 2013-05-15 |
发明(设计)人: | 郑淑艳;吴炆皜 | 申请(专利权)人: | 苏州明皜传感科技有限公司 |
主分类号: | G01C9/00 | 分类号: | G01C9/00 |
代理公司: | 苏州市新苏专利事务所有限公司 32221 | 代理人: | 徐鸣 |
地址: | 215123 江苏省苏州市苏州工业*** | 国省代码: | 江苏;32 |
权利要求书: | 查看更多 | 说明书: | 查看更多 |
摘要: | |||
搜索关键词: | 一种 利用 加速度计 检测 倾角 处理 方法 | ||
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轴和水平面垂直面的倾角。
该专利技术资料仅供研究查看技术是否侵权等信息,商用须获得专利权人授权。该专利全部权利属于苏州明皜传感科技有限公司,未经苏州明皜传感科技有限公司许可,擅自商用是侵权行为。如果您想购买此专利、获得商业授权和技术合作,请联系【客服】
本文链接:http://www.vipzhuanli.com/pat/books/201310020669.2/1.html,转载请声明来源钻瓜专利网。