[发明专利]一种低精度MEMS陀螺组合零位偏置快速标定方法有效
| 申请号: | 201911260848.7 | 申请日: | 2019-12-10 |
| 公开(公告)号: | CN110987008B | 公开(公告)日: | 2023-08-11 |
| 发明(设计)人: | 毋蒙;许东欢;孙昭行;林益锋;赖思维 | 申请(专利权)人: | 上海航天控制技术研究所 |
| 主分类号: | G01C25/00 | 分类号: | G01C25/00 |
| 代理公司: | 上海航天局专利中心 31107 | 代理人: | 圣冬冬 |
| 地址: | 201109 *** | 国省代码: | 上海;31 |
| 权利要求书: | 查看更多 | 说明书: | 查看更多 |
| 摘要: | |||
| 搜索关键词: | 一种 精度 mems 陀螺 组合 零位 偏置 快速 标定 方法 | ||
1.一种低精度MEMS陀螺组合零位偏置快速标定方法,其特征在于,包括如下步骤:
步骤1)确定陀螺零偏标定时所需位置的最少个数,减少标定时间;
通过计算,将MEMS陀螺组合零偏标定时所需摆放位置数减少至3个,缩短标定时间;
步骤2)采用相邻位置绕轴翻转180°的方法,无需确定初始方位;
将MEMS陀螺组合安装于标定工装内,并放置于双轴转台台面,分别将转台外轴与内轴旋转180°,即可得到所需的三个位置;
步骤3)采用低通数字滤波器滤除高频噪声分量;
通过一个IIR低通滤波器对陀螺输出数据进行后处理,滤除高频噪声干扰,
所述的步骤2)中将MEMS及标定工装固定在转台台面,使得MEMS陀螺组合的第1轴与转台内轴平行,同时第2轴与转台外轴平行,记为位置1并采集采集第1轴陀螺输出数据记为R1+、第2轴陀螺输出数据记为R2+、第3轴陀螺输出数据记为R3+;绕转台外轴第2轴旋转180°,记为位置2并采集第1轴陀螺输出数据记为R1-、第3轴陀螺输出数据记为R3-;绕转台内轴第1轴旋转180°,记为位置3并采集第2轴陀螺输出数据记为R2-,
最后所述的步骤3)中利用下式计算出三个轴的陀螺零偏:
式中:
W1+、W1-、W2+、W2-、W3+、W3-分别为R1+、R1-、R2+、R2-、R3+、R3-经过滤波器后的平均值;
D1、D2、D3分别为所对应的X轴、Y轴、Z轴陀螺零偏。
2.根据权利要求1所述的一种低精度MEMS陀螺组合零位偏置快速标定方法,其特征在于:所述的步骤1)中,通过计算分析,只需将MEMS陀螺组合摆放三个位置,即可得到三轴分别处于正负指向下陀螺输出的六组数据,具备陀螺零偏标定最小条件。
3.根据权利要求1所述的一种低精度MEMS陀螺组合零位偏置快速标定方法,其特征在于:所述第1轴为X轴、Y轴、Z轴中任意一轴,所述第2轴为剩下两轴中任意一轴。
4.根据权利要求1所述的一种低精度MEMS陀螺组合零位偏置快速标定方法,其特征在于:所述的步骤3)中,采用IIR低通滤波器进行数字滤波,滤波器系统传递函数如下:
式中:
A0、A1、A2、A3、B0、B1、B2、B3为滤波器系数,选取A0=1.0、A1=-2.6862、A2=2.4197、A3=-0.7302、B0=0.0004、B1=0.0012、
B2=0.0012、B3=0.0004。
该专利技术资料仅供研究查看技术是否侵权等信息,商用须获得专利权人授权。该专利全部权利属于上海航天控制技术研究所,未经上海航天控制技术研究所许可,擅自商用是侵权行为。如果您想购买此专利、获得商业授权和技术合作,请联系【客服】
本文链接:http://www.vipzhuanli.com/pat/books/201911260848.7/1.html,转载请声明来源钻瓜专利网。
- 上一篇:优化分支血流分布的腔内修复装置
- 下一篇:一种冷却塔的循环使用方法





