CN112344927A - 一种小型化mems惯性测量系统安装误差补偿方法 - Google Patents
一种小型化mems惯性测量系统安装误差补偿方法 Download PDFInfo
- Publication number
- CN112344927A CN112344927A CN202011115798.6A CN202011115798A CN112344927A CN 112344927 A CN112344927 A CN 112344927A CN 202011115798 A CN202011115798 A CN 202011115798A CN 112344927 A CN112344927 A CN 112344927A
- Authority
- CN
- China
- Prior art keywords
- accelerometer
- axis
- orthogonal
- error compensation
- compensating
- 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
Links
Images
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
- G01C21/00—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
- G01C21/20—Instruments for performing navigational calculations
-
- 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惯性测量系统安装误差补偿方法,首先建立正交加速度计系,以加速度计X轴为加速度计系的X轴,以加速度计系X轴垂直面与加速度计X、Y构成平面的交线为加速度计系Y轴,加速度计系Z轴与X、Y轴成右手系。将陀螺、加速度计补偿至正交加速度计系,然后将正交加速度计系补偿至壳体系进行安装误差补偿。本发明方法在目前常用的安装误差补偿算法是将陀螺、加速度计补偿至正交加速度计系基础上,将正交加速度计系补偿至壳体系,提高了系统精度。
Description
技术领域
本发明涉及惯性测量系统安装误差补偿方法,具体涉及一种器件敏感轴与壳体的坐标轴相差较大时惯性测量系统安装误差补偿方法。
背景技术
小型化MEMS惯性测量系统由于体积、重量的要求,惯性敏感器件、处理器等电路需要使用胶粘的方式固连在壳体上,在胶粘过程中由于胶量大小、厚度不同,敏感器件的敏感轴与壳体坐标中并不能完全重合,偏离程度可达5°,温度变化时胶自身也会产生形变,导致全温情况下敏感器件的敏感轴也会发生变化。目前常用的补偿方法是将陀螺加速度计补偿至一个正交加速度计系(以加速度计X轴为加速度计系的X轴,以加速度计系X轴垂直面与加速度计X、Y构成平面的交线为加速度计系Y轴,加速度计系Z轴与X、Y轴成右手系),而该系与壳体系存在较大的偏差并且全温下也会发生变化,影响系统的测量
发明内容
提出一种一种小型化MEMS惯性测量系统安装误差补偿方法,解决器件坐标系与壳体坐标系不重合问题。
本发明的技术方案:
一种小型化MEMS惯性测量系统安装误差补偿方法,步骤如下:
建立正交加速度计系,所述正交加速度计系以加速度计X轴为加速度计系的X轴,以加速度计系X轴垂直面与加速度计X、Y构成平面的交线为加速度计系Y轴,加速度计系Z轴与X、Y轴成右手系;
将陀螺、加速度计补偿至正交加速度计系;
将正交加速度计系补偿至壳体系;
进行安装误差补偿。
进一步地,将正交加速度计系补偿至壳体系,所述安装误差补偿方程为:
其中:
δA为加速度计的安装误差,
δG为陀螺安装误差;
α、γ通过系统放置水平时X、Z的加速度计输出求得,假设系统放置水平时X加速度计输出为fx,Z加速度计输出为fz,则:
α=fx·g
γ=fz·g
β通过系统绕X轴转90°后的Y加速度计输出求得,假设系统绕X轴转90°,Y加速度计输出为fy,则:
β=fy·g
由正交单位阵的特性以及其物理意义可列方程:
对于胶粘的MEMS系统,正交加速度计系与壳体系(b系)存在较大偏差,本发明方法在目前常用的安装误差补偿算法是将陀螺、加速度计补偿至正交加速度计系基础上,将正交加速度计系补偿至壳体系,提高了系统精度。
附图说明
图1加速度计安装误差补偿;
图2陀螺安装误差补偿;
图3加速度计系与壳体系关系图。
具体实施方式
下面结合附图对本发明作进一步详细说明。
本发明提出一种将器件坐标系补偿至壳体系的补偿算法,解决器件坐标系与壳体坐标系不重合问题。
1、目前常用的安装误差补偿算法
小型化MEMS惯性测量系统由于体积、重量的要求,惯性敏感器件、处理器等电路不能使用螺钉固定的方式(体积、重量不允许),需要使用胶粘的方式固连在壳体上。
惯导系统的IMU由三只陀螺和三只加速度计正交连接在壳体上。在实际胶粘过程中由于胶量大小、厚度不同,无法做到陀螺组件坐标系和加速度计组件坐标系与壳体坐标系完全重合,存在安装误差,并且胶在温度变化时自身也会产生形变,导致全温情况安装误差会发生变化。
目前常用的安装误差补偿方法是将陀螺加速度计补偿至一个正交加速度计系S系(以加速度计X轴为加速度计系的X轴,以加速度计系X轴垂直面与加速度计X、Y构成平面的交线为加速度计系Y轴,加速度计系Z轴与X、Y轴成右手系),加速度计安装误差补偿如图1所示:
陀螺安装误差补偿如图2所示:
陀螺、加速度计的安装误差补偿方程如下:
其中:
δA:加速度计的安装误差;
δG:陀螺安装误差。
如图所示正交加速度计系是以加速度计X轴为基准轴建立的正交坐标系,而X加速度计与壳体系存在较大的偏差并且全温下也会发生变化,所以加速度计系与壳体系并不重合并且受温度的影响。
2、改进的安装误差补偿算法
目前常用的安装误差补偿算法是将陀螺、加速度计补偿至正交加速度计系,对于胶粘的MEMS系统,正交加速度计系与壳体系(b系)存在较大偏差,有必要将正交加速度计系补偿至壳体系,提高系统精度。加速度计系与壳体系的关系如图3所示
其中α、γ可以通过系统放置水平时X、Z的加速度计输出求得,假设系统放置水平时X加速度计输出为fx(单位:g),Z加速度计输出为fz(单位:g),则:
α=fx·g
γ=fz·g
β可以通过系统绕X轴转90°后的Y加速度计输出求得,假设系统绕X轴转90°Y加速度计输出为fy(单位:g),则:
β=fy·g
由正交单位阵的特性以及其物理意义可列方程:
上述具体实施方式仅限于解释和说明本发明的技术方案,但并不能构成对权利要求保护范围的限定。本领域技术人员应当清楚,在本发明的技术方案的基础上做任何简单的变形或替换而得到的新的技术方案,均落入本发明的保护范围内。
Claims (2)
1.一种小型化MEMS惯性测量系统安装误差补偿方法,其特征在于,步骤如下:
建立正交加速度计系,所述正交加速度计系以加速度计X轴为加速度计系的X轴,以加速度计系X轴垂直面与加速度计X、Y构成平面的交线为加速度计系Y轴,加速度计系Z轴与X、Y轴成右手系;
将陀螺、加速度计补偿至正交加速度计系;
将正交加速度计系补偿至壳体系;
进行安装误差补偿。
2.根据权利要求1所述的一种小型化MEMS惯性测量系统安装误差补偿方法,其特征在于,将正交加速度计系补偿至壳体系,所述安装误差补偿方程为:
其中:
δA为加速度计的安装误差,
δG为陀螺安装误差;
α、γ通过系统放置水平时X、Z的加速度计输出求得,假设系统放置水平时X加速度计输出为fx,Z加速度计输出为fz,则:
α=fx·g
γ=fz·g
β通过系统绕X轴转90°后的Y加速度计输出求得,假设系统绕X轴转90°,Y加速度计输出为fy,则:
β=fy·g
由正交单位阵的特性以及其物理意义可列方程:
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202011115798.6A CN112344927B (zh) | 2020-10-19 | 2020-10-19 | 一种小型化mems惯性测量系统安装误差补偿方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202011115798.6A CN112344927B (zh) | 2020-10-19 | 2020-10-19 | 一种小型化mems惯性测量系统安装误差补偿方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN112344927A true CN112344927A (zh) | 2021-02-09 |
CN112344927B CN112344927B (zh) | 2023-08-15 |
Family
ID=74362023
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202011115798.6A Active CN112344927B (zh) | 2020-10-19 | 2020-10-19 | 一种小型化mems惯性测量系统安装误差补偿方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN112344927B (zh) |
Citations (10)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2896407B1 (ja) * | 1998-03-31 | 1999-05-31 | 防衛庁技術研究本部長 | 慣性航法装置 |
CN101566483A (zh) * | 2009-05-22 | 2009-10-28 | 哈尔滨工程大学 | 光纤陀螺捷联惯性测量系统振动误差补偿方法 |
CN103940445A (zh) * | 2014-04-10 | 2014-07-23 | 哈尔滨工程大学 | 一种单轴旋转惯导系统惯性器件误差补偿方法 |
CN105371868A (zh) * | 2015-11-13 | 2016-03-02 | 北京航天控制仪器研究所 | 一种惯性稳定平台系统加速度计组合误差标定和补偿方法 |
CN105806367A (zh) * | 2016-03-25 | 2016-07-27 | 中国人民解放军国防科学技术大学 | 无陀螺惯性系统误差标定方法 |
CN108458725A (zh) * | 2017-11-17 | 2018-08-28 | 北京计算机技术及应用研究所 | 捷联惯导系统晃动基座上的系统级标定方法 |
CN109470273A (zh) * | 2018-12-14 | 2019-03-15 | 中国船舶重工集团公司第七0七研究所 | 捷联惯性导航系统惯性元件拆装免标定方法 |
CN109631941A (zh) * | 2018-12-09 | 2019-04-16 | 西安航天精密机电研究所 | 一种惯性平台系统加速度计安装误差精确标定方法 |
CN110160554A (zh) * | 2019-04-30 | 2019-08-23 | 东南大学 | 一种基于寻优法的单轴旋转捷联惯导系统标定方法 |
CN111678538A (zh) * | 2020-07-29 | 2020-09-18 | 中国电子科技集团公司第二十六研究所 | 一种基于速度匹配的动态水平仪误差补偿方法 |
-
2020
- 2020-10-19 CN CN202011115798.6A patent/CN112344927B/zh active Active
Patent Citations (10)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2896407B1 (ja) * | 1998-03-31 | 1999-05-31 | 防衛庁技術研究本部長 | 慣性航法装置 |
CN101566483A (zh) * | 2009-05-22 | 2009-10-28 | 哈尔滨工程大学 | 光纤陀螺捷联惯性测量系统振动误差补偿方法 |
CN103940445A (zh) * | 2014-04-10 | 2014-07-23 | 哈尔滨工程大学 | 一种单轴旋转惯导系统惯性器件误差补偿方法 |
CN105371868A (zh) * | 2015-11-13 | 2016-03-02 | 北京航天控制仪器研究所 | 一种惯性稳定平台系统加速度计组合误差标定和补偿方法 |
CN105806367A (zh) * | 2016-03-25 | 2016-07-27 | 中国人民解放军国防科学技术大学 | 无陀螺惯性系统误差标定方法 |
CN108458725A (zh) * | 2017-11-17 | 2018-08-28 | 北京计算机技术及应用研究所 | 捷联惯导系统晃动基座上的系统级标定方法 |
CN109631941A (zh) * | 2018-12-09 | 2019-04-16 | 西安航天精密机电研究所 | 一种惯性平台系统加速度计安装误差精确标定方法 |
CN109470273A (zh) * | 2018-12-14 | 2019-03-15 | 中国船舶重工集团公司第七0七研究所 | 捷联惯性导航系统惯性元件拆装免标定方法 |
CN110160554A (zh) * | 2019-04-30 | 2019-08-23 | 东南大学 | 一种基于寻优法的单轴旋转捷联惯导系统标定方法 |
CN111678538A (zh) * | 2020-07-29 | 2020-09-18 | 中国电子科技集团公司第二十六研究所 | 一种基于速度匹配的动态水平仪误差补偿方法 |
Non-Patent Citations (1)
Title |
---|
江奇渊;汤建勋;袁保伦;韩松来;: "激光陀螺捷联惯导尺寸效应误差分析与补偿", 红外与激光工程, no. 04, pages 1110 - 1114 * |
Also Published As
Publication number | Publication date |
---|---|
CN112344927B (zh) | 2023-08-15 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN111678538B (zh) | 一种基于速度匹配的动态水平仪误差补偿方法 | |
US11680962B2 (en) | Sensor module, measurement system, and vehicle | |
CN102879793B (zh) | 超小型gps/ins/磁强计/气压计组合导航系统 | |
CN106767917B (zh) | 一种斜置冗余惯导系统标定误差模型建模方法 | |
CN202974288U (zh) | 一种微型捷联航姿系统 | |
CN106444809B (zh) | 一种无人机飞行控制器 | |
CN108710001B (zh) | 一种两轴一体陀螺加速度计及伺服控制方法 | |
CN103743378A (zh) | 一种管道检测器姿态检测系统 | |
CN108534799B (zh) | 一种利用mems修正三轴光纤陀螺跨条纹输出的方法及装置 | |
CN109631952B (zh) | 航天器用光学陀螺组件姿态基准镜安装误差标定方法 | |
CN116448145A (zh) | 一种基于偏振矢量空间差分的航姿确定方法 | |
Pazychev et al. | Low-Cost Navigation System for UAV | |
CN112697143B (zh) | 高精度载体动态姿态测量方法及系统 | |
CN104897153A (zh) | 一种基于mems和mr传感器的载体姿态测量系统 | |
CN112665570B (zh) | 一种基于星敏感器的mems陀螺零偏在轨简化工程计算方法 | |
CN105091883A (zh) | Mems一体化imu温度补偿改进方法 | |
CN112344927A (zh) | 一种小型化mems惯性测量系统安装误差补偿方法 | |
CN108593966A (zh) | 一种两轴框架摆式加速度计自标定方法和系统 | |
CN214951273U (zh) | 方位指示系统 | |
CN111780787B (zh) | 一种基于光纤惯性辅助的mems惯组标定方法 | |
CN113701752A (zh) | 一种旋转弹用全捷联姿态测量装置及方法 | |
CN112729280A (zh) | 一种基于多面体式阵列结构的微惯性姿态测量装置及方法 | |
CN216483089U (zh) | 一种光纤陀螺寻北仪 | |
CN113639766B (zh) | 双轴旋转惯性导航系统中包含非正交角的系统级标定方法 | |
Miyazaki et al. | Initial Investigation of Physically Tightly-Coupled Single-Chip MEMS IMU for Mutual Compensation of Two Differential Resonant Accelerometers and a Mode-Matched Donut-Mass Gyroscope |
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 |