CN113865621B - 任意六位置MEMS陀螺仪及其g值敏感系数标定方法 - Google Patents
任意六位置MEMS陀螺仪及其g值敏感系数标定方法 Download PDFInfo
- Publication number
- CN113865621B CN113865621B CN202111264808.7A CN202111264808A CN113865621B CN 113865621 B CN113865621 B CN 113865621B CN 202111264808 A CN202111264808 A CN 202111264808A CN 113865621 B CN113865621 B CN 113865621B
- Authority
- CN
- China
- Prior art keywords
- mems gyroscope
- accelerometer
- sensitivity coefficient
- value sensitivity
- value
- 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
- 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
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
- G01C19/00—Gyroscopes; Turn-sensitive devices using vibrating masses; Turn-sensitive devices without moving masses; Measuring angular rate using gyroscopic effects
- G01C19/56—Turn-sensitive devices using vibrating masses, e.g. vibratory angular rate sensors based on Coriolis forces
-
- 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
Landscapes
- Engineering & Computer Science (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Manufacturing & Machinery (AREA)
- Gyroscopes (AREA)
Abstract
本发明涉及一种任意六位置MEMS陀螺仪及其g值敏感系数标定方法,将MEMS陀螺仪及加速度计置于至少六个不同位置,记录每个位置MEMS陀螺仪及加速度计输出的一组数据;对每个位置MEMS陀螺仪及加速度计输出的数据进行平滑滤波;基于MEMS陀螺仪及加速度计输出关系建立g值敏感系数模型;采用平滑滤波后的MEMS陀螺仪及加速度计输出的数据求解所述g值敏感系数模型,获得g值敏感系数。本发明提供的标定方法可以解决传统MEMS陀螺仪g值敏感系数标定流程复杂,时间长的问题,仅用六个位置求解出g值敏感系数,缩短标定时间,提高MEMS陀螺的精度。
Description
技术领域
本发明涉及陀螺仪技术领域,尤其涉及一种任意六位置MEMS陀螺仪及其g值敏感系数标定方法。
背景技术
因为尺寸小、成本低、精度高、易于集成和可大规模生产等优点,微机电(MEMS)惯性传感器受到越来越多人们的欢迎,广泛应用于民用和军用领域。MEMS陀螺仪由于特殊的加工工艺和设计原理,其角速率输出精度的影响因素区别于传统的激光和光纤陀螺仪,存在由加速度所引入的测量误差,称之为g值敏感误差。
在消费级和商业应用中,所选用的MEMS陀螺仪的零偏稳定性较差,高达几百度每小时,且应用过程中绝大多数工作在低动态环境下,加速度相对较小,因此由g值敏感系数所引起的陀螺仪输出误差相对陀螺仪其他误差如零偏不稳定性误差幅值较小,在导航系统中的影响经常被忽略。因而,很少有参考文献关注研究g值敏感系数的标定和补偿。
在一些高性能的MEMS陀螺仪中,由g值敏感系数所引起的陀螺仪角速率输出误差不能被轻易忽略,需要进行标定和补偿,从而提高高性能MEMS陀螺仪在动态情况下的测量精度和性能。
通过将陀螺仪固定在转台上旋转多个位置进行数据采集,并对采集的数据进行误差建模,使用线性最小二乘法求取值敏感系数。该方法计算较为复杂,标定时间长。
发明内容
针对现有技术存在的问题,本发明提供任意六位置MEMS陀螺仪及其g值敏感系数标定方法,可以解决传统MEMS陀螺仪g值敏感系数标定流程复杂,时间长的问题,仅用任意六个位置求解出g值敏感系数,缩短标定时间,提高MEMS陀螺的精度。
为达到上述目的,本发明提供了一种任意六位置MEMS陀螺仪g值敏感系数标定方法,包括:
将MEMS陀螺仪及加速度计置于至少六个不同位置,记录每个位置MEMS陀螺仪及加速度计输出的一组数据;
对每个位置MEMS陀螺仪及加速度计输出的数据进行平滑滤波;
基于MEMS陀螺仪及加速度计输出关系建立g值敏感系数模型;
采用平滑滤波后的MEMS陀螺仪及加速度计输出的数据求解所述g值敏感系数模型,获得g值敏感系数。
进一步地,将MEMS陀螺仪及加速度计置于至少六个不同位置,静止采集数分钟后同步采集MEMS陀螺仪和加速度计的输出数据。
所述加速度计的精度高于所述MEMS陀螺仪。
进一步地,对每个位置MEMS陀螺仪输出的数据进行平滑滤波包括:
其中为平滑后的MEMS陀螺仪输出,/>为MEMS陀螺仪输出的原始采集数据,N为此位置MEMS陀螺仪输出的原始采集数据总个数。
进一步地,对每个位置加速度计输出的数据进行平滑滤波包括:
其中为平滑后的加速度计输出,/>为加速度计输出的原始采集数据,N为此位置加速度计输出的原始采集数据总个数。
进一步地,所述g值敏感系数模型为:
其中Gx,Gy,Gz,是待标定参数,/>分为每个位置处地球自转角速率在陀螺仪坐标系b系下x,y,z轴的投影,/>分别为g值敏感系数x、y、z方向的分量。
进一步地,求解所述g值敏感系数模型,包括使函数值全局最小:
进一步地,采用牛顿迭代算法和PSO算法使方程最小,从而解出Gx,Gy,Gz,/>
进一步地,基于MEMS陀螺仪及加速度计输出关系建立g值敏感系数模型时,忽略交叉项的敏感系数。
另一方面提供一种MEMS陀螺仪,g值敏感系数采用所述的任意六位置MEMS陀螺仪g值敏感系数标定方法标定。
本发明的上述技术方案具有如下有益的技术效果:
本发明提供的标定方法可以解决传统MEMS陀螺仪g值敏感系数标定流程复杂,时间长的问题,仅用六个位置求解出g值敏感系数,缩短标定时间,提高MEMS陀螺的精度。无需使用转台及温箱,标定过程简单。适用于高性能、高动态条件下的MEMS陀螺仪的快速标定。
附图说明
图1是任意六位置MEMS陀螺仪g值敏感系数标定方法流程图;
图2为非线性函数优化求解流程示意图。
具体实施方式
为使本发明的目的、技术方案和优点更加清楚明了,下面结合具体实施方式并参照附图,对本发明进一步详细说明。应该理解,这些描述只是示例性的,而并非要限制本发明的范围。此外,在以下说明中,省略了对公知结构和技术的描述,以避免不必要地混淆本发明的概念。
本发明使用任意六位置陀螺仪和加速度计的输出,基于模值法,同时求解零偏与g值敏感系数,完成MEMS陀螺仪g值敏感系数标定。结合图1,具体包括如下步骤:
步骤一:将MEMS陀螺仪及加速度计置于至少六个不同位置,记录每个位置MEMS陀螺仪及加速度计输出的一组数据。
在每一位置处,采集短时间内MEMS陀螺仪和加速度计的输出数据(短时间内可以视为运动状态不变),并保存所采集的数据。
所述加速度计的精度高于所述MEMS陀螺仪。g值敏感误差是MEMS陀螺仪由加速度所引入的测量误差,和载体加速度大小有关,加速度计用于测量载体加速度,精度要求高于陀螺仪。
步骤二:对每个位置MEMS陀螺仪及加速度计输出的数据进行平滑滤波。
通过对每个位置采集的数据进行均值化平滑处理,降低噪声的影响,公式如下:
其中为平滑后的陀螺仪输出,/>为原始采集数据,N为此位置数据总个数。
平滑后的加速度计的输出以相同的方法得到:
因此陀螺仪和加速度的数据可分别记为和/>
步骤三:基于MEMS陀螺仪及加速度计输出关系建立g值敏感系数模型。
交叉项的敏感系数远小于主轴系数,将其忽略。敏感系数模型如下所示:
其中Gx,Gy,Gz,是待标定参数,/>分为每个位置处地球自转角速率在陀螺仪坐标系b系下x,y,z轴的投影,总共六个观测位置数。对于每个位置有:
其中为地球自转角速率在陀螺仪坐标系b系下的值,wie为地球自转角速率的模值。这就建立了包含陀螺仪g值敏感系数以及陀螺仪零偏的非线性方程,由于该非线性方程有多个待求解参数,因此需要建立非线性方程组才可能求解出所有未知参数。通过测量六个位置静止条件下的陀螺仪及加速度计的输出,就可以建立多个非线性方程构成非线性方程组。对上式进行移项整理,可以将非线性方程组的求解问题转化为非线性函数优化问题,整理后如下:
是由Gx,Gy,Gz,/>组成的一个函数,Gx,Gy,Gz,/>是函数的变量。
使得上式取得最小值的参数即是MEMS陀螺仪待标定参数,采用牛顿迭代算法和PSO算法解决参数求解问题。
结合图2,求解的过程包括:
(1)初始化参数,包括粒子个数,学习因子等。
(2)初始化粒子,包括粒子的初始位置及速度,此处为的初始值和算法的迭代速度。
(3)计算适应度。适应度为用于评价粒子优劣的值。一般设置为目标函数,本发明采用的函数为采用/>的值作为适应度。
(4)更新粒子状态,按照以下式子进行更新;
vi(t+1)=w·vi(t)+c1·r1(pi(t)-xi(t))+c2·r2(gi(t)-xi(t))
xi(t+1)=xi(t)+vi(t+1)
其中,w为惯性权值,c1和c2为学习因子,也称为加速度常数,r1和r2是均匀分布于[0,1]上的随机数,vi(t)代表更新前第i个粒子的速度,xi(t)代表更新前第i个粒子的位置,pi(t)代表更新前位置的局部最优位置(即更新前第i个粒子使取得最小值的/>),gi(t)代表更新前位置的全局最优位置,即更新前所有粒子使/>取得最小值的/>vi(t+1)代表更新后第i个粒子的速度,xi(t+1)代表更新后第i个粒子的位置。
(5)更新适应度;
(6)寻找全局最优粒子。达到迭代次数的全局最优粒子即为参数的最优解。
(7)判断是否达到迭代次数,如果达到,则结束迭代,输出最优解;否则返回步骤(4)。
另一方面提供一种MEMS陀螺仪,g值敏感系数采用所述的任意六位置MEMS陀螺仪g值敏感系数标定方法标定。
综上所述,本发明涉及一种任意六位置MEMS陀螺仪及其g值敏感系数标定方法,将MEMS陀螺仪及加速度计置于至少六个不同位置,记录每个位置MEMS陀螺仪及加速度计输出的一组数据;对每个位置MEMS陀螺仪及加速度计输出的数据进行平滑滤波;基于MEMS陀螺仪及加速度计输出关系建立g值敏感系数模型;采用平滑滤波后的MEMS陀螺仪及加速度计输出的数据求解所述g值敏感系数模型,获得g值敏感系数。本发明提供的标定方法可以解决传统MEMS陀螺仪g值敏感系数标定流程复杂,时间长的问题,仅用六个位置求解出g值敏感系数,缩短标定时间,提高MEMS陀螺的精度。
应当理解的是,本发明的上述具体实施方式仅仅用于示例性说明或解释本发明的原理,而不构成对本发明的限制。因此,在不偏离本发明的精神和范围的情况下所做的任何修改、等同替换、改进等,均应包含在本发明的保护范围之内。此外,本发明所附权利要求旨在涵盖落入所附权利要求范围和边界、或者这种范围和边界的等同形式内的全部变化和修改例。
Claims (7)
1.一种任意六位置MEMS陀螺仪g值敏感系数标定方法,其特征在于,包括:
将MEMS陀螺仪及加速度计置于至少六个不同位置,记录每个位置MEMS陀螺仪及加速度计输出的一组数据;
对每个位置MEMS陀螺仪及加速度计输出的数据进行平滑滤波;
基于MEMS陀螺仪及加速度计输出关系建立g值敏感系数模型;
采用平滑滤波后的MEMS陀螺仪及加速度计输出的数据求解所述g值敏感系数模型,获得g值敏感系数;
所述g值敏感系数模型为:
其中Gx,Gy,Gz,是待标定参数,/>分为每个位置处地球自转角速率在陀螺仪坐标系b系下x,y,z轴的投影,/>分别为g值敏感系数x、y、z方向的分量;
求解所述g值敏感系数模型,包括使函数值全局最小:
采用牛顿迭代算法和PSO算法使方程最小,从而解出Gx,Gy,Gz,
2.根据权利要求1所述的任意六位置MEMS陀螺仪g值敏感系数标定方法,其特征在于,将MEMS陀螺仪及加速度计置于至少六个不同位置,静止采集数分钟后同步采集MEMS陀螺仪和加速度计的输出数据;所述加速度计的精度高于所述MEMS陀螺仪。
3.根据权利要求1所述的任意六位置MEMS陀螺仪g值敏感系数标定方法,其特征在于,对每个位置MEMS陀螺仪输出的数据进行平滑滤波包括:
其中为平滑后的MEMS陀螺仪输出,/>为MEMS陀螺仪输出的原始采集数据,N为此位置MEMS陀螺仪输出的原始采集数据总个数。
4.根据权利要求3所述的任意六位置MEMS陀螺仪g值敏感系数标定方法,其特征在于,对每个位置加速度计输出的数据进行平滑滤波包括:
其中为平滑后的加速度计输出,/>为加速度计输出的原始采集数据,N为此位置加速度计输出的原始采集数据总个数。
5.根据权利要求4所述的任意六位置MEMS陀螺仪g值敏感系数标定方法,其特征在于,求解所述g值敏感系数模型,包括:
(1)初始化粒子个数,学习因子;
(2)初始化粒子,包括的初始值作为粒子的初始位置,迭代速度作为粒子的初始速度;
(3)设置为目标函数为计算适应度;
(4)更新粒子状态;
(5)更新适应度;
(6)寻找全局最优粒子;
(7)判断是否达到迭代次数,如果达到,则结束迭代,输出最优解;否则返回步骤(4)。
6.根据权利要求1所述的任意六位置MEMS陀螺仪g值敏感系数标定方法,其特征在于,基于MEMS陀螺仪及加速度计输出关系建立g值敏感系数模型时,忽略交叉项的敏感系数。
7.一种MEMS陀螺仪,其特征在于,g值敏感系数采用权利要求1-6之一所述的任意六位置MEMS陀螺仪g值敏感系数标定方法标定。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202111264808.7A CN113865621B (zh) | 2021-10-28 | 2021-10-28 | 任意六位置MEMS陀螺仪及其g值敏感系数标定方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202111264808.7A CN113865621B (zh) | 2021-10-28 | 2021-10-28 | 任意六位置MEMS陀螺仪及其g值敏感系数标定方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN113865621A CN113865621A (zh) | 2021-12-31 |
CN113865621B true CN113865621B (zh) | 2023-08-22 |
Family
ID=78998321
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202111264808.7A Active CN113865621B (zh) | 2021-10-28 | 2021-10-28 | 任意六位置MEMS陀螺仪及其g值敏感系数标定方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN113865621B (zh) |
Citations (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
RU2408843C1 (ru) * | 2009-05-20 | 2011-01-10 | Общество с ограниченной ответственностью Научно-производственное предприятие "Ориентир" | Аналитический гирокомпас для квазистатических измерений |
CN102636184A (zh) * | 2012-03-31 | 2012-08-15 | 北京航空航天大学 | 无角运动环境下基于离心机的挠性陀螺比力敏感项标定方法 |
CN103389114A (zh) * | 2013-07-23 | 2013-11-13 | 中国兵器工业集团第二一四研究所苏州研发中心 | 基于g敏感性的三轴MEMS陀螺非正交误差标定方法 |
CN105277215A (zh) * | 2015-11-19 | 2016-01-27 | 中国兵器工业集团第二一四研究所苏州研发中心 | 基于离心加速度的mems陀螺加速度敏感性补偿方法 |
CN106705995A (zh) * | 2016-11-23 | 2017-05-24 | 极翼机器人(上海)有限公司 | 一种MEMS陀螺仪g值敏感系数的标定方法 |
CN109000680A (zh) * | 2018-05-31 | 2018-12-14 | 中国电子产品可靠性与环境试验研究所((工业和信息化部电子第五研究所)(中国赛宝实验室)) | 陀螺仪加速度敏感误差系数获取方法、装置和系统 |
Family Cites Families (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN115876225A (zh) * | 2022-12-22 | 2023-03-31 | 重庆九洲星熠导航设备有限公司 | 基于二自由度转台的mems imu标定方法及系统 |
-
2021
- 2021-10-28 CN CN202111264808.7A patent/CN113865621B/zh active Active
Patent Citations (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
RU2408843C1 (ru) * | 2009-05-20 | 2011-01-10 | Общество с ограниченной ответственностью Научно-производственное предприятие "Ориентир" | Аналитический гирокомпас для квазистатических измерений |
CN102636184A (zh) * | 2012-03-31 | 2012-08-15 | 北京航空航天大学 | 无角运动环境下基于离心机的挠性陀螺比力敏感项标定方法 |
CN103389114A (zh) * | 2013-07-23 | 2013-11-13 | 中国兵器工业集团第二一四研究所苏州研发中心 | 基于g敏感性的三轴MEMS陀螺非正交误差标定方法 |
CN105277215A (zh) * | 2015-11-19 | 2016-01-27 | 中国兵器工业集团第二一四研究所苏州研发中心 | 基于离心加速度的mems陀螺加速度敏感性补偿方法 |
CN106705995A (zh) * | 2016-11-23 | 2017-05-24 | 极翼机器人(上海)有限公司 | 一种MEMS陀螺仪g值敏感系数的标定方法 |
CN109000680A (zh) * | 2018-05-31 | 2018-12-14 | 中国电子产品可靠性与环境试验研究所((工业和信息化部电子第五研究所)(中国赛宝实验室)) | 陀螺仪加速度敏感误差系数获取方法、装置和系统 |
Non-Patent Citations (1)
Title |
---|
一种高精度MEMS陀螺仪g值敏感系数误差的标定方法;周彬;赵万良;石然;马吉雨;付伟平;;导航与控制(第05期);78-82 * |
Also Published As
Publication number | Publication date |
---|---|
CN113865621A (zh) | 2021-12-31 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN108827299B (zh) | 一种基于改进四元数二阶互补滤波的飞行器姿态解算方法 | |
CN109188026B (zh) | 适用于mems加速度计的自动标定的深度学习方法 | |
CN108731676B (zh) | 一种基于惯性导航技术的姿态融合增强测量方法及系统 | |
CN110174123B (zh) | 一种磁传感器实时标定方法 | |
CN109709628B (zh) | 一种旋转加速度计重力梯度仪标定方法 | |
CN109086250B (zh) | 适用于带斜置光纤陀螺的mems惯组的数据融合方法 | |
WO2022160391A1 (zh) | 磁力计信息辅助的mems陀螺仪标定方法及标定系统 | |
CN110567492A (zh) | 低成本mems惯性传感器系统级标定方法 | |
CN111121820B (zh) | 基于卡尔曼滤波的mems惯性传感器阵列融合方法 | |
CN110595434B (zh) | 基于mems传感器的四元数融合姿态估计方法 | |
CN113916257B (zh) | 三轴mems加计组合惯性测量单元标定方法 | |
CN111649747A (zh) | 一种基于imu的自适应ekf姿态测量改进方法 | |
CN108450007A (zh) | 使用廉价惯性传感器的冗余阵列的高性能惯性测量 | |
CN113865621B (zh) | 任意六位置MEMS陀螺仪及其g值敏感系数标定方法 | |
Xing et al. | Offline calibration for MEMS gyroscope g-sensitivity error coefficients based on the Newton iteration and least square methods | |
CN112683265B (zh) | 一种基于快速iss集员滤波的mimu/gps组合导航方法 | |
CN115267256A (zh) | 一种加速度计组件的模观测标定方法 | |
Zhang et al. | Implementation and complexity analysis of orientation estimation algorithms for human body motion tracking using low-cost sensors | |
CN114705184A (zh) | 基于神经网络的九轴姿态传感器一体化智能误差补偿方法 | |
CN112833918A (zh) | 一种基于函数迭代的高旋体微惯导空中对准方法及装置 | |
CN112013880B (zh) | 一种面向高动态应用环境的mems陀螺标定方法 | |
CN113790737B (zh) | 一种阵列式传感器的现场快速标定方法 | |
Ning et al. | MIMU error calibration method of turntable free platform based on improved genetic algorithm | |
CN117433561A (zh) | 一种基于遗传算法的免转台mimu误差标定方法 | |
CN114353825B (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 |