[go: up one dir, main page]
More Web Proxy on the site http://driver.im/

CN108827291B - 运动载体下的mems陀螺仪输出的零偏补偿方法及装置 - Google Patents

运动载体下的mems陀螺仪输出的零偏补偿方法及装置 Download PDF

Info

Publication number
CN108827291B
CN108827291B CN201810660414.5A CN201810660414A CN108827291B CN 108827291 B CN108827291 B CN 108827291B CN 201810660414 A CN201810660414 A CN 201810660414A CN 108827291 B CN108827291 B CN 108827291B
Authority
CN
China
Prior art keywords
quaternion
gyroscope
error
obtaining
information
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
Application number
CN201810660414.5A
Other languages
English (en)
Other versions
CN108827291A (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.)
Kaifeng Navigation Control Technology Co ltd
Original Assignee
Beijing Xilang Technology Co ltd
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 Beijing Xilang Technology Co ltd filed Critical Beijing Xilang Technology Co ltd
Priority to CN201810660414.5A priority Critical patent/CN108827291B/zh
Publication of CN108827291A publication Critical patent/CN108827291A/zh
Application granted granted Critical
Publication of CN108827291B publication Critical patent/CN108827291B/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
    • 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
    • G01C21/165—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 combined with non-inertial navigation instruments
    • 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
    • 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

Landscapes

  • Engineering & Computer Science (AREA)
  • Radar, Positioning & Navigation (AREA)
  • Remote Sensing (AREA)
  • Physics & Mathematics (AREA)
  • General Physics & Mathematics (AREA)
  • Automation & Control Theory (AREA)
  • Manufacturing & Machinery (AREA)
  • Gyroscopes (AREA)

Abstract

本发明实施例提供的一种运动载体下的MEMS陀螺仪输出的零偏补偿方法及装置，该方法包括：在第一采集时刻和第二采集时刻分别获取地磁计的第一信息和加速度计的第二信息，根据所述第一信息和所述第二信息分别建立所述地磁计的地磁四元数、所述陀螺仪的姿态四元数，根据所述地磁四元数获得共轭四元数，并根据所述共轭四元数和所述姿态四元数获得误差四元数，根据所述误差四元数获得对应的平台误差角；根据所述平台误差角和预设的陀螺零偏反馈系数分别获得对应于所述第一采集时刻和所述第二采集时刻的所述陀螺仪的零偏值，根据所述陀螺仪的零偏值获得对应于第二采集时刻的所述陀螺仪的输出值，实现快速补偿MEMS陀螺零偏，确保陀螺仪稳定输出。

Description

