CN114459465B - 一种mems惯组方位的在线补偿方法 - Google Patents
一种mems惯组方位的在线补偿方法 Download PDFInfo
- Publication number
- CN114459465B CN114459465B CN202110231341.XA CN202110231341A CN114459465B CN 114459465 B CN114459465 B CN 114459465B CN 202110231341 A CN202110231341 A CN 202110231341A CN 114459465 B CN114459465 B CN 114459465B
- Authority
- CN
- China
- Prior art keywords
- scale factor
- mems inertial
- measurement unit
- reverse
- inertial measurement
- 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.)
- Active
Links
Classifications
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
- G01C21/00—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
- G01C21/10—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration
- G01C21/12—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration executed aboard the object being navigated; Dead reckoning
- G01C21/16—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration executed aboard the object being navigated; Dead reckoning by integrating acceleration or speed, i.e. inertial navigation
-
- 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惯组的反向方位误差角,代入反向标度因数误差计算公式,得出反向标度因数误差;用反向标度因数补偿MEMS惯组的标度因数,计算得出补偿后的反向标度因数;采用所述正向标度因数以及所述反向标度因数补偿标度因数非对称误差。
Description
技术领域
本发明涉及惯性检测技术领域,尤其涉及一种MEMS惯组方位的在线补偿方法。
背景技术
近年来,MEMS惯组作为惯性导航技术的重要部分,由于相比传统惯性元器件,具有尺寸小、成本低、重量轻、集成度高的优势,得到了迅猛发展,在惯性导航,工业控制,及电子消费领域得到广泛应用。但由于制造工艺、设计水平等因素,器件本身测量精度较低,往往不能满足实际使用需求,严重制约了MEMS惯组的发展和应用。无限制追求更高精度,更加稳定的惯性器件会对现有器件加工提出极高甚至不能完成的要求,一定会引起系统成本的急剧提高,所以实现在已有器件精度基础上进行在线误差补偿,进一步提高MEMS惯组使用精度是必要的。
MEMS惯组标度因数不可能标定得绝对准确,实际系统中总存在着标度因数误差。另外由于原理、工艺等原因,一般标度因数还存在不对称性,这是导致MEMS惯组正转及反转360°方位都不闭合且不闭合角度不同的主要原因。在实际的使用过程中,一般忽略这种不对称性,或者把标度因数直接取为正向标度因数和反向标度因数的平均值,这会引起一定的方位误差。并且基于国军标的陀螺标度因数非对称性器件级测试方法,需要将陀螺放置于转台进行正反向旋转测试,标度流程较为复杂,对操作设备有一定要求。
发明内容
针对目前MEMS惯组器件正转及反转方位不闭合且不闭合角度不同的问题,本发明提供MEMS惯组方位的在线补偿方法,进一步提高MEMS惯组方位的有效使用精度,并且标度流程简单,无需复杂测试台。
为达到上述目的,本发明提供了一种MEMS惯组方位的在线补偿方法,包括以下步骤:
测量MEMS惯组的正向方位误差角,由正向标度因数误差计算公式计算得出正向标度因数误差;
用正向标度因数误差补偿MEMS惯组的标度因数,计算得出补偿后正向标度因数;
测量MEMS惯组的反向方位误差角,由反向标度因数误差计算公式计算得出反向标度因数误差;
用反向标度因数误差补偿MEMS惯组的标度因数,计算得出补偿后的反向标度因数;
采用所述正向标度因数以及所述反向标度因数补偿标度因数非对称性误差。
进一步地,得到正向标度因数的误差,包括:
将MEMS惯组靠紧竖直墙面,正转360°,得到正向方位误差角Δθ1,
计算得出正向标度因数误差K1:
进一步地,计算得出补偿后正向标度因数S(+):
S(+)=S(1-K1),
其中K1为正向标度因数误差,S为MEMS惯组的标度因数。
进一步地,得到反向标度因数的误差,包括:
将MEMS惯组靠紧竖直墙面,反转360°,得到反向方位误差角Δθ2,
计算得出反向标度因数误差K2:
。
进一步地,计算得出补偿后反向标度因数S(-):
S(-)=S(1-K2),
其中K2为反向标度因数误差,S为MEMS惯组的标度因数。
进一步地,当MEMS惯组绕其输入轴正向旋转时,MEMS输入输出线性模型中使用正向标度因数作为MEMS惯组的标度因数;当MEMS惯组绕其输入轴反向旋转时,MEMS输入输出线性模型中使用反向标度因数作为MEMS惯组的标度因数。
本发明的上述技术方案具有如下有益的技术效果:
(1)本发明通过利用正向标度因数补偿公式、反向标度因数补偿公式,计算得出补偿后的正向标度因数、反向标度因数,可在线补偿标度因数非对称误差,解决MEMS方位不闭合的问题。
(2)本发明MEMS惯组方位的在线补偿方法,无须拆分器件,在不增加系统成本的条件下,进行器件级补偿,使得MEMS惯组的方位有效使用精度进一步提高。
附图说明
图1是MEMS惯组方位的在线补偿流程图;
图2是MEMS惯组靠紧竖直墙面正转360°的示意图;
图3是MEMS惯组靠紧竖直墙面反转360°的示意图。
具体实施方式
为使本发明的目的、技术方案和优点更加清楚明了,下面结合具体实施方式并参照附图,对本发明进一步详细说明。应该理解,这些描述只是示例性的,而并非要限制本发明的范围。此外,在以下说明中,省略了对公知结构和技术的描述,以避免不必要地混淆本发明的概念。
由图1可知,提供一种MEMS惯组方位的在线补偿方法,包括以下步骤:
测量MEMS惯组的正向方位误差角,代入正向标度因数误差计算公式,得出正向标度因数误差;用正向标度因数误差补偿MEMS惯组的标度因数,计算得出补偿后正向标度因数;测量MEMS惯组的反向方位误差角,代入反向标度因数误差计算公式,得出反向标度因数误差;用反向标度因数误差补偿MEMS惯组的标度因数,计算得出补偿后的反向标度因数;采用所述正向标度因数以及所述反向标度因数补偿标度因数非对称性误差。
一方面,要得到正向标度因数的误差,将MEMS惯组靠紧竖直墙面,正转360°,得到正向方位误差角Δθ1。具体如图2所示,在XYZ构成的三轴坐标系中将MEMS惯组紧贴X轴和Z轴形成的平面,正向(逆时针)转360°,得到正向方位误差角Δθ1,进一步计算得出正向标度因数误差K1:
将得出的正向标度因数误差K1补偿进MEMS惯组的标度因数S,代入如下公式,计算得出补偿后正向标度因数S(+):
S(+)=S(1-K1),
其中K1为正向标度因数误差,S为MEMS惯组的标度因数。
另一方面,要得到反向标度因数的误差,将MEMS惯组靠紧竖直墙面,反转360°,得到反向方位误差角Δθ2。具体如图3所示,在XYZ构成的三轴坐标系中将MEMS惯组紧贴X轴和Z轴形成的平面,反向(顺时针)转360°,得到反向方位误差角Δθ2,进一步计算得出反向标度因数误差K2:
将得出的反向标度因数误差K2补偿进MEMS惯组的标度因数S,代入如下公式,计算得出补偿后反向标度因数S(-):
S(-)=S(1-K2),
其中K2为反向标度因数误差,S为MEMS惯组的标度因数。
当MEMS惯组绕其输入轴正向旋转时,MEMS输入输出线性模型中使用正向标度因数S(+);当MEMS惯组绕其输入轴反向旋转时,MEMS输入输出线性模型中使用反向标度因数S(-);
采用所述方法补偿标度因数非对称性误差后,正向旋转360°,正向标度因数误差所产生的正向方位误差角被均匀的补偿进正向旋转过程中,故补偿后正向方位闭合;同理反向旋转360°,反向标度因数误差所产生的反向方位误差角被均匀的补偿进反向旋转过程中,故补偿后反向方位闭合。
综上所述,本发明提供一种加速度计测量俯仰角误差补偿方法,通过测量MEMS惯组的正向方位误差角和负向方位误差角,将正向方位误差角和负向方位误差角代入标度因数误差计算公式,得出正向标度因数误差和负向标度因数误差;用正向标度因数误差和负向标度因数误差,补偿MEMS惯组的标度因数,计算得出补偿后正向标度因数和负向标度因数;采用所述正向标度因数以及所述反向标度因数补偿标度因数非对称误差。本发明提供的一种MEMS惯组方位的在线补偿方法,在不增加系统成本的条件下,无须拆分器件,可在线补偿标度因数非对称误差,解决MEMS方位不闭合的问题,进一步提高MEMS惯组方位的有效使用精度。
应当理解的是,本发明的上述具体实施方式仅仅用于示例性说明或解释本发明的原理,而不构成对本发明的限制。因此,在不偏离本发明的精神和范围的情况下所做的任何修改、等同替换、改进等,均应包含在本发明的保护范围之内。此外,本发明所附权利要求旨在涵盖落入所附权利要求范围和边界、或者这种范围和边界的等同形式内的全部变化和修改例。
Claims (3)
1.一种MEMS惯组方位的在线补偿方法,其特征在于,包括以下步骤:
测量MEMS惯组的正向方位误差角,由正向标度因数误差计算公式计算得出正向标度因数误差;
用正向标度因数误差补偿MEMS惯组的标度因数,计算得出补偿后正向标度因数;
测量MEMS惯组的反向方位误差角,由反向标度因数误差计算公式计算得出反向标度因数误差;
用反向标度因数误差补偿MEMS惯组的标度因数,计算得出补偿后的反向标度因数;
采用所述正向标度因数以及所述反向标度因数补偿标度因数误差;
当MEMS惯组绕其输入轴正向旋转时,MEMS输入输出线性模型中使用正向标度因数作为MEMS惯组的标度因数;当MEMS惯组绕其输入轴反向旋转时,MEMS输入输出线性模型中使用反向标度因数作为MEMS惯组的标度因数;
将MEMS惯组靠紧竖直墙面,正转360°,得到正向方位误差角,
计算得出正向标度因数误差:
;
计算得出补偿后正向标度因数:
,
其中为正向标度因数误差,S为MEMS惯组的标度因数。
2.根据权利要求1所述的MEMS惯组方位的在线补偿方法,其特征在于,得到反向标度因数的误差,包括:
将MEMS惯组靠紧竖直墙面,反转360°,得到反向方位误差角,
计算得出反向标度因数误差:
。
3.根据权利要求2所述的MEMS惯组方位的在线补偿方法,其特征在于,计算得出补偿后反向标度因数:
其中为反向标度因数误差,S为MEMS惯组的标度因数。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202110231341.XA CN114459465B (zh) | 2021-03-02 | 2021-03-02 | 一种mems惯组方位的在线补偿方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202110231341.XA CN114459465B (zh) | 2021-03-02 | 2021-03-02 | 一种mems惯组方位的在线补偿方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN114459465A CN114459465A (zh) | 2022-05-10 |
CN114459465B true CN114459465B (zh) | 2023-08-22 |
Family
ID=81406509
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202110231341.XA Active CN114459465B (zh) | 2021-03-02 | 2021-03-02 | 一种mems惯组方位的在线补偿方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN114459465B (zh) |
Citations (12)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN101246023A (zh) * | 2008-03-21 | 2008-08-20 | 哈尔滨工程大学 | 微机械陀螺惯性测量组件的闭环标定方法 |
CN102680004A (zh) * | 2012-05-30 | 2012-09-19 | 北京航空航天大学 | 一种挠性陀螺位置姿态测量系统pos的标度因数误差标定与补偿方法 |
CN103245358A (zh) * | 2012-06-05 | 2013-08-14 | 北京航空航天大学 | 一种光纤陀螺标度因数非对称性误差的系统级标定方法 |
CN104596545A (zh) * | 2015-01-27 | 2015-05-06 | 北京航天时代光电科技有限公司 | 一种光纤惯性测量装置陀螺仪标度因数温度建模方法 |
CN105509768A (zh) * | 2015-11-27 | 2016-04-20 | 北京航天控制仪器研究所 | 一种单轴寻北仪的误差标定方法 |
WO2016112571A1 (zh) * | 2015-01-16 | 2016-07-21 | 北京航天时代光电科技有限公司 | 一种高精度光纤陀螺惯测装置标定方法 |
CN107063309A (zh) * | 2017-05-08 | 2017-08-18 | 中国船舶重工集团公司第七〇七研究所 | 一种旋转式捷联惯导陀螺标度误差补偿策略 |
CN107202575A (zh) * | 2017-05-16 | 2017-09-26 | 西北工业大学 | 一种带转位机构的捷联惯导系统标度因数实时补偿方法 |
CN108168575A (zh) * | 2017-11-30 | 2018-06-15 | 上海航天控制技术研究所 | 一种五轴冗余配置十表光纤惯组的标定方法和系统 |
CN109506638A (zh) * | 2018-12-24 | 2019-03-22 | 哈尔滨工程大学 | 一种补偿陀螺标度因数对旋转调制罗经方位对准影响方法 |
CN111397635A (zh) * | 2020-04-20 | 2020-07-10 | 湖南云顶智能科技有限公司 | 一种mems惯性导航系统旋转调制方法 |
CN111551164A (zh) * | 2020-05-27 | 2020-08-18 | 北京计算机技术及应用研究所 | 速率偏频激光陀螺寻北仪航向效应误差的补偿方法 |
-
2021
- 2021-03-02 CN CN202110231341.XA patent/CN114459465B/zh active Active
Patent Citations (12)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN101246023A (zh) * | 2008-03-21 | 2008-08-20 | 哈尔滨工程大学 | 微机械陀螺惯性测量组件的闭环标定方法 |
CN102680004A (zh) * | 2012-05-30 | 2012-09-19 | 北京航空航天大学 | 一种挠性陀螺位置姿态测量系统pos的标度因数误差标定与补偿方法 |
CN103245358A (zh) * | 2012-06-05 | 2013-08-14 | 北京航空航天大学 | 一种光纤陀螺标度因数非对称性误差的系统级标定方法 |
WO2016112571A1 (zh) * | 2015-01-16 | 2016-07-21 | 北京航天时代光电科技有限公司 | 一种高精度光纤陀螺惯测装置标定方法 |
CN104596545A (zh) * | 2015-01-27 | 2015-05-06 | 北京航天时代光电科技有限公司 | 一种光纤惯性测量装置陀螺仪标度因数温度建模方法 |
CN105509768A (zh) * | 2015-11-27 | 2016-04-20 | 北京航天控制仪器研究所 | 一种单轴寻北仪的误差标定方法 |
CN107063309A (zh) * | 2017-05-08 | 2017-08-18 | 中国船舶重工集团公司第七〇七研究所 | 一种旋转式捷联惯导陀螺标度误差补偿策略 |
CN107202575A (zh) * | 2017-05-16 | 2017-09-26 | 西北工业大学 | 一种带转位机构的捷联惯导系统标度因数实时补偿方法 |
CN108168575A (zh) * | 2017-11-30 | 2018-06-15 | 上海航天控制技术研究所 | 一种五轴冗余配置十表光纤惯组的标定方法和系统 |
CN109506638A (zh) * | 2018-12-24 | 2019-03-22 | 哈尔滨工程大学 | 一种补偿陀螺标度因数对旋转调制罗经方位对准影响方法 |
CN111397635A (zh) * | 2020-04-20 | 2020-07-10 | 湖南云顶智能科技有限公司 | 一种mems惯性导航系统旋转调制方法 |
CN111551164A (zh) * | 2020-05-27 | 2020-08-18 | 北京计算机技术及应用研究所 | 速率偏频激光陀螺寻北仪航向效应误差的补偿方法 |
Non-Patent Citations (1)
Title |
---|
加速度计全量程标度因数不对称性标定算法研究;王洋;于湘涛;吴楠;魏超;张吉;;导航定位与授时(第01期);52-56 * |
Also Published As
Publication number | Publication date |
---|---|
CN114459465A (zh) | 2022-05-10 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN106064379B (zh) | 一种机器人自动计算实际臂长的方法 | |
CN105352487A (zh) | 一种姿态测量系统的精度校准方法 | |
CN109459585B (zh) | 一种加速度计零位偏置修正方法 | |
CN105371868A (zh) | 一种惯性稳定平台系统加速度计组合误差标定和补偿方法 | |
WO2020164206A1 (zh) | 一种旋转加速度计重力梯度仪标定方法 | |
CN111679097B (zh) | 一种高精度的加速度计温度补偿方法 | |
CN106705821B (zh) | 一种回转轴系正交性测量方法及装置 | |
CN104597273B (zh) | 一种运动速度的测试方法和设备 | |
CN111664868A (zh) | 一种单轴陀螺安装误差标定与补偿的方法 | |
CN107063309B (zh) | 一种旋转式捷联惯导陀螺标度误差补偿方法 | |
CN114459465B (zh) | 一种mems惯组方位的在线补偿方法 | |
CN109141868B (zh) | 精密轴系误差运动的测量装置及测量方法 | |
CN110736484A (zh) | 基于陀螺仪及磁传感器融合的背景磁场标定方法 | |
CN112665477B (zh) | 用于测试端拾器平面定位精度的检具及方法 | |
CN108871322B (zh) | 基于姿态角匹配的无模型船体变形测量方法 | |
CN110940357A (zh) | 一种用于旋转惯导单轴自对准的内杆臂标定方法 | |
CN111721962B (zh) | 一种基于马格努斯效应的流速测量方法 | |
CN105865741B (zh) | 一种测量风洞试验段横向气流偏角的简易方法 | |
CN112697171B (zh) | 一种调平角测试方法及系统 | |
CN114779144A (zh) | 一种测量三轴磁强计安装矩阵的方法、芯片和装置 | |
CN110986926B (zh) | 一种基于地磁要素的飞行弹体旋转姿态测量方法 | |
KR101499509B1 (ko) | 자세방위장치의 온도보정방법 및 이를 적용한 장치 | |
CN113175941B (zh) | 基于双轴转台的激光陀螺寻北仪参数辨识方法 | |
CN113624255B (zh) | 一种环形激光测角仪敏感轴修正装置及方法 | |
CN114577218B (zh) | 基于磁力仪和深度计的水下运载体姿态测量方法及系统 |
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 |