CN110987008A - 一种低精度mems陀螺组合零位偏置快速标定方法 - Google Patents

一种低精度mems陀螺组合零位偏置快速标定方法 Download PDF

Info

Publication number
CN110987008A
CN110987008A CN201911260848.7A CN201911260848A CN110987008A CN 110987008 A CN110987008 A CN 110987008A CN 201911260848 A CN201911260848 A CN 201911260848A CN 110987008 A CN110987008 A CN 110987008A
Authority
CN
China
Prior art keywords
axis
zero offset
low
mems gyroscope
calibration
Prior art date
Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
Granted
Application number
CN201911260848.7A
Other languages
English (en)
Other versions
CN110987008B (zh
Inventor
毋蒙
许东欢
孙昭行
林益锋
赖思维
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Shanghai Aerospace Control Technology Institute
Original Assignee
Shanghai Aerospace Control Technology Institute
Priority date (The priority date is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the date listed.)
Filing date
Publication date
Application filed by Shanghai Aerospace Control Technology Institute filed Critical Shanghai Aerospace Control Technology Institute
Priority to CN201911260848.7A priority Critical patent/CN110987008B/zh
Publication of CN110987008A publication Critical patent/CN110987008A/zh
Application granted granted Critical
Publication of CN110987008B publication Critical patent/CN110987008B/zh
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Classifications

    • G—PHYSICS
    • G01—MEASURING; TESTING
    • G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
    • G01C25/00—Manufacturing, calibrating, cleaning, or repairing instruments or devices referred to in the other groups of this subclass
    • G01C25/005—Manufacturing, calibrating, cleaning, or repairing instruments or devices referred to in the other groups of this subclass initial alignment, calibration or starting-up of inertial devices
    • Y—GENERAL TAGGING OF NEW TECHNOLOGICAL DEVELOPMENTS; GENERAL TAGGING OF CROSS-SECTIONAL TECHNOLOGIES SPANNING OVER SEVERAL SECTIONS OF THE IPC; TECHNICAL SUBJECTS COVERED BY FORMER USPC CROSS-REFERENCE ART COLLECTIONS [XRACs] AND DIGESTS
    • Y02—TECHNOLOGIES OR APPLICATIONS FOR MITIGATION OR ADAPTATION AGAINST CLIMATE CHANGE
    • Y02T—CLIMATE CHANGE MITIGATION TECHNOLOGIES RELATED TO TRANSPORTATION
    • Y02T90/00—Enabling technologies or technologies with a potential or indirect contribution to GHG emissions mitigation

Abstract

本发明涉及MEMS陀螺零偏标定技术，为解决低精度MEMS陀螺零偏普遍存在零偏随时间漂移，需要定期对零偏进行标定并加以补偿；采用传统的“六位置法”、“十二位置法”或“二十四位置法”标定时工序复杂，耗费时间较长；MEMS陀螺易受外界及器件内部高频噪声的影响，造成标定误差过大的技术问题，本发明公开了一种针对精度MEMS陀螺组合零位偏置快速标定方法，其步骤是：通过计算，确定陀螺组合零偏标定所需位置数仅为3个；采用相邻位置绕轴翻转180°的方法，采集MEMS陀螺三位置下的输出数据；采用低通数字滤波器滤除高频噪声干扰后求得陀螺零偏。本发明利用低通数字滤波器滤除高频噪声，滤波参数调整灵活，可根据不同工况进行设计。

Description

一种低精度MEMS陀螺组合零位偏置快速标定方法
技术领域
本发明涉及低精度MEMS陀螺组合零位偏置的快速标定方法，属于控制技术领域。
背景技术
MEMS陀螺组合是各类低成本飞行器的常用惯性测量元件，其主要功能是实时测量沿敏感轴输入的角速度分量，并定时向外发送数据，一般由三个正交的角速度传感器、误差补偿计算机、电源电路、接口电路、本体组件等几部分组成。目前低精度MEMS陀螺普遍存在零偏随时间漂移的现象，尤其是经过长期贮存后，陀螺零偏可能会超出指标要求，影响系统使用，因此需要定期对产品零偏进行标定并加以补偿。
常规的标定方法多采用“六位置法”、“十二位置法”或“二十四位置法”，标定时工序复杂，耗费时间较长。同时，在对陀螺数据进行处理时多采用简单计算输出均值的计算方法，其计算结果易受到外界及器件内部的高频噪声的影响，造成标定误差过大。
随着飞行器航程、飞行速度、机动性能的不断提高，对MEMS陀螺的性能提出了越来越高的要求，为满足系统使用需要定期对MEMS陀螺组合的零偏进行标定维护，本发明提出了一种快速标定方法，并且通过设计专用滤波器消除高频噪声的干扰，提高标定的精度。
发明内容
针对现有技术存在的缺陷，本发明要解决的是低精度MEMS陀螺组合快速标定及标定结果易受高频噪声干扰的技术问题。
为解决上述技术问题，本发明是通过以下技术方案实现的，一种低精度MEMS陀螺组合零位偏置快速标定方法，适合于采用MEMS陀螺组合且需要对陀螺零偏进行快速修正的各类应用，特别是批量研制生产的低成本小型化战术导弹上应用的惯性测量组合，包括如下步骤：
1、确定陀螺零偏标定时所需位置的最少个数，减少标定时间
通过计算，将MEMS陀螺组合零偏标定时所需摆放位置数减至最少的3个，缩短标定时间。
2、采用相邻位置绕轴翻转180°的方法，无需确定初始方位
将MEMS陀螺组合安装于标定工装内，并放置于双轴转台台面，分别将转台外轴与内轴旋转180°，即可得到所需的三个位置。
3、采用低通数字滤波器滤除高频噪声分量
通过一个IIR低通滤波器对陀螺输出数据进行后处理，滤除高频噪声干扰。
进一步，所述的步骤1)中，通过计算分析，只需将MEMS陀螺组合摆放三个位置，即可得到三轴分别处于正负指向下陀螺输出的六组数据，具备陀螺零偏标定最小条件。
本发明方法与现有技术相比，其优点和有益效果是：
采用“三位置法”进行陀螺零偏标定，相比传统的“六位置法”、“十二位置法”，或“二十四位置法”，过程简洁，耗时少，；利用低通数字滤波器消除高频噪声，并且滤波器的参数调整灵活，可根据不同工况进行专门设计。
附图说明
以下将结合附图和实施实例对本发明作进一步的说明。
图1是本发明实施例的三位置法示意图；
图2是本发明实施例的所设计的滤波器频率特性图；
图3是采用本发明实施例的滤波器前、后对比图。
具体实施方式
一种低精度MEMS陀螺组合零位偏置快速标定方法，其步骤是：
1、通过计算确定陀螺零偏标定时所需最少位置数
对于低精度MEMS陀螺，其零偏为主要误差项，忽略其他误差因素，当某个轴与地球自转轴夹角为α时，此轴的陀螺输出如下：
Rα＝we cosα+D (1)
式中：
we为地球自转速率；
D为陀螺零偏。
当此轴被翻转180°后，陀螺输出如下：
Rα+180＝we cos(α+180°)+D＝-we cosα+D (2)
则该轴对应陀螺的零偏如下：
Figure BDA0002311547820000031
由于MEMS陀螺组合的三个轴呈正交关系，其中两个轴翻转时第三个轴的指向不变，因此还需要第三个位置将第三个轴进行翻转，此时已达到将三个轴向陀螺零偏全部求出的最少条件。
2、采用相邻位置绕轴翻转180°的方法实现三位置
整个翻转过程如图1所示，首先将MEMS陀螺组合及标定工装固定在双轴转台台面上，使得第1轴(为X轴、Y轴、Z轴中任意一轴)与转台内轴平行，且第2轴(为X轴、Y轴、Z轴中除第1轴剩下两轴中任意一轴)与转台外轴平行，此时即为位置1并采集第1轴陀螺输出数据记为R1+、第2轴陀螺输出数据记为R2+、第3轴陀螺输出数据记为R3+；绕转台外轴(第2轴)旋转180°，此时为位置2并采集第1轴陀螺输出数据记为R1-、第3轴陀螺输出数据记为R3-；绕转台内轴(第1轴)旋转180°，此时为位置3并采集第3轴陀螺输出数据记为R2-。
3、采用低通数字滤波器滤除高频噪声分量
采用如下的三阶IIR低通滤波器对三位置下所采集数据进行数字滤波，滤波器传递函数如下：
Figure BDA0002311547820000041
式中：
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；
采样频率即MEMS陀螺输出频率选择为400Hz；
通带边界频率选择为10Hz。
本发明采用的滤波器幅频特性如图2所示，针对所采集的陀螺输出数据进行滤波前、后的对比如图3所示。
最后利用下式则可计算出三个轴的陀螺零偏：
Figure BDA0002311547820000051
式中：
W1+、W1-、W2+、W2-、W3+、W3-分别为R1+、R1-、R2+、R2-、R3+、R3-经过滤波器后的平均值；
D1、D2、D3分别为所对应的X轴、Y轴、Z轴陀螺零偏。