运动载体下的MEMS陀螺仪输出的零偏补偿方法及装置
技术领域
本发明涉及导航技术领域，尤其涉及一种运动载体下的MEMS陀螺仪输出的零偏补偿方法及装置。
背景技术
陀螺零偏补偿是为提高惯性导航精度服务的，对于高精度机电陀螺或光学陀螺，陀螺参数具有较高的逐次加电一致性，在使用前进行标定即可满足运动载体的导航精度需求，但对于MEMS陀螺，特别是消费级MEMS陀螺，零偏逐次加电重复性较差，变化幅度可达到1000°/h小时以上，若不进行补偿则无法实现在运动载体上导航的目的。
发明内容
本发明提供一种运动载体下的MEMS陀螺仪输出的零偏补偿方法及装置，用于解决现有技术中对于MEMS陀螺不进行补偿则无法实现在运动载体上导航的问题。
第一方面，本发明实施例提供一种运动载体下的MEMS陀螺仪输出的零偏补偿方法，包括：
在第一采集时刻和第二采集时刻分别获取地磁计的第一信息和加速度计的第二信息，根据所述第一信息和所述第二信息分别建立所述地磁计的地磁四元数、所述陀螺仪的姿态四元数；
根据所述地磁四元数获得共轭四元数，并根据所述共轭四元数和所述姿态四元数获得误差四元数；
根据所述误差四元数获得对应的平台误差角；
根据所述平台误差角和预设的陀螺零偏反馈系数分别获得对应于所述第一采集时刻和所述第二采集时刻的所述陀螺仪的零偏值；
根据所述陀螺仪的零偏值获得对应于第二采集时刻的所述陀螺仪的输出值；
其中，所述第二采集时刻晚于所述第一采集时刻。
可选地，在第一采集时刻和第二采集时刻分别获取地磁计的第一信息和加速度计的第二信息，根据所述第一信息和所述第二信息分别建立所述地磁计的地磁四元数、所述陀螺仪的姿态四元数，包括：
获取所述地磁计的标定参数和输出值，所述标定参数和输出值作为所述第一信息；
根据所述地磁计的标定参数和输出值获得所述陀螺仪的航向；
获取所述加速度计的俯仰角、横滚角，所述俯仰角和横滚角作为所述第二信息；
根据所述航向、俯仰角和横滚角获得所述地磁四元数和所述姿态四元数。
可选地，根据所述地磁四元数获得共轭四元数，并根据所述共轭四元数和所述姿态四元数获得误差四元数，包括：
根据所述地磁四元数采用第一计算公式获得共轭四元数，所述第一计算公式为：
Figure GDA0002441263020000021
其中，
Figure GDA0002441263020000022
为共轭四元数，qM0，qMx，qMy，qMz均为地磁四元数的四个数值；
根据共轭四元数、姿态四元数采用第二计算公式获得误差四元数，所述第二计算公式为：
Figure GDA0002441263020000023
其中，dq为误差四元数，
Figure GDA0002441263020000024
为共轭四元数，qG为姿态四元数。
可选地，根据所述误差四元数获得对应的平台误差角，包括：
根据所述误差四元数采用第三计算公式获得对应的平台误差角，所述第三计算公式为：
δλx＝0.5·dq0·dq1
δλy＝0.5·dq0·dq2
δλz＝0.5·dq0·dq3
其中，设δλ(x，y，z)为平台误差角，δλx、δλy、δλz为平台误差角的三个数值，dq0、dq1、dq2、dq3为误差四元数的四个数值。
可选地，根据所述陀螺仪的零偏值获得对应于第二采集时刻的所述陀螺仪的输出值，包括：
将对应于所述第一采集时刻的零偏值和对应于所述第二采集时刻的零偏值进行差值计算，获得变化幅度值；
将变化幅度值与预设的零偏收敛阈值进行比较，当变化幅度值小于零偏收敛阈值，则将对应于第二采集时刻的陀螺仪的输出值减去对应的零偏值作为所述陀螺仪的输出值。
第二方面，本发明实施例提供一种运动载体下的MEMS陀螺仪输出的零偏补偿装置，包括：
建立模块，用于在第一采集时刻和第二采集时刻分别获取地磁计的第一信息和加速度计的第二信息，根据所述第一信息和所述第二信息分别建立所述地磁计的地磁四元数、所述陀螺仪的姿态四元数；
第一计算模块，用于根据所述地磁四元数获得共轭四元数，并根据所述共轭四元数和所述姿态四元数获得误差四元数；
第二计算模块，用于根据所述误差四元数获得对应的平台误差角；
第三计算模块，用于根据所述平台误差角和预设的陀螺零偏反馈系数分别获得对应于所述第一采集时刻和所述第二采集时刻的所述陀螺仪的零偏值；
输出模块，用于根据所述陀螺仪的零偏值获得对应于第二采集时刻的所述陀螺仪的输出值；
其中，所述第二采集时刻晚于所述第一采集时刻。
可选地，所述建立模块具体用于：
获取所述地磁计的标定参数和输出值，所述标定参数和输出值作为所述第一信息；
根据所述地磁计的标定参数和输出值获得所述陀螺仪的航向；
获取所述加速度计的俯仰角、横滚角，所述俯仰角和横滚角作为所述第二信息；
根据所述航向、俯仰角和横滚角获得所述地磁四元数和所述姿态四元数。
可选地，所述第一计算模块具体用于：
根据所述地磁四元数采用第一计算公式获得共轭四元数，所述第一计算公式为：
Figure GDA0002441263020000041
其中，
Figure GDA0002441263020000042
为共轭四元数，qM0，qMx，qMy，qMz均为地磁四元数的四个数值；
根据共轭四元数、姿态四元数采用第二计算公式获得误差四元数，所述第二计算公式为：
Figure GDA0002441263020000043
其中，dq为误差四元数，
Figure GDA0002441263020000044
为共轭四元数，qG为姿态四元数。
可选地，所述第二计算模块具体用于：
根据所述误差四元数采用第三计算公式获得对应的平台误差角，所述第三计算公式为：
δλx＝0.5·dq0·dq1
δλy＝0.5·dq0·dq2
δλz＝0.5·dq0·dq3
其中，设δλ(x，y，z)为平台误差角，δλx、δλy、δλz为平台误差角的三个数值，dq0、dq1、dq2、dq3为误差四元数的四个数值。
可选地，所述输出模块具体用于：
将对应于所述第一采集时刻的零偏值和对应于所述第二采集时刻的零偏值进行差值计算，获得变化幅度值；
将变化幅度值与预设的零偏收敛阈值进行比较，当变化幅度值小于零偏收敛阈值，则将对应于第二采集时刻的陀螺仪的输出值减去对应的零偏值作为所述陀螺仪的输出值。
由上述技术方案可知，本发明实施例提供的一种运动载体下的MEMS陀螺仪输出的零偏补偿方法及装置，通过在第一采集时刻和第二采集时刻分别获取地磁计的第一信息和加速度计的第二信息，根据所述第一信息和所述第二信息分别建立所述地磁计的地磁四元数、所述陀螺仪的姿态四元数，根据所述地磁四元数获得共轭四元数，并根据所述共轭四元数和所述姿态四元数获得误差四元数，根据所述误差四元数获得对应的平台误差角；根据所述平台误差角和预设的陀螺零偏反馈系数分别获得对应于所述第一采集时刻和所述第二采集时刻的所述陀螺仪的零偏值，根据所述陀螺仪的零偏值获得对应于第二采集时刻的所述陀螺仪的输出值，实现快速补偿MEMS陀螺零偏，确保陀螺仪稳定输出。
附图说明
图1为本发明一实施例提供的运动载体下的MEMS陀螺仪输出的零偏补偿方法的流程示意图；
图2为本发明一实施例提供的运动载体下的MEMS陀螺仪输出的零偏补偿装置的结构示意图。
具体实施方式
下面结合附图和实施例，对本发明的具体实施方式作进一步详细描述。以下实施例用于说明本发明，但不用来限制本发明的范围。
图1示出了本发明一实施例提供一种运动载体下的MEMS陀螺仪输出的零偏补偿方法，包括：
S11、在第一采集时刻和第二采集时刻分别获取地磁计的第一信息和加速度计的第二信息，根据所述第一信息和所述第二信息分别建立所述地磁计的地磁四元数、所述陀螺仪的姿态四元数；
S12、根据所述地磁四元数获得共轭四元数，并根据所述共轭四元数和所述姿态四元数获得误差四元数；
S13、根据所述误差四元数获得对应的平台误差角；
S14、根据所述平台误差角和预设的陀螺零偏反馈系数分别获得对应于所述第一采集时刻和所述第二采集时刻的所述陀螺仪的零偏值；
S15、根据所述陀螺仪的零偏值获得对应于第二采集时刻的所述陀螺仪的输出值；
其中，所述第二采集时刻晚于所述第一采集时刻。
针对步骤S11-步骤S15，需要说明的是，在本发明实施例中，第一采集时刻和第二采集时刻为相邻的两个采集时刻，所述第二采集时刻晚于所述第一采集时刻。
在本发明实施例中，获取地磁计的信息之前，首先要对地磁计的参数进行标定。地磁计的误差主要归纳为三类，分别是当量误差、零偏以及非正交误差，列写磁力计输出椭圆方程：
Figure GDA0002441263020000061
Figure GDA0002441263020000062
分别为磁力计在水平方向的输出值，其与地磁真值
Figure GDA0002441263020000063
之间的关系可以表示为：
Figure GDA0002441263020000064
对于归一化标定结果，
Figure GDA0002441263020000065
可以表示为
Figure GDA0002441263020000066
的形式，将(2)代入归一化表达式后即可表示为(1)式的形式。对a,b,ρ,x0,y0展开后可得到各参数与参数A-F的变换关系，在此不再赘述。
a,b,ρ,x0,y0分别为地磁X轴半径、地磁Y轴半径、椭圆倾斜角、X轴向零偏、Y轴向零偏。
将相关误差项与地磁计输出关联，为了实现对参数A-F的最优估计，可以对上式进行适当改造，以矩阵形式表示从而适应最小二乘计算，如式(3)所示：
Figure GDA0002441263020000067
经过多次迭代计算后，所有的地磁计测试数据可合成为一个大矩阵，矩阵可表示为如下形式：
X×P＝W (4)
其中：
Figure GDA0002441263020000071
Figure GDA0002441263020000072
Figure GDA0002441263020000073
通过最小二乘计算得到最优估计，计算公式可表示如下：
Pest＝(XTX)-1X (8)
经过最小二乘解算后可以得到地磁计A-F的计算结果，并变换得到a,b,ρ,x0,y0等误差参数。
在本发明实施例中，所述第一信息包括地磁计的标定参数和输出值。所述第二信息包括加速度计的俯仰角和横滚角。
载体运动状态下，利用经过标定后的参数及地磁计输出得到初始航向ψ。
Figure GDA0002441263020000081
Figure GDA0002441263020000082
初始不水平角度(包括俯仰角θ、横滚角γ)可利用加速度计获得，同时利用ψ、θ、γ建立地磁四元数初值q0M和姿态四元数初值q0G。
在本发明实施例中，经过多个时刻点的信息获取，能够对地磁四元数和姿态四元数进行更新。
在本发明实施例中，根据所述地磁四元数采用第一计算公式获得共轭四元数，所述第一计算公式为：
Figure GDA0002441263020000083
其中，
Figure GDA0002441263020000084
为共轭四元数，qM0，qMx，qMy，qMz均为地磁四元数的四个数值；
根据共轭四元数、姿态四元数采用第二计算公式获得误差四元数，所述第二计算公式为：
Figure GDA0002441263020000085
其中，dq为误差四元数，
Figure GDA0002441263020000086
为共轭四元数，qG为姿态四元数。
根据所述误差四元数采用第三计算公式获得对应的平台误差角，所述第三计算公式为：
δλx＝0.5·dq0·dq1
δλy＝0.5·dq0·dq2
δλz＝0.5·dq0·dq3
其中，设δλ(x，y，z)为平台误差角，δλx、δλy、δλz为平台误差角的三个数值，dq0、dq1、dq2、dq3为误差四元数的四个数值。
为了更好对上述内容进行解释说明，在本发明实施例中，k+1时刻为第二采集时刻，k时刻为第一采集时刻。
计算
Figure GDA0002441263020000091
的共轭四元数
Figure GDA0002441263020000092
Figure GDA0002441263020000093
将
Figure GDA0002441263020000094
和
Figure GDA0002441263020000095
四元数相乘得到误差四元数
Figure GDA0002441263020000096
Figure GDA0002441263020000097
在本发明实施例中，
根据所述误差四元数采用第三计算公式获得对应的平台误差角，所述第三计算公式为：
δλx＝0.5·dq0·dq1
δλy＝0.5·dq0·dq2
δλz＝0.5·dq0·dq3
其中，设δλ(x，y，z)为平台误差角，δλx、δλy、δλz为平台误差角的三个数值，dq0、dq1、dq2、dq3为误差四元数的四个数值。
进一步的解释说明计算得到平台误差角，记为
Figure GDA0002441263020000098
记为：
Figure GDA0002441263020000099
选取一个小于1的浮点数作为陀螺零偏反馈系数k，将平台误差角与反馈系数相乘即为本次迭代计算所得零偏值，记为
Figure GDA00024412630200000910
表示为：
Figure GDA00024412630200000911
设定零偏收敛阈值，
Figure GDA00024412630200000912
与
Figure GDA00024412630200000913
三个轴向变化幅度小于0.05°/s即认为互补滤波迭代收敛；在陀螺输出中扣除
Figure GDA00024412630200000914
后可得到经过零偏补偿的陀螺输出。另外，当变化幅度值不小于零偏收敛阈值，则直接陀螺输出。
本发明实施例提供的一种运动载体下的MEMS陀螺仪输出的零偏补偿方法，通过在第一采集时刻和第二采集时刻分别获取地磁计的第一信息和加速度计的第二信息，根据所述第一信息和所述第二信息分别建立所述地磁计的地磁四元数、所述陀螺仪的姿态四元数，根据所述地磁四元数获得共轭四元数，并根据所述共轭四元数和所述姿态四元数获得误差四元数，根据所述误差四元数获得对应的平台误差角；根据所述平台误差角和预设的陀螺零偏反馈系数分别获得对应于所述第一采集时刻和所述第二采集时刻的所述陀螺仪的零偏值，根据所述陀螺仪的零偏值获得对应于第二采集时刻的所述陀螺仪的输出值，实现快速补偿MEMS陀螺零偏，确保陀螺仪稳定输出。
图2示出了本发明一实施例提供的一种运动载体下的MEMS陀螺仪输出的零偏补偿装置，包括建立模块21、第一计算模块22、第二计算模块23、第三计算模块24、输出模块25，其中：
建立模块21，用于在第一采集时刻和第二采集时刻分别获取地磁计的第一信息和加速度计的第二信息，根据所述第一信息和所述第二信息分别建立所述地磁计的地磁四元数、所述陀螺仪的姿态四元数；
第一计算模块22，用于根据所述地磁四元数获得共轭四元数，并根据所述共轭四元数和所述姿态四元数获得误差四元数；
第二计算模块23，用于根据所述误差四元数获得对应的平台误差角；
第三计算模块24，用于根据所述平台误差角和预设的陀螺零偏反馈系数分别获得对应于所述第一采集时刻和所述第二采集时刻的所述陀螺仪的零偏值；
输出模块25，用于根据所述陀螺仪的零偏值获得对应于第二采集时刻的所述陀螺仪的输出值；
其中，所述第二采集时刻晚于所述第一采集时刻。
由于本发明实施例所述装置与上述实施例所述方法的原理相同，对于更加详细的解释内容在此不再赘述。
需要说明的是，本发明实施例中可以通过硬件处理器(hardware processor)来实现相关功能模块。
本发明实施例提供的一种运动载体下的MEMS陀螺仪输出的零偏补偿装置，通过在第一采集时刻和第二采集时刻分别获取地磁计的第一信息和加速度计的第二信息，根据所述第一信息和所述第二信息分别建立所述地磁计的地磁四元数、所述陀螺仪的姿态四元数，根据所述地磁四元数获得共轭四元数，并根据所述共轭四元数和所述姿态四元数获得误差四元数，根据所述误差四元数获得对应的平台误差角；根据所述平台误差角和预设的陀螺零偏反馈系数分别获得对应于所述第一采集时刻和所述第二采集时刻的所述陀螺仪的零偏值，根据所述陀螺仪的零偏值获得对应于第二采集时刻的所述陀螺仪的输出值，实现快速补偿MEMS陀螺零偏，确保陀螺仪稳定输出。
此外，本领域的技术人员能够理解，尽管在此所述的一些实施例包括其它实施例中所包括的某些特征而不是其它特征，但是不同实施例的特征的组合意味着处于本发明的范围之内并且形成不同的实施例。例如，在下面的权利要求书中，所要求保护的实施例的任意之一都可以以任意的组合方式来使用。
应该注意的是上述实施例对本发明进行说明而不是对本发明进行限制，并且本领域技术人员在不脱离所附权利要求的范围的情况下可设计出替换实施例。在权利要求中，不应将位于括号之间的任何参考符号构造成对权利要求的限制。单词“包含”不排除存在未列在权利要求中的元件或步骤。位于元件之前的单词“一”或“一个”不排除存在多个这样的元件。本发明可以借助于包括有若干不同元件的硬件以及借助于适当编程的计算机来实现。在列举了若干装置的单元权利要求中，这些装置中的若干个可以是通过同一个硬件项来具体体现。单词第一、第二、以及第三等的使用不表示任何顺序。可将这些单词解释为名称。
本领域普通技术人员可以理解：以上各实施例仅用以说明本发明的技术方案，而非对其限制；尽管参照前述各实施例对本发明进行了详细的说明，本领域的普通技术人员应当理解：其依然可以对前述各实施例所记载的技术方案进行修改，或者对其中部分或者全部技术特征进行等同替换；而这些修改或者替换，并不使相应技术方案的本质脱离本发明权利要求所限定的范围。

