CN107202578A - 一种基于mems技术的捷联式垂直陀螺仪解算方法 - Google Patents
一种基于mems技术的捷联式垂直陀螺仪解算方法 Download PDFInfo
- Publication number
- CN107202578A CN107202578A CN201710326078.6A CN201710326078A CN107202578A CN 107202578 A CN107202578 A CN 107202578A CN 201710326078 A CN201710326078 A CN 201710326078A CN 107202578 A CN107202578 A CN 107202578A
- Authority
- CN
- China
- Prior art keywords
- mrow
- mtd
- mtr
- angle
- msub
- 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
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/18—Stabilised platforms, e.g. by gyroscope
-
- 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)
- Navigation (AREA)
Abstract
本发明公开了一种基于MEMS技术的捷联式垂直陀螺仪解算方法，具体按照以下步骤实施：步骤1，互补对称加速度传感器的布局与各角度解算，步骤2，进行捷联解算，在步骤1中解算出的俯仰角和横滚角基础上，把三轴陀螺仪测得载体的角速度信息按俯仰轴和横滚轴二次旋转，变换到水平地理坐标系，按捷联算法求出俯仰角和横滚角，步骤3，利用Kalman滤波器进行信息融合，解决了现有机械式垂直陀螺仪在载体加速过程中的测量不准确问题和捷联式惯导系统的高成本问题。
Description
技术领域
本发明属于电子信息和导航技术领域，涉及基于MEMS技术的捷联式垂直陀螺仪解算方法。
背景技术
垂直陀螺仪(Vertical Gyroscope,VG)是无人机、稳定云台和“动中通”天线等重要的姿态传感器，其在载体运动过程中实时获取载体的姿态信息,即俯仰角和横滚角。
机械式垂直陀螺仪：机械式垂直陀螺仪是一个框架式双自由度陀螺和液体摆构成的闭环控制系统，使陀螺的自转轴稳定在当地地垂线方向上，它的原理就是利用陀螺的定轴性和进动性可测量载体的俯仰角和横滚角。机械螺仪由于其结构复杂、制造困难、漂移误差大和使用环境要求高等，现在已经很少应用。
捷联式惯导系统：捷联式惯导系统不采用实体平台，把三轴加速度计与三轴陀螺仪直接固连在载体上，利用计算机实时计算姿态矩阵，通过姿态矩阵把加速度计测得的机体的加速度信息，变化到导航坐标系，然后进行导航解算，同时从姿态矩阵的元素中提取航向角和姿态角信息。缺点一是捷联式惯导系统依靠高精度的陀螺和加速度计，才能在初始对准过程中，通过敏感当地的地球自传角速度，才能给出航向角信息；二是由于陀螺仪和加速度计长时间会产生漂移，需要外部信息修正，比如GPS和北斗信息。
发明内容
本发明的目的是提供一种基于MEMS技术的捷联式垂直陀螺仪解算方法，解决了现有机械式垂直陀螺仪在载体加速过程中的测量不准确问题和捷联式惯导系统的高成本问题。
本发明所采用的技术方案是，一种基于MEMS技术的捷联式垂直陀螺仪解算方法，基于如下定义的坐标系：垂直陀螺仪的导航坐标系取为地理坐标系，建立载体所在位置的地理坐标系为北-东-地，即N-E-D，固连在载体上的载体坐标系为X-Y-Z，X处于载体对称平面内，由质心指向载体运动前向；Y垂直于载体对称平面并指向右方；Z在载体对称平面内且垂直于X轴指向下方，其特征在于，具体按照以下步骤实施：
步骤1，互补对称加速度传感器的布局与各角度解算，
步骤2，进行捷联解算，在步骤1中解算出的俯仰角和横滚角基础上，把三轴陀螺仪测得载体的角速度信息按俯仰轴和横滚轴二次旋转，变换到水平地理坐标系，按捷联算法求出俯仰角和横滚角，
步骤3，利用Kalman滤波器进行信息融合。
本发明的特点还在于，
所述的步骤1具体为，
步骤1.1，互补对称加速度传感器的布局，将在载体的X-Z和Y-Z平面沿X轴和Y轴方向，且与X轴和Y轴的夹角分别为α角度分别布置2对加速度传感器，在X-Y-Z轴三个方向上，各布置一个陀螺仪；
步骤1.2，俯仰角度的解算，
设载体X轴方向加速度xa和俯仰角度xt时，从两个加速度传感器上采集到的加速度的输出值ax1和ax2分别为：
经过推导，可以求得：
其中中间变量：
步骤1.3，横滚角的解算，
当载体Y轴方向有加速度ya和横滚角度yt时，利用同样的原理，借助公
式(1)、(2)在求出横滚角度yt的基础之上除以cos(xt)即可。
所述的步骤2具体为：
设载体坐标系下的俯仰角θ，横滚角γ，载体坐标系与地理坐标系经过两次旋转变换，变换阵为：
载体坐标系上，按步骤1.1方法布置的三个陀螺的测量值分别为：ωx、ωy和ωz，把载体系测量得到的三维角速度转换到地理坐标系，得到：
式中和为水平地理系下对应的角速度，对应横滚轴；对应俯仰轴；
角速度在采样周期内积分，根据(4),结合初始条件可以得到水平地理坐标系下的俯仰角增量θ和横滚角增量γ分别为：
式中T为解算周期。
步骤3具体为，以俯仰角误差φx＝xi-θ和横滚角误差φy＝yi-γ以及三个的漂移误差作为Kalman滤波器的状态方量的变量；
步骤3.1，建立系统状态方程，
取垂直陀螺仪系统的状态量X为：
X＝[φx φy εx εy εz]T，
式中：φθ和φγ是俯仰角和横滚角的测量误差；εx、εy和εz为三轴陀螺仪的漂移误差，
这三个误差可以事前通过静态测试得到，用一阶马尔科夫过程描述，则垂直陀螺仪的状态方程为：
式中：系统状态转移矩阵
系统噪声驱动矩阵：
系统激励噪声矩阵W＝[wx wy wz]T，
τx、τy、τz和wx、wy、wz分别为X、Y和Z周陀螺的一阶马尔科夫时间和方差。
步骤3.2，建立系统量测方程，
以互补对称加速度传感器解算的角度xt、yt和捷联解算得到的角度θ、γ之差作为观测量：
所以量测方程为：Z＝HX+V
式中：量测矩阵V为加速度测量角度的方差。
本发明的有益效果是，通过传感器的布局、姿态角度的捷联式算法、载体加速度对角度解算误差的消除和捷联式解算数据与倾角解算的数据融合等技术，最终给出动态环境下的载体俯仰角和横滚角的测量值。
附图说明
图1是本发明基于MEMS技术的捷联式垂直陀螺仪解算方法中的互补对称加速度传感器的布置图；
图2是本发明基于MEMS技术的捷联式垂直陀螺仪解算方法中的三轴陀螺仪的布置图。
具体实施方式
下面结合附图和具体实施方式对本发明进行详细说明。
一种基于MEMS技术的捷联式垂直陀螺仪解算方法，基于如下定义的坐标系：垂直陀螺仪的导航坐标系取为地理坐标系，建立载体所在位置的地理坐标系为北-东-地(即N-E-D)、固连在载体上的载体坐标系为X-Y-Z，X处于载体对称平面内，由质心指向载体运动前向；Y垂直于载体对称平面并指向右方；Z在载体对称平面内且垂直于X轴指向下方，
具体按照以下步骤实施：
步骤1，互补对称加速度传感器的布局与各角度解算，
步骤1.1，互补对称加速度传感器的布局，按照如图1所示，将在载体的X-Z和Y-Z平面沿X轴和Y轴方向，且与X轴和Y轴的夹角分别为α角度分别布置2对加速度传感器，在X-Y-Z轴三个方向上，各布置一个陀螺仪；
步骤1.2，俯仰角度的解算，
设载体X轴方向加速度xa和俯仰角度xt时，从两个加速度传感器上采集到的加速度的输出值ax1和ax2分别为：
经过推导，可以求得：
其中中间变量：
步骤1.3，横滚角的解算，
当载体Y轴方向有加速度ya和横滚角度yt时，利用同样的原理，借助公式(1)、(2)在求出横滚角度yt的基础之上除以cos(xt)即可。
步骤2，进行捷联解算，在步骤1.2中解算出的俯仰角和横滚角基础上，把三轴陀螺仪测得载体的角速度信息按俯仰轴和横滚轴二次旋转，变换到水平地理坐标系，按捷联算法求出俯仰角和横滚角，设此方法解算出的俯仰角为θ，横滚角为γ，与之前解算出的俯仰角xt和横滚角yt代表的是同一角度，只是表示方法不同。
步骤2.1，设载体坐标系下的俯仰角θ，横滚角γ，载体坐标系与地理坐标系经过两次旋转变换，变换阵为：
载体坐标系上，按步骤1.1方法布置的三个陀螺的测量值分别为：ωx、ωy和ωz，把载体系测量得到的三维角速度转换到地理坐标系，得到：
式中和为水平地理系下对应的角速度，对应横滚轴；对应俯仰轴。
角速度在采样周期内积分，根据(4),结合初始条件可以得到水平地理坐标系下的俯仰角增量θ和横滚角增量γ分别为
式中T为解算周期。
步骤3，利用Kalman滤波器进行信息融合，以俯仰角误差φx＝xi-θ和横滚角误差φy＝yi-γ以及三个的漂移误差作为Kalman滤波器的状态方量的变量。
步骤3.1，建立系统状态方程，
取垂直陀螺仪系统的状态量X为：
X＝[φx φy εx εy εz]T
式中：φθ和φγ是俯仰角和横滚角的测量误差；εx、εy和εz为三轴陀螺仪的漂移误差,这三个误差可以事前通过静态测试得到，用一阶马尔科夫过程描述，则垂直陀螺仪的状态方程为：
式中：系统状态转移矩阵
系统噪声驱动矩阵：
系统激励噪声矩阵W＝[wx wy wz]T，
τx、τy、τz和wx、wy、wz分别为X、Y和Z周陀螺的一阶马尔科
夫时间和方差。
步骤3.2，建立系统量测方程，
以互补对称加速度传感器解算的角度xt、yt和捷联解算得到的角度θ、γ之差作为观测量：
所以量测方程为：Z＝HX+V
式中：量测矩阵V为加速度测量角度的方差。
通过以上的实施方式的描述，本领域的技术人员可以清楚地了解到本发明可借助三轴MEME技术的陀螺仪和四个MEMS技术的加速度传感器，在ARM或DSP硬件平台实现。
本发明的有益效果是：
(1)本发明的垂直陀螺仪，利用了对称互补的加速度原理，可以有效消除载体加速度信息对角度解算的影响。
(2)本发明利用三轴陀螺仪按捷联算法解算，可以与加速度解算出的角度信息形成互补滤波，防止角度解算出错，同时也系统的相应带宽。
(3)本发明以加速度传感器解算出的角度信息作为Kalman滤波器的观测量，设计Kalman滤波器，通过滤波后可以消除角度和陀螺仪的漂移误差。
(4)适用范围广泛，适用于无人机和稳定平台。
本发明利用低成本的MEMS技术的三轴陀螺仪和四轴的加速度，三轴陀螺仪按照载体的OXYZ轴安装，四个加速度计分别安装在OXZ两个和OYZ平面两个，两个加速度计对称安装，与各自的X轴和Y轴成统一的对称角度，这样就能够克服载体加速度和载体非直线运动时离心加速度信息对姿态角度信息解算带来的影响。同时提出了一种基于捷联解算角度信息与姿态角的信息融合方法。一方面，该算法能够克服姿态角度解算动态和静态测量精度不足问题；另一方面利用陀螺仪解算能够克服载体非直线运动离心加速度对姿态角解算精度的影响问题，最后该方法不需要任何外部信息，利用自身的姿态角度信息利用Kalman滤波器对陀螺的漂移误差进行修正，能够保证垂直陀螺仪的长时间精度。
Claims (4)
1.一种基于MEMS技术的捷联式垂直陀螺仪解算方法，基于如下定义的坐标系：垂直陀螺仪的导航坐标系取为地理坐标系，建立载体所在位置的地理坐标系为北-东-地，即N-E-D，固连在载体上的载体坐标系为X-Y-Z，X处于载体对称平面内，由质心指向载体运动前向；Y垂直于载体对称平面并指向右方；Z在载体对称平面内且垂直于X轴指向下方，其特征在于，具体按照以下步骤实施：
步骤1，互补对称加速度传感器的布局与各角度解算，
步骤2，进行捷联解算，在步骤1中解算出的俯仰角和横滚角基础上，把三轴陀螺仪测得载体的角速度信息按俯仰轴和横滚轴二次旋转，变换到水平地理坐标系，按捷联算法求出俯仰角和横滚角，
步骤3，利用Kalman滤波器进行信息融合。
2.根据权利要求1所述的基于MEMS技术的捷联式垂直陀螺仪解算方法，其特征在于，所述的步骤1具体为，
步骤1.1，互补对称加速度传感器的布局，将在载体的X-Z和Y-Z平面沿X轴和Y轴方向，且与X轴和Y轴的夹角分别为α角度分别布置2对加速度传感器，在X-Y-Z轴三个方向上，各布置一个陀螺仪；
步骤1.2，俯仰角度的解算，
设载体X轴方向加速度xa和俯仰角度xt时，从两个加速度传感器上采集到的加速度的输出值ax1和ax2分别为：
<mrow>
<mfenced open = "{" close = "">
<mtable>
<mtr>
<mtd>
<mrow>
<mi>a</mi>
<mi>x</mi>
<mn>1</mn>
<mo>=</mo>
<mi>s</mi>
<mi>i</mi>
<mi>n</mi>
<mrow>
<mo>(</mo>
<mi>&alpha;</mi>
<mo>+</mo>
<msub>
<mi>x</mi>
<mi>t</mi>
</msub>
<mo>)</mo>
</mrow>
<mo>+</mo>
<msub>
<mi>x</mi>
<mi>a</mi>
</msub>
<mi>c</mi>
<mi>o</mi>
<mi>s</mi>
<mrow>
<mo>(</mo>
<mi>&alpha;</mi>
<mo>+</mo>
<msub>
<mi>x</mi>
<mi>t</mi>
</msub>
<mo>)</mo>
</mrow>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<mi>a</mi>
<mi>x</mi>
<mn>2</mn>
<mo>=</mo>
<mi>s</mi>
<mi>i</mi>
<mi>n</mi>
<mrow>
<mo>(</mo>
<mo>-</mo>
<mi>&alpha;</mi>
<mo>+</mo>
<msub>
<mi>x</mi>
<mi>t</mi>
</msub>
<mo>)</mo>
</mrow>
<mo>+</mo>
<msub>
<mi>x</mi>
<mi>a</mi>
</msub>
<mi>c</mi>
<mi>o</mi>
<mi>s</mi>
<mrow>
<mo>(</mo>
<mo>-</mo>
<mi>&alpha;</mi>
<mo>+</mo>
<msub>
<mi>x</mi>
<mi>t</mi>
</msub>
<mo>)</mo>
</mrow>
</mrow>
</mtd>
</mtr>
</mtable>
</mfenced>
<mo>-</mo>
<mo>-</mo>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mn>1</mn>
<mo>)</mo>
</mrow>
</mrow>
经过推导，可以求得：
<mrow>
<msub>
<mi>x</mi>
<mi>t</mi>
</msub>
<mo>=</mo>
<mi>A</mi>
<mo>-</mo>
<mi>arcsin</mi>
<mrow>
<mo>(</mo>
<mfrac>
<mrow>
<mi>s</mi>
<mi>i</mi>
<mi>n</mi>
<mrow>
<mo>(</mo>
<mo>-</mo>
<mn>2</mn>
<mi>&alpha;</mi>
<mo>)</mo>
</mrow>
</mrow>
<mi>B</mi>
</mfrac>
<mo>)</mo>
</mrow>
<mo>-</mo>
<mi>&alpha;</mi>
<mo>-</mo>
<mo>-</mo>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mn>2</mn>
<mo>)</mo>
</mrow>
</mrow>
其中中间变量：
<mrow>
<mi>B</mi>
<mo>=</mo>
<msqrt>
<mrow>
<msup>
<mrow>
<mo>(</mo>
<mi>a</mi>
<mi>x</mi>
<mn>2</mn>
<mo>-</mo>
<mi>a</mi>
<mi>x</mi>
<mn>1</mn>
<mo>&times;</mo>
<mi>c</mi>
<mi>o</mi>
<mi>s</mi>
<mo>(</mo>
<mrow>
<mn>2</mn>
<mi>&alpha;</mi>
</mrow>
<mo>)</mo>
<mo>)</mo>
</mrow>
<mn>2</mn>
</msup>
<mo>+</mo>
<msup>
<mrow>
<mo>(</mo>
<mi>a</mi>
<mi>x</mi>
<mn>1</mn>
<mo>&times;</mo>
<mi>s</mi>
<mi>i</mi>
<mi>n</mi>
<mo>(</mo>
<mrow>
<mn>2</mn>
<mi>&alpha;</mi>
</mrow>
<mo>)</mo>
<mo>)</mo>
</mrow>
<mn>2</mn>
</msup>
</mrow>
</msqrt>
</mrow>
步骤1.3，横滚角的解算，
当载体Y轴方向有加速度ya和横滚角度yt时，利用同样的原理，借助公式(1)、(2)在求出横滚角度yt的基础之上除以cos(xt)即可。
3.根据权利要求1所述的基于MEMS技术的捷联式垂直陀螺仪解算方法，其特征在于，所述的步骤2具体为：
设载体坐标系下的俯仰角θ，横滚角γ，载体坐标系与地理坐标系经过两次旋转变换，变换阵为：
<mrow>
<msubsup>
<mi>c</mi>
<mi>b</mi>
<mn>2</mn>
</msubsup>
<mo>=</mo>
<mfenced open = "[" close = "]">
<mtable>
<mtr>
<mtd>
<mrow>
<mi>c</mi>
<mi>o</mi>
<mi>s</mi>
<mi>&gamma;</mi>
</mrow>
</mtd>
<mtd>
<mn>0</mn>
</mtd>
<mtd>
<mrow>
<mo>-</mo>
<mi>s</mi>
<mi>i</mi>
<mi>n</mi>
<mi>&gamma;</mi>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<mi>s</mi>
<mi>i</mi>
<mi>n</mi>
<mi>&theta;</mi>
<mi>sin</mi>
<mi>&gamma;</mi>
</mrow>
</mtd>
<mtd>
<mrow>
<mi>c</mi>
<mi>o</mi>
<mi>s</mi>
<mi>&theta;</mi>
</mrow>
</mtd>
<mtd>
<mrow>
<mi>s</mi>
<mi>i</mi>
<mi>n</mi>
<mi>&theta;</mi>
<mi>c</mi>
<mi>o</mi>
<mi>s</mi>
<mi>&gamma;</mi>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<mi>c</mi>
<mi>o</mi>
<mi>s</mi>
<mi>&theta;</mi>
<mi>sin</mi>
<mi>&gamma;</mi>
</mrow>
</mtd>
<mtd>
<mrow>
<mo>-</mo>
<mi>sin</mi>
<mi>&theta;</mi>
</mrow>
</mtd>
<mtd>
<mrow>
<mi>c</mi>
<mi>o</mi>
<mi>s</mi>
<mi>&theta;</mi>
<mi>c</mi>
<mi>o</mi>
<mi>s</mi>
<mi>&gamma;</mi>
</mrow>
</mtd>
</mtr>
</mtable>
</mfenced>
<mo>-</mo>
<mo>-</mo>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mn>3</mn>
<mo>)</mo>
</mrow>
</mrow>
载体坐标系上，按步骤1.1方法布置的三个陀螺的测量值分别为：ωx、ωy和ωz，把载体系测量得到的三维角速度转换到地理坐标系，得到：
<mrow>
<mfenced open = "[" close = "]">
<mtable>
<mtr>
<mtd>
<msubsup>
<mi>&omega;</mi>
<mi>x</mi>
<mi>n</mi>
</msubsup>
</mtd>
</mtr>
<mtr>
<mtd>
<msubsup>
<mi>&omega;</mi>
<mi>y</mi>
<mi>n</mi>
</msubsup>
</mtd>
</mtr>
<mtr>
<mtd>
<msubsup>
<mi>&omega;</mi>
<mi>z</mi>
<mi>n</mi>
</msubsup>
</mtd>
</mtr>
</mtable>
</mfenced>
<mo>=</mo>
<mfenced open = "[" close = "]">
<mtable>
<mtr>
<mtd>
<mrow>
<mi>c</mi>
<mi>o</mi>
<mi>s</mi>
<mi>&gamma;</mi>
</mrow>
</mtd>
<mtd>
<mn>0</mn>
</mtd>
<mtd>
<mrow>
<mo>-</mo>
<mi>sin</mi>
<mi>&gamma;</mi>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<mi>sin</mi>
<mi>&theta;</mi>
<mi>sin</mi>
<mi>&gamma;</mi>
</mrow>
</mtd>
<mtd>
<mrow>
<mi>c</mi>
<mi>o</mi>
<mi>s</mi>
<mi>&theta;</mi>
</mrow>
</mtd>
<mtd>
<mrow>
<mi>sin</mi>
<mi>&theta;</mi>
<mi>c</mi>
<mi>o</mi>
<mi>s</mi>
<mi>&gamma;</mi>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<mi>c</mi>
<mi>o</mi>
<mi>s</mi>
<mi>&theta;</mi>
<mi>sin</mi>
<mi>&gamma;</mi>
</mrow>
</mtd>
<mtd>
<mrow>
<mo>-</mo>
<mi>sin</mi>
<mi>&theta;</mi>
</mrow>
</mtd>
<mtd>
<mrow>
<mi>c</mi>
<mi>o</mi>
<mi>s</mi>
<mi>&theta;</mi>
<mi>c</mi>
<mi>o</mi>
<mi>s</mi>
<mi>&gamma;</mi>
</mrow>
</mtd>
</mtr>
</mtable>
</mfenced>
<mfenced open = "[" close = "]">
<mtable>
<mtr>
<mtd>
<msub>
<mi>&omega;</mi>
<mi>x</mi>
</msub>
</mtd>
</mtr>
<mtr>
<mtd>
<msub>
<mi>&omega;</mi>
<mi>y</mi>
</msub>
</mtd>
</mtr>
<mtr>
<mtd>
<msub>
<mi>&omega;</mi>
<mi>z</mi>
</msub>
</mtd>
</mtr>
</mtable>
</mfenced>
<mo>-</mo>
<mo>-</mo>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mn>4</mn>
<mo>)</mo>
</mrow>
</mrow>
式中和为水平地理系下对应的角速度，对应横滚轴；对应俯仰轴；
角速度在采样周期内积分，根据(4),结合初始条件可以得到水平地理坐标系下的俯仰角增量θ和横滚角增量γ分别为：
<mrow>
<mtable>
<mtr>
<mtd>
<mrow>
<mi>&theta;</mi>
<mo>=</mo>
<msubsup>
<mi>&omega;</mi>
<mi>y</mi>
<mi>n</mi>
</msubsup>
<mo>&times;</mo>
<mi>T</mi>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<mi>&gamma;</mi>
<mo>=</mo>
<msubsup>
<mi>&omega;</mi>
<mi>x</mi>
<mi>n</mi>
</msubsup>
<mo>&times;</mo>
<mi>T</mi>
</mrow>
</mtd>
</mtr>
</mtable>
<mo>-</mo>
<mo>-</mo>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mn>5</mn>
<mo>)</mo>
</mrow>
</mrow>
式中T为解算周期。
4.根据权利要求1所述的基于MEMS技术的捷联式垂直陀螺仪解算方法，其特征在于，所述的步骤3具体为，以俯仰角误差φx＝xi-θ和横滚角误差φy＝yi-γ以及三个的漂移误差作为Kalman滤波器的状态方量的变量；
步骤3.1，建立系统状态方程，
取垂直陀螺仪系统的状态量X为：
X＝[φx φy εx εy εz]T，
式中：φθ和φγ是俯仰角和横滚角的测量误差；εx、εy和εz为三轴陀螺仪的漂移误差，
这三个误差可以事前通过静态测试得到，用一阶马尔科夫过程描述，则垂直陀螺仪的状态方程为：
<mrow>
<mover>
<mi>X</mi>
<mo>&CenterDot;</mo>
</mover>
<mo>=</mo>
<mi>F</mi>
<mi>X</mi>
<mo>+</mo>
<mi>G</mi>
<mi>w</mi>
</mrow>
式中：系统状态转移矩阵
系统噪声驱动矩阵：
系统激励噪声矩阵W＝[wx wy wz]T，
τx、τy、τz和wx、wy、wz分别为X、Y和Z周陀螺的一阶马尔科夫时间和方差；
步骤3.2，建立系统量测方程，
以互补对称加速度传感器解算的角度xt、yt和捷联解算得到的角度θ、γ之差作为观测量：
所以量测方程为：Z＝HX+V
式中：量测矩阵V为加速度测量角度的方差。
Priority Applications (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| CN201710326078.6A CN107202578B (zh) | 2017-05-10 | 2017-05-10 | 一种基于mems技术的捷联式垂直陀螺仪解算方法 |
Applications Claiming Priority (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| CN201710326078.6A CN107202578B (zh) | 2017-05-10 | 2017-05-10 | 一种基于mems技术的捷联式垂直陀螺仪解算方法 |
Publications (2)
| Publication Number | Publication Date |
|---|---|
| CN107202578A true CN107202578A (zh) | 2017-09-26 |
| CN107202578B CN107202578B (zh) | 2020-11-24 |
Family
ID=59905077
Family Applications (1)
| Application Number | Title | Priority Date | Filing Date |
|---|---|---|---|
| CN201710326078.6A Active CN107202578B (zh) | 2017-05-10 | 2017-05-10 | 一种基于mems技术的捷联式垂直陀螺仪解算方法 |
Country Status (1)
| Country | Link |
|---|---|
| CN (1) | CN107202578B (zh) |
Cited By (6)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN109708661A (zh) * | 2018-11-13 | 2019-05-03 | 河北汉光重工有限责任公司 | 一种具有两轴框架的惯性稳定设备的视轴惯性稳定方法 |
| CN109883444A (zh) * | 2019-02-25 | 2019-06-14 | 航天科工防御技术研究试验中心 | 一种姿态角耦合误差补偿方法、装置及电子设备 |
| CN110645972A (zh) * | 2018-06-26 | 2020-01-03 | 北京金坤科创技术有限公司 | 一种基于mems的室内方向优化方法 |
| WO2021012635A1 (zh) * | 2019-07-23 | 2021-01-28 | 南京航空航天大学 | 一种基于陀螺仪信息的惯性导航方法 |
| CN113108790A (zh) * | 2021-05-14 | 2021-07-13 | 深圳中智永浩机器人有限公司 | 机器人imu角度测量方法、装置、计算机设备及存储介质 |
| CN114217628A (zh) * | 2021-12-24 | 2022-03-22 | 北京理工大学重庆创新中心 | 基于5g通讯的双路imu单元无人机控制器及控制方法 |
Citations (3)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| US6421622B1 (en) * | 1998-06-05 | 2002-07-16 | Crossbow Technology, Inc. | Dynamic attitude measurement sensor and method |
| CN101726295A (zh) * | 2008-10-24 | 2010-06-09 | 中国科学院自动化研究所 | 考虑加速度补偿和基于无迹卡尔曼滤波的惯性位姿跟踪方法 |
| CN105258698A (zh) * | 2015-10-13 | 2016-01-20 | 北京航天控制仪器研究所 | 一种高动态自旋制导炮弹空中组合导航方法 |
-
2017
- 2017-05-10 CN CN201710326078.6A patent/CN107202578B/zh active Active
Patent Citations (3)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| US6421622B1 (en) * | 1998-06-05 | 2002-07-16 | Crossbow Technology, Inc. | Dynamic attitude measurement sensor and method |
| CN101726295A (zh) * | 2008-10-24 | 2010-06-09 | 中国科学院自动化研究所 | 考虑加速度补偿和基于无迹卡尔曼滤波的惯性位姿跟踪方法 |
| CN105258698A (zh) * | 2015-10-13 | 2016-01-20 | 北京航天控制仪器研究所 | 一种高动态自旋制导炮弹空中组合导航方法 |
Non-Patent Citations (2)
| Title |
|---|
| 徐建: "基于DSP的惯性导航系统设计与实现", 《中国优秀硕士学位论文全文数据库 工程科技Ⅱ辑》 * |
| 曲国福: "基于MEMS技术的复合型智能传感器设计", 《传感器与微系统》 * |
Cited By (8)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN110645972A (zh) * | 2018-06-26 | 2020-01-03 | 北京金坤科创技术有限公司 | 一种基于mems的室内方向优化方法 |
| CN110645972B (zh) * | 2018-06-26 | 2021-08-24 | 北京金坤科创技术有限公司 | 一种基于mems的室内方向优化方法 |
| CN109708661A (zh) * | 2018-11-13 | 2019-05-03 | 河北汉光重工有限责任公司 | 一种具有两轴框架的惯性稳定设备的视轴惯性稳定方法 |
| CN109708661B (zh) * | 2018-11-13 | 2022-07-29 | 河北汉光重工有限责任公司 | 一种具有两轴框架的惯性稳定设备的视轴惯性稳定方法 |
| CN109883444A (zh) * | 2019-02-25 | 2019-06-14 | 航天科工防御技术研究试验中心 | 一种姿态角耦合误差补偿方法、装置及电子设备 |
| WO2021012635A1 (zh) * | 2019-07-23 | 2021-01-28 | 南京航空航天大学 | 一种基于陀螺仪信息的惯性导航方法 |
| CN113108790A (zh) * | 2021-05-14 | 2021-07-13 | 深圳中智永浩机器人有限公司 | 机器人imu角度测量方法、装置、计算机设备及存储介质 |
| CN114217628A (zh) * | 2021-12-24 | 2022-03-22 | 北京理工大学重庆创新中心 | 基于5g通讯的双路imu单元无人机控制器及控制方法 |
Also Published As
| Publication number | Publication date |
|---|---|
| CN107202578B (zh) | 2020-11-24 |
Similar Documents
| Publication | Publication Date | Title |
|---|---|---|
| CN107202578A (zh) | 一种基于mems技术的捷联式垂直陀螺仪解算方法 | |
| CN105180968B (zh) | 一种imu/磁强计安装失准角在线滤波标定方法 | |
| WO2017063388A1 (zh) | 一种惯导装置初始对准方法 | |
| CN111678538B (zh) | 一种基于速度匹配的动态水平仪误差补偿方法 | |
| CN102980577B (zh) | 一种微型捷联航姿系统及其工作方法 | |
| CN103900565B (zh) | 一种基于差分gps的惯导系统姿态获取方法 | |
| CN105973271B (zh) | 一种混合式惯导系统自标定方法 | |
| CN100541132C (zh) | 大失准角下船用光纤陀螺捷联航姿系统系泊精对准方法 | |
| CN106482746B (zh) | 一种用于混合式惯导系统的加速度计内杆臂标定与补偿方法 | |
| CN104165638B (zh) | 一种双轴旋转惯导系统多位置自主标定方法 | |
| CN108458714B (zh) | 一种姿态检测系统中不含重力加速度的欧拉角求解方法 | |
| CN104501838B (zh) | 捷联惯导系统初始对准方法 | |
| CN106153073B (zh) | 一种全姿态捷联惯导系统的非线性初始对准方法 | |
| CN112595350B (zh) | 一种惯导系统自动标定方法及终端 | |
| CN107677292B (zh) | 基于重力场模型的垂线偏差补偿方法 | |
| CN103900608A (zh) | 一种基于四元数ckf的低精度惯导初始对准方法 | |
| CN102706349A (zh) | 一种基于光纤捷联罗经技术的载体姿态确定方法 | |
| CN106123917B (zh) | 考虑外杆臂效应的捷联惯导系统罗经对准方法 | |
| CN106767925A (zh) | 带双轴转位机构的惯导系统三位置参数辨识对准方法 | |
| CN104848818A (zh) | Stewart平台姿态测量装置及测量方法 | |
| CN106979779A (zh) | 一种无人车实时姿态测量方法 | |
| CN104101345B (zh) | 基于互补重构技术的多传感器姿态融合方法 | |
| CN106679612B (zh) | 一种基于惯性测量匹配的非线性挠曲变形估计方法 | |
| WO2021253487A1 (zh) | 水下导航与重力测量一体化系统 | |
| CN110542430B (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 |