CN107202578B - 一种基于mems技术的捷联式垂直陀螺仪解算方法 - Google Patents
一种基于mems技术的捷联式垂直陀螺仪解算方法 Download PDFInfo
- Publication number
- CN107202578B CN107202578B CN201710326078.6A CN201710326078A CN107202578B CN 107202578 B CN107202578 B CN 107202578B CN 201710326078 A CN201710326078 A CN 201710326078A CN 107202578 B CN107202578 B CN 107202578B
- Authority
- CN
- China
- Prior art keywords
- carrier
- axis
- coordinate system
- angle
- gyroscope
- 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
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/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=xt-θ和横滚角误差φy=yt-γ以及三个漂移误差作为Kalman滤波器的状态变量;
步骤3.1,建立***状态方程,
取垂直陀螺仪***的状态量X为:
X=[φx φy εx εy εz]T,
式中:φx是俯仰角测量误差,φy是横滚角的测量误差;εx、εy和εz为三轴陀螺仪的漂移误差,
这三个误差事前通过静态测试得到,用一阶马尔科夫过程描述,则垂直陀螺仪的状态方程为:
***激励噪声矩阵W=[wx wy wz]T,
τx、τy、τz和wx、wy、wz分别为X、Y和Z轴陀螺的一阶马尔科夫时间和方差。
步骤3.2,建立***量测方程,
所以量测方程为:Z=HX+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=xt-θ和横滚角误差φy=yt-γ以及三个漂移误差作为Kalman滤波器的状态变量。
步骤3.1,建立***状态方程,
取垂直陀螺仪***的状态量X为:
X=[φx φy εx εy εz]T
式中:φx是俯仰角测量误差,φy是横滚角的测量误差;εx、εy和εz为三轴陀螺仪的漂移误差,这三个误差事前通过静态测试得到,用一阶马尔科夫过程描述,则垂直陀螺仪的状态方程为:
***激励噪声矩阵W=[wx wy wz]T,
τx、τy、τz和wx、wy、wz分别为X、Y和Z轴陀螺的一阶马尔科夫时间和方差。
步骤3.2,建立***量测方程,
所以量测方程为:Z=HX+V
通过以上的实施方式的描述,本领域的技术人员可以清楚地了解到本发明可借助三轴MEME技术的陀螺仪和四个MEMS技术的加速度传感器,在ARM或DSP硬件平台实现。
本发明的有益效果是:
(1)本发明的垂直陀螺仪,利用了对称互补的加速度原理,可以有效消除载体加速度信息对角度解算的影响。
(2)本发明利用三轴陀螺仪按捷联算法解算,可以与加速度解算出的角度信息形成互补滤波,防止角度解算出错,同时也***的相应带宽。
(3)本发明以加速度传感器解算出的角度信息作为Kalman滤波器的观测量,设计Kalman滤波器,通过滤波后可以消除角度和陀螺仪的漂移误差。
(4)适用范围广泛,适用于无人机和稳定平台。
本发明利用低成本的MEMS技术的三轴陀螺仪和四轴的加速度,三轴陀螺仪按照载体的OXYZ轴安装,四个加速度计分别安装在OXZ两个和OYZ平面两个,两个加速度计对称安装,与各自的X轴和Y轴成统一的对称角度,这样就能够克服载体加速度和载体非直线运动时离心加速度信息对姿态角度信息解算带来的影响。同时提出了一种基于捷联解算角度信息与姿态角的信息融合方法。一方面,该算法能够克服姿态角度解算动态和静态测量精度不足问题;另一方面利用陀螺仪解算能够克服载体非直线运动离心加速度对姿态角解算精度的影响问题,最后该方法不需要任何外部信息,利用自身的姿态角度信息利用Kalman滤波器对陀螺的漂移误差进行修正,能够保证垂直陀螺仪的长时间精度。
Claims (3)
1.一种基于MEMS技术的捷联式垂直陀螺仪解算方法,基于如下定义的坐标系:垂直陀螺仪的导航坐标系取为地理坐标系,建立载体所在位置的地理坐标系为北-东-地,即N-E-D,固连在载体上的载体坐标系为X-Y-Z,X处于载体对称平面内,由质心指向载体运动前向;Y垂直于载体对称平面并指向右方;Z在载体对称平面内且垂直于X轴指向下方,其特征在于,具体按照以下步骤实施:
步骤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中解算出的俯仰角和横滚角基础上,把三轴陀螺仪测得载体的角速度信息按俯仰轴和横滚轴二次旋转,变换到水平地理坐标系,按捷联算法求出俯仰角和横滚角,
步骤3,利用Kalman滤波器进行信息融合。
3.根据权利要求1所述的基于MEMS技术的捷联式垂直陀螺仪解算方法,其特征在于,所述的步骤3具体为,以俯仰角误差φx=xt-θ和横滚角误差φy=yt-γ以及三个漂移误差作为Kalman滤波器的状态变量;
步骤3.1,建立***状态方程,
取垂直陀螺仪***的状态量X为:
X=[φx φy εx εy εz]T,
式中:φx是俯仰角误差,φy是横滚角误差;εx、εy和εz为三轴陀螺仪的漂移误差,
这三个误差事前通过静态测试得到,用一阶马尔科夫过程描述,则垂直陀螺仪的状态方程为:
***激励噪声矩阵W=[wx wy wz]T,
τx、τy、τz和wx、wy、wz分别为X、Y和Z轴陀螺的一阶马尔科夫时间和方差;
步骤3.2,建立***量测方程,
所以量测方程为:Z=HX+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 CN107202578A (zh) | 2017-09-26 |
CN107202578B true 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) |
Families Citing this family (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN110645972B (zh) * | 2018-06-26 | 2021-08-24 | 北京金坤科创技术有限公司 | 一种基于mems的室内方向优化方法 |
CN109708661B (zh) * | 2018-11-13 | 2022-07-29 | 河北汉光重工有限责任公司 | 一种具有两轴框架的惯性稳定设备的视轴惯性稳定方法 |
CN109883444B (zh) * | 2019-02-25 | 2022-03-25 | 航天科工防御技术研究试验中心 | 一种姿态角耦合误差补偿方法、装置及电子设备 |
CN112304310A (zh) * | 2019-07-23 | 2021-02-02 | 南京航空航天大学 | 一种基于陀螺仪信息的惯性导航方法 |
CN113108790B (zh) * | 2021-05-14 | 2024-06-25 | 深圳中智永浩机器人有限公司 | 机器人imu角度测量方法、装置、计算机设备及存储介质 |
CN114217628A (zh) * | 2021-12-24 | 2022-03-22 | 北京理工大学重庆创新中心 | 基于5g通讯的双路imu单元无人机控制器及控制方法 |
Family Cites Families (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 |
CN101726295B (zh) * | 2008-10-24 | 2011-09-07 | 中国科学院自动化研究所 | 考虑加速度补偿和基于无迹卡尔曼滤波的惯性位姿跟踪方法 |
CN105258698B (zh) * | 2015-10-13 | 2017-12-19 | 北京航天控制仪器研究所 | 一种高动态自旋制导炮弹空中组合导航方法 |
-
2017
- 2017-05-10 CN CN201710326078.6A patent/CN107202578B/zh active Active
Also Published As
Publication number | Publication date |
---|---|
CN107202578A (zh) | 2017-09-26 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN107202578B (zh) | 一种基于mems技术的捷联式垂直陀螺仪解算方法 | |
CN111678538B (zh) | 一种基于速度匹配的动态水平仪误差补偿方法 | |
CN109269471B (zh) | 一种新型gnss接收机倾斜测量***及方法 | |
EP2557394B1 (en) | System for processing pulse signals within an inertial navigation system | |
CN106289246B (zh) | 一种基于位置和姿态测量***的柔性杆臂测量方法 | |
CN109470273B (zh) | 捷联惯性导航***惯性元件拆装免标定方法 | |
CN106969783B (zh) | 一种基于光纤陀螺惯性导航的单轴旋转快速标定技术 | |
CN112595350B (zh) | 一种惯导***自动标定方法及终端 | |
CN107228665B (zh) | 一种混合式惯性平台*** | |
CN110887507B (zh) | 一种快速估计惯性测量单元全部零偏的方法 | |
CN101701824A (zh) | 基于激光陀螺的高精度单轴旋转姿态测量*** | |
CN104697521A (zh) | 一种采用陀螺冗余斜交配置方式测量高速旋转体姿态和角速度的方法 | |
CN102788597A (zh) | 基于空间稳定的旋转捷联惯导***误差抑制方法 | |
CN114877915A (zh) | 一种激光陀螺惯性测量组件g敏感性误差标定装置及方法 | |
CN109084755B (zh) | 一种基于重力视速度与参数辨识的加速度计零偏估计方法 | |
CN112697143B (zh) | 高精度载体动态姿态测量方法及*** | |
CN102748010A (zh) | 姿态测量***和方法以及油井井眼轨迹测量***和方法 | |
CN104567888A (zh) | 基于速度在线修正的惯性导航车辆姿态测量方法 | |
CN111141285B (zh) | 一种航空重力测量装置 | |
CN110940357B (zh) | 一种用于旋转惯导单轴自对准的内杆臂标定方法 | |
CN102183263A (zh) | 一种光纤陀螺常值漂移的标定方法 | |
Lu et al. | Calibration, alignment, and dynamic tilt maintenance method based on vehicular hybrid measurement unit | |
CN114264304B (zh) | 复杂动态环境高精度水平姿态测量方法与*** | |
CN102589568B (zh) | 车辆捷联惯性导航***的三轴陀螺常值漂移快速测量方法 | |
CN114137592A (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 |