Claims (8)

1.一种运动载体下的MEMS陀螺仪输出的零偏补偿方法，其特征在于，包括：
在第一采集时刻和第二采集时刻分别获取地磁计的第一信息和加速度计的第二信息，根据所述第一信息和所述第二信息分别建立所述地磁计的地磁四元数、所述陀螺仪的姿态四元数；
根据所述地磁四元数获得共轭四元数，并根据所述共轭四元数和所述姿态四元数获得误差四元数；
根据所述误差四元数获得对应的平台误差角；
根据所述平台误差角和预设的陀螺零偏反馈系数分别获得对应于所述第一采集时刻和所述第二采集时刻的所述陀螺仪的零偏值；
根据所述陀螺仪的零偏值获得对应于第二采集时刻的所述陀螺仪的输出值；
其中，所述第二采集时刻晚于所述第一采集时刻；
其中，根据所述误差四元数获得对应的平台误差角，包括：
根据所述误差四元数采用第三计算公式获得对应的平台误差角，所述第三计算公式为：
δλx＝0.5·dq0·dq1
δλy＝0.5·dq0·dq2
δλz＝0.5·dq0·dq3
其中，设δλ(x，y，z)为平台误差角，δλx、δλy、δλz为平台误差角的三个数值，dq0、dq1、dq2、dq3为误差四元数的四个数值。
2.根据权利要求1所述的方法，其特征在于，在第一采集时刻和第二采集时刻分别获取地磁计的第一信息和加速度计的第二信息，根据所述第一信息和所述第二信息分别建立所述地磁计的地磁四元数、所述陀螺仪的姿态四元数，包括：
获取所述地磁计的标定参数和输出值，所述标定参数和输出值作为所述第一信息；
根据所述地磁计的标定参数和输出值获得所述陀螺仪的航向；
获取所述加速度计的俯仰角、横滚角，所述俯仰角和横滚角作为所述第二信息；
根据所述航向、俯仰角和横滚角获得所述地磁四元数和所述姿态四元数。
3.根据权利要求2所述的方法，其特征在于，根据所述地磁四元数获得共轭四元数，并根据所述共轭四元数和所述姿态四元数获得误差四元数，包括：
根据所述地磁四元数采用第一计算公式获得共轭四元数，所述第一计算公式为：
Figure FDA0002441263010000021
其中，
Figure FDA0002441263010000022
为共轭四元数，qM0，qMx，qMy，qMz为地磁四元数的四个数值；
根据共轭四元数、姿态四元数采用第二计算公式获得误差四元数，所述第二计算公式为：
Figure FDA0002441263010000023
其中，dq为误差四元数，
Figure FDA0002441263010000024
为共轭四元数，qG为姿态四元数。
4.根据权利要求1所述的方法，其特征在于，根据所述陀螺仪的零偏值获得对应于第二采集时刻的所述陀螺仪的输出值，包括：
将对应于所述第一采集时刻的零偏值和对应于所述第二采集时刻的零偏值进行差值计算，获得变化幅度值；
将变化幅度值与预设的零偏收敛阈值进行比较，当变化幅度值小于零偏收敛阈值，则将对应于第二采集时刻的陀螺仪的输出值减去对应的零偏值作为所述陀螺仪的输出值。
5.一种运动载体下的MEMS陀螺仪输出的零偏补偿装置，包括：
建立模块，用于在第一采集时刻和第二采集时刻分别获取地磁计的第一信息和加速度计的第二信息，根据所述第一信息和所述第二信息分别建立所述地磁计的地磁四元数、所述陀螺仪的姿态四元数；
第一计算模块，用于根据所述地磁四元数获得共轭四元数，并根据所述共轭四元数和所述姿态四元数获得误差四元数；
第二计算模块，用于根据所述误差四元数获得对应的平台误差角；
第三计算模块，用于根据所述平台误差角和预设的陀螺零偏反馈系数分别获得对应于所述第一采集时刻和所述第二采集时刻的所述陀螺仪的零偏值；
输出模块，用于根据所述陀螺仪的零偏值获得对应于第二采集时刻的所述陀螺仪的输出值；
其中，所述第二采集时刻晚于所述第一采集时刻；
所述第二计算模块具体用于：
根据所述误差四元数采用第三计算公式获得对应的平台误差角，所述第三计算公式为：
δλx＝0.5·dq0·dq1
δλy＝0.5·dq0·dq2
δλz＝0.5·dq0·dq3
其中，设δλ(x，y，z)为平台误差角，δλx、δλy、δλz为平台误差角的三个数值，dq0、dq1、dq2、dq3为误差四元数的四个数值。
6.根据权利要求5所述的装置，其特征在于，所述建立模块具体用于：
获取所述地磁计的标定参数和输出值，所述标定参数和输出值作为所述第一信息；
根据所述地磁计的标定参数和输出值获得所述陀螺仪的航向；
获取所述加速度计的俯仰角、横滚角，所述俯仰角和横滚角作为所述第二信息；
根据所述航向、俯仰角和横滚角获得所述地磁四元数和所述姿态四元数。
7.根据权利要求6所述的装置，其特征在于，所述第一计算模块具体用于：
根据所述地磁四元数采用第一计算公式获得共轭四元数，所述第一计算公式为：
Figure FDA0002441263010000031
其中，
Figure FDA0002441263010000032
为共轭四元数，qM0，qMx，qMy，qMz为地磁四元数的四个数值；
根据共轭四元数、姿态四元数采用第二计算公式获得误差四元数，所述第二计算公式为：
Figure FDA0002441263010000041
其中，dq为误差四元数，
Figure FDA0002441263010000042
为共轭四元数，qG为姿态四元数。
8.根据权利要求5所述的装置，其特征在于，所述输出模块具体用于：
将对应于所述第一采集时刻的零偏值和对应于所述第二采集时刻的零偏值进行差值计算，获得变化幅度值；
将变化幅度值与预设的零偏收敛阈值进行比较，当变化幅度值小于零偏收敛阈值，则将对应于第二采集时刻的陀螺仪的输出值减去对应的零偏值作为所述陀螺仪的输出值。
CN201810660414.5A 2018-06-25 2018-06-25 运动载体下的mems陀螺仪输出的零偏补偿方法及装置 Active CN108827291B (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN201810660414.5A CN108827291B (zh) 2018-06-25 2018-06-25 运动载体下的mems陀螺仪输出的零偏补偿方法及装置

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN201810660414.5A CN108827291B (zh) 2018-06-25 2018-06-25 运动载体下的mems陀螺仪输出的零偏补偿方法及装置

Publications (2)

Publication Number Publication Date
CN108827291A CN108827291A (zh) 2018-11-16
CN108827291B true CN108827291B (zh) 2020-06-23

Family

ID=64138156

Family Applications (1)

Application Number Title Priority Date Filing Date
CN201810660414.5A Active CN108827291B (zh) 2018-06-25 2018-06-25 运动载体下的mems陀螺仪输出的零偏补偿方法及装置

Country Status (1)

Country Link
CN (1) CN108827291B (zh)

Families Citing this family (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN110530397A (zh) * 2019-08-08 2019-12-03 北京首贝科技发展有限公司 一种基于九轴imu的磁场自动标定方法
EP4085231A4 (en) * 2019-12-31 2023-09-27 Robert Bosch Power Tools GmbH METHOD AND APPARATUS FOR CALIBRATING WEIGHTLESS OFFSET FOR A MEMS-TYPE ACCELEROMETER
CN112378417A (zh) * 2020-10-27 2021-02-19 苏州臻迪智能科技有限公司 一种基于惯性测量单元的陀螺仪零偏获取方法及系统
CN114088110B (zh) * 2021-09-26 2023-04-18 湖北三江航天红峰控制有限公司 一种高精度光纤陀螺阈值测试方法

Citations (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN102654404A (zh) * 2011-03-02 2012-09-05 浙江中科无线授时与定位研发中心 一种提高航姿参考系统解算精度和系统抗干扰能力的方法
CN103900608A (zh) * 2014-03-21 2014-07-02 哈尔滨工程大学 一种基于四元数ckf的低精度惯导初始对准方法
JP2015148497A (ja) * 2014-02-06 2015-08-20 マグネデザイン株式会社 磁気型ジャイロスコープおよび三次元方位計
CN105300384A (zh) * 2015-04-03 2016-02-03 东南大学 一种用于卫星姿态确定的交互式滤波方法
CN105606846A (zh) * 2015-09-18 2016-05-25 北京理工大学 一种基于姿态信息的加速度计校准方法
CN105773617A (zh) * 2016-04-15 2016-07-20 哈尔滨工业大学 空间机器人的三指式抓持器碰撞预测方法

Patent Citations (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN102654404A (zh) * 2011-03-02 2012-09-05 浙江中科无线授时与定位研发中心 一种提高航姿参考系统解算精度和系统抗干扰能力的方法
JP2015148497A (ja) * 2014-02-06 2015-08-20 マグネデザイン株式会社 磁気型ジャイロスコープおよび三次元方位計
CN103900608A (zh) * 2014-03-21 2014-07-02 哈尔滨工程大学 一种基于四元数ckf的低精度惯导初始对准方法
CN105300384A (zh) * 2015-04-03 2016-02-03 东南大学 一种用于卫星姿态确定的交互式滤波方法
CN105606846A (zh) * 2015-09-18 2016-05-25 北京理工大学 一种基于姿态信息的加速度计校准方法
CN105773617A (zh) * 2016-04-15 2016-07-20 哈尔滨工业大学 空间机器人的三指式抓持器碰撞预测方法

Also Published As

Publication number Publication date
CN108827291A (zh) 2018-11-16

Similar Documents

Publication Publication Date Title
CN109163721B (zh) 姿态测量方法及终端设备
CN108827291B (zh) 运动载体下的mems陀螺仪输出的零偏补偿方法及装置
CN109696183B (zh) 惯性测量单元的标定方法及装置
US9417091B2 (en) System and method for determining and correcting field sensors errors
KR101739390B1 (ko) 중력오차보상을 통한 관성항법장치의 자체정렬 정확도 향상기법
CN109084806B (zh) 标量域mems惯性系统标定方法
EP1552246A2 (en) Method and system for processing pulse signals within an inertial navigation system
CN105910602B (zh) 一种组合导航方法
CN112591148B (zh) 利用在轨恒星感光评估姿态稳定度的方法及系统
CN113155129B (zh) 一种基于扩展卡尔曼滤波的云台姿态估计方法
CN110174121A (zh) 一种基于地磁场自适应修正的航姿系统姿态解算方法
CN109470272B (zh) 一种imu测量基准的标定方法
CN108827341A (zh) 用于确定图像采集装置的惯性测量单元中的偏差的方法
CN115435817B (zh) Mems惯导安装误差的标定方法、存储介质和控制计算机
CN114485641A (zh) 一种基于惯导卫导方位融合的姿态解算方法及装置
CN109489661B (zh) 一种卫星初始入轨时陀螺组合常值漂移估计方法
CN112945271A (zh) 磁力计信息辅助的mems陀螺仪标定方法及标定系统
CN116817896A (zh) 一种基于扩展卡尔曼滤波的姿态解算方法
CN108871319B (zh) 一种基于地球重力场与地磁场序贯修正的姿态解算方法
CN103913179A (zh) 舰载单轴旋转调制捷联惯导姿态角修正方法
US11293816B2 (en) Inertial measurement apparatus and method with improved thermal and noise performance
CN107389092B (zh) 一种基于磁传感器辅助的陀螺标定方法
CN111141285B (zh) 一种航空重力测量装置
Papafotis et al. Multiple accelerometers and magnetometers joint calibration and alignment
CN108692727B (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
TR01 Transfer of patent right

Effective date of registration: 20220630

Address after: 230088 1056, North building, Hefei original animation Park Management Co., Ltd., No. 19, Tianzhi Road, high tech Zone, Hefei, Anhui Province

Patentee after: Hefei Kaifa Navigation Control Technology Co.,Ltd.

Address before: 100036 b323, floor 3, building 14, Cuiwei Zhongli, Haidian District, Beijing

Patentee before: BEIJING XILANG TECHNOLOGY Co.,Ltd.

TR01 Transfer of patent right
CP01 Change in the name or title of a patent holder

Address after: 230088 1056, North building, Hefei original animation Park Management Co., Ltd., No. 19, Tianzhi Road, high tech Zone, Hefei, Anhui Province

Patentee after: Kaifeng Navigation Control Technology Co.,Ltd.

Address before: 230088 1056, North building, Hefei original animation Park Management Co., Ltd., No. 19, Tianzhi Road, high tech Zone, Hefei, Anhui Province

Patentee before: Hefei Kaifa Navigation Control Technology Co.,Ltd.

CP01 Change in the name or title of a patent holder