Claims (5)

1.一种低精度MEMS陀螺组合零位偏置快速标定方法，其特征在于，包括如下步骤：
步骤1)确定陀螺零偏标定时所需位置的最少个数，减少标定时间；
通过计算，将MEMS陀螺组合零偏标定时所需摆放位置数减少至3个，缩短标定时间；
步骤2)采用相邻位置绕轴翻转180°的方法，无需确定初始方位；
将MEMS陀螺组合安装于标定工装内，并放置于双轴转台台面，分别将转台外轴与内轴旋转180°，即可得到所需的三个位置；
步骤3)采用低通数字滤波器滤除高频噪声分量；
通过一个IIR低通滤波器对陀螺输出数据进行后处理，滤除高频噪声干扰。
2.根据权利要求1所述的一种低精度MEMS陀螺组合零位偏置快速标定方法，其特征在于：所述的步骤1)中，通过计算分析，只需将MEMS陀螺组合摆放三个位置，即可得到三轴分别处于正负指向下陀螺输出的六组数据，具备陀螺零偏标定最小条件。
3.根据权利要求1所述的一种低精度MEMS陀螺组合零位偏置快速标定方法，其特征在于：所述的步骤2)中将MEMS及标定工装固定在转台台面，使得MEMS陀螺组合的第1轴与转台内轴平行，同时第2轴与转台外轴平行，记为位置1并采集第1、第2、第3轴陀螺输出数据；绕转台外轴第2轴旋转180°，记为位置2并采集第1、第3轴陀螺输出数据；绕转台内轴第1轴旋转180°，记为位置3并采集第2轴陀螺输出数据。
4.根据权利要求3所述的一种低精度MEMS陀螺组合零位偏置快速标定方法，其特征在于：所述第1轴为X轴、Y轴、Z轴中任意一轴，所述第2轴为剩下两轴中任意一轴.
5.根据权利要求1所述的一种低精度MEMS陀螺组合零位偏置快速标定方法，其特征在于：所述的步骤3)中，采用IIR低通滤波器进行数字滤波，滤波器系统传递函数如下：
Figure FDA0002311547810000021
式中：
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。
CN201911260848.7A 2019-12-10 2019-12-10 一种低精度mems陀螺组合零位偏置快速标定方法 Active CN110987008B (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN201911260848.7A CN110987008B (zh) 2019-12-10 2019-12-10 一种低精度mems陀螺组合零位偏置快速标定方法

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN201911260848.7A CN110987008B (zh) 2019-12-10 2019-12-10 一种低精度mems陀螺组合零位偏置快速标定方法

Publications (2)

Publication Number Publication Date
CN110987008A true CN110987008A (zh) 2020-04-10
CN110987008B CN110987008B (zh) 2023-08-11

Family

ID=70092111

Family Applications (1)

Application Number Title Priority Date Filing Date
CN201911260848.7A Active CN110987008B (zh) 2019-12-10 2019-12-10 一种低精度mems陀螺组合零位偏置快速标定方法

Country Status (1)

Country Link
CN (1) CN110987008B (zh)

Citations (11)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
WO2007015149A2 (en) * 2005-08-01 2007-02-08 Toyota Jidosha Kabushiki Kaisha Robot equipped with a gyro and gyro calibration apparatus, program, and method
CN101029833A (zh) * 2007-03-12 2007-09-05 北京航空航天大学 一种捷联mems陀螺动态误差标定方法
CN102183264A (zh) * 2011-01-14 2011-09-14 北京理工大学 一种高效集成光纤陀螺的测试系统及测试方法
CN102853850A (zh) * 2012-09-11 2013-01-02 中国兵器工业集团第二一四研究所苏州研发中心 基于单轴转台的三轴mems陀螺旋转积分标定方法
CN105277210A (zh) * 2014-07-09 2016-01-27 北京自动化控制设备研究所 一种任意安装多轴陀螺组合标定方法
CN105371868A (zh) * 2015-11-13 2016-03-02 北京航天控制仪器研究所 一种惯性稳定平台系统加速度计组合误差标定和补偿方法
WO2016112571A1 (zh) * 2015-01-16 2016-07-21 北京航天时代光电科技有限公司 一种高精度光纤陀螺惯测装置标定方法
CN106017507A (zh) * 2016-05-13 2016-10-12 北京航空航天大学 一种用于中低精度的光纤惯组快速标定方法
CN106767925A (zh) * 2016-12-29 2017-05-31 西安航天精密机电研究所 带双轴转位机构的惯导系统三位置参数辨识对准方法
US20170241799A1 (en) * 2016-02-22 2017-08-24 Invensense, Inc. Systems and methods to compensate for gyroscope offset
CN108592952A (zh) * 2018-06-01 2018-09-28 北京航空航天大学 基于杆臂补偿与正反倍速率同时标定多mimu误差的方法

Patent Citations (11)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
WO2007015149A2 (en) * 2005-08-01 2007-02-08 Toyota Jidosha Kabushiki Kaisha Robot equipped with a gyro and gyro calibration apparatus, program, and method
CN101029833A (zh) * 2007-03-12 2007-09-05 北京航空航天大学 一种捷联mems陀螺动态误差标定方法
CN102183264A (zh) * 2011-01-14 2011-09-14 北京理工大学 一种高效集成光纤陀螺的测试系统及测试方法
CN102853850A (zh) * 2012-09-11 2013-01-02 中国兵器工业集团第二一四研究所苏州研发中心 基于单轴转台的三轴mems陀螺旋转积分标定方法
CN105277210A (zh) * 2014-07-09 2016-01-27 北京自动化控制设备研究所 一种任意安装多轴陀螺组合标定方法
WO2016112571A1 (zh) * 2015-01-16 2016-07-21 北京航天时代光电科技有限公司 一种高精度光纤陀螺惯测装置标定方法
CN105371868A (zh) * 2015-11-13 2016-03-02 北京航天控制仪器研究所 一种惯性稳定平台系统加速度计组合误差标定和补偿方法
US20170241799A1 (en) * 2016-02-22 2017-08-24 Invensense, Inc. Systems and methods to compensate for gyroscope offset
CN106017507A (zh) * 2016-05-13 2016-10-12 北京航空航天大学 一种用于中低精度的光纤惯组快速标定方法
CN106767925A (zh) * 2016-12-29 2017-05-31 西安航天精密机电研究所 带双轴转位机构的惯导系统三位置参数辨识对准方法
CN108592952A (zh) * 2018-06-01 2018-09-28 北京航空航天大学 基于杆臂补偿与正反倍速率同时标定多mimu误差的方法

Non-Patent Citations (4)

* Cited by examiner, † Cited by third party
Title
JAN K. BEKKENG: "Calibration of a Novel MEMS Inertial Reference Unit", 《IEEE TRANSACTIONS ON INSTRUMENTATION AND MEASUREMENT 》, pages 1967 *
张丽杰; 常佶: "一种免装配微惯性测量单元的研制与开发", 《中国惯性技术学报》, pages 664 - 669 *
李政; 张志利: "一种基于双轴位置转台的现场标定方法", 《压电与声光 》, pages 308 - 311 *
董亮; 臧中原; 许东欢: "一种惯性/卫星容错组合导航系统设计", 《电光与控制》, pages 104 - 108 *

Also Published As

Publication number Publication date
CN110987008B (zh) 2023-08-11

Similar Documents

Publication Publication Date Title
CN106679649B (zh) 一种手部运动追踪系统及追踪方法
US8239162B2 (en) Miniaturized inertial measurement unit and associated methods
US8762091B1 (en) Inertial measurement system
CN109373998B (zh) 基于多传感器数据的旋转体姿态测量方法
US20160047675A1 (en) Inertial Measurement and Navigation System And Method Having Low Drift MEMS Gyroscopes And Accelerometers Operable In GPS Denied Environments
CN208505331U (zh) 一种共抖陀螺惯性测量单元imu
CA2605177A1 (en) Miniaturized inertial measurement unit and associated methods
CN103712598B (zh) 一种小型无人机姿态确定方法
CN112964240B (zh) 一种连续寻北装置、方法、电子设备及存储介质
CN108170154A (zh) 一种无人机多传感器正向摄影倾斜飞控调试方法
AU2020332884B2 (en) Systems and methods for measuring the rate of angular displacement using magnetic field sensing
CN104697521A (zh) 一种采用陀螺冗余斜交配置方式测量高速旋转体姿态和角速度的方法
CN105737793A (zh) 滚转角测量单元及测量方法
CN106595669B (zh) 一种旋转体姿态解算方法
CN110987008A (zh) 一种低精度mems陀螺组合零位偏置快速标定方法
CN110411481B (zh) 陀螺仪不正交误差的校准方法及校准系统
CN110058324B (zh) 利用重力场模型的捷联式重力仪水平分量误差修正方法
CN109443352B (zh) 一种四轴惯性稳定平台系统的伺服回路解耦方法
Huang et al. Development of attitude and heading reference systems
CN113776560B (zh) 一种基于高精度三轴转台的陀螺标度因数测试方法
CN110954081A (zh) 一种磁罗盘快速校准装置及方法
CN109470277B (zh) 非正交角度测量装置标定系数的测定方法及系统
CN112304339B (zh) 一种卫星移动通信天线的惯导校准方法
CN114707317A (zh) 基于弹道先验知识的旋转弹飞行参数测量方法和系统
Shen et al. Design and realization of low-cost, fast and high-precision fog north finder

Legal Events

Date Code Title Description
PB01 Publication
PB01 Publication
SE01 Entry into force of request for substantive examination
SE01 Entry into force of request for substantive examination
GR01 Patent grant
GR01 Patent grant