一种单轴旋转式MEMS水平仪角度计算方法与流程
本发明涉及惯性测量,特别涉及一种单轴旋转式mems水平仪角度计算方法。
背景技术:
1、在惯性测量领域,常采用加速度计来测量不同位置的水平角度,利用加速度计的瞬时测量值或平均值,通过三角函数的方法计算出水平仪的角度。由于加速度计的零偏误差会引起测量误差,因此需要高精度的加速度计实现测量,这就导致,现在通过水平仪进行惯性测量的操作,过于依赖加速度计的精度,在加速度计精度不足的情况下,因为没有相对应的误差补偿计算措施,致使最终由水平仪测出的数值与实际的数值具有较大的误差;且通过选择高精度加速度计的测量改善方式,也不易实现。鉴于此,本方案提出一种单轴旋转式mems水平仪角度计算方法,用以解决上述问题。
技术实现思路
1、本发明的目的在于提供了一种单轴旋转式mems水平仪角度计算方法,以解决上述背景技术中提出的问题。
2、为实现上述目的,本发明提供如下技术方案:一种单轴旋转式mems水平仪角度计算方法,包括以下步骤:
3、s1,首先将水平仪放置于待测平面,控制水平仪的单轴转位结构锁止于第一静止位置,保持静止状态持续第一预设时间段,在第一预设时间段内,通过水平仪的加速度计实时测量x轴和y轴的加速度,分别记为和;
4、s2,根据所述加速度计实时测量的x轴和y轴的加速度均值,按反正弦关系解算出第一静止位置的俯仰方向角度和滚转方向角度,分别记为和;
5、s3,控制所述单轴转位结构旋转180°,到达第二静止位置后锁止,按照s1和s2的操作流程解算出第二静止位置的俯仰方向角度和滚转方向角度,分别记为和;
6、s4,预设小角度阈值,当≤时,通过差值平均算法计算得出水平仪的实际俯仰方向角度和滚转方向角度;当>时,通过迭代解算流程反复逼近所述加速度计的零偏误差,最终迭代计算出水平仪的实际俯仰方向角度和滚转方向角度。
7、优选的,所述第一静止位置的俯仰方向角度和滚转方向角度的计算分别表示为:
8、 (1);
9、 (2);
10、其中,表示所述加速度计处于第一静止位置时间段时位于x轴的坐标均值;表示所述加速度计处于第一静止位置时间段时位于y轴的坐标均值;表示当地的重力加速度。
11、优选的,所述第二静止位置的俯仰方向角度和滚转方向角度的计算分别表示为:
12、 (3);
13、 (4);
14、其中,表示所述加速度计处于第二静止位置时间段时位于x轴的坐标均值;表示所述加速度计处于第二静止位置时间段时位于y轴的坐标均值。
15、优选的,当≤时,水平仪的实际俯仰方向角度和滚转方向角度的计算分别表示为:
16、 (5);
17、 (6)。
18、优选的,当>时,此时要消除所述加速度计的零偏误差,加速度计在x轴的零偏误差和y轴的零偏误差分别表示为:
19、 (7);
20、 (8);
21、其中,表示加速度计在x轴的零偏误差;表示加速度计在y轴的零偏误差。
22、优选的,当>时,迭代的具体步骤为:
23、首先设定迭代的初始次数为0,初始零偏误差,;
24、然后以初始零偏误差开始,对测量的不同静止位置的俯仰方向角度和滚转方向角度进行解算,并在解算之后,根据俯仰方向角度和滚转方向角度的解算值,重新计算零偏误差;
25、之后将新计算出的零偏误差作为输入,继续进行俯仰方向角度和滚转方向角度解算,并同样根据解算出的俯仰方向角度和滚转方向角度计算并更新零偏误差;
26、最终根据上述迭代计算的规律进行连续迭代,且在每次迭代完成后,判断本次迭代的各参数与上一次迭代对应参数的差值,是否均小于预设的收敛阈值;若小于,则停止迭代,将收敛后的零偏误差代入角度解算公式,得到的俯仰方向角度和滚转方向角度即为水平仪的实际角度值;若不小于,则继续迭代直至小于。
27、优选的,所述收敛阈值比较的差值内容包括俯仰方向角度、滚转方向角度和零偏误差,设第n次迭代后小于收敛阈值,此时各参数值记为、、、、和,则判断本次迭代的各参数与上一次迭代对应参数的差值均小于预设的收敛阈值表示为:
28、(9)。
29、优选的,小于收敛阈值的条件满足后,输出迭代计算后的水平仪的实际俯仰方向角度和滚转方向角度,表示为:
30、 (10);
31、 (11);
32、其中,表示加速度计在迭代结束前一次y轴的零偏误差,表示加速度计在迭代结束前一次x轴的零偏误差。
33、优选的,所述零偏误差的更新是在每次迭代时,先用当前的零偏误差计算值减去原始测量值进行补偿。
34、本发明的技术效果和优点:
35、本发明通过单轴转位结构旋转180°的双位置测量方案,利用两个位置测量值的作差取平均运算,有效抵消了加速度计的固定零偏误差对角度计算结果的影响;当被测平面倾斜角度较大时,本发明针对大角度工况通过迭代计算的方式,通过对加速度计零偏误差值的反复逼近与补偿,消除了反正弦函数高阶项带来的非线性误差,使得水平仪在任意倾斜角度下均能保持高精度测量,以此在不依赖加速度计精度的方式下实现了更加精准的角度测量。
1.一种单轴旋转式mems水平仪角度计算方法,其特征在于,包括以下步骤:
2.根据权利要求1所述的一种单轴旋转式mems水平仪角度计算方法,其特征在于,所述第一静止位置的俯仰方向角度和滚转方向角度的计算分别表示为:
3.根据权利要求2所述的一种单轴旋转式mems水平仪角度计算方法,其特征在于,所述第二静止位置的俯仰方向角度和滚转方向角度的计算分别表示为:
4.根据权利要求3所述的一种单轴旋转式mems水平仪角度计算方法,其特征在于,当≤时,水平仪的实际俯仰方向角度和滚转方向角度的计算分别表示为:
5.根据权利要求4所述的一种单轴旋转式mems水平仪角度计算方法,其特征在于,当>时,此时要消除所述加速度计的零偏误差,加速度计在x轴的零偏误差和y轴的零偏误差分别表示为:
6.根据权利要求5所述的一种单轴旋转式mems水平仪角度计算方法,其特征在于,当>时,迭代的具体步骤为:
7.根据权利要求6所述的一种单轴旋转式mems水平仪角度计算方法,其特征在于,所述收敛阈值比较的差值内容包括俯仰方向角度、滚转方向角度和零偏误差,设第n次迭代后小于收敛阈值,此时各参数值记为、、、、和,则判断本次迭代的各参数与上一次迭代对应参数的差值均小于预设的收敛阈值表示为:
8.根据权利要求7所述的一种单轴旋转式mems水平仪角度计算方法,其特征在于,小于收敛阈值的条件满足后,输出迭代计算后的水平仪的实际俯仰方向角度和滚转方向角度,表示为:
9.根据权利要求6所述的一种单轴旋转式mems水平仪角度计算方法,其特征在于,所述零偏误差的更新是在每次迭代时,先用当前的零偏误差计算值减去原始测量值进行补偿。
版权声明:本站专利文献数据主要来源于国家知识产权局等公开渠道,由 技术新讯 进行整理汇编。页面设计及数据汇编的著作权归本站所有。全部内容仅供个人学习、科研评估与技术交流参考,严禁用于任何商业用途(包括但不限于直接生产制造、技术转让、倒卖数据等)。
免责条款:专利技术具有时效性,本站不对资料的绝对准确性、完整性和可实施性提供任何明示或暗示的担保。因参考本站内容造成的直接或间接损失,本站不承担相关法律责任。若您认为本站内容有侵权问题,请及时提供权属证明与我们联系,本站将在核实后依法处理。反馈意见:yyfuon@163.com