CN104316052A - 一种基于正交旋转的九陀螺mems惯性测量装置 - Google Patents
一种基于正交旋转的九陀螺mems惯性测量装置 Download PDFInfo
- Publication number
- CN104316052A CN104316052A CN201410619414.2A CN201410619414A CN104316052A CN 104316052 A CN104316052 A CN 104316052A CN 201410619414 A CN201410619414 A CN 201410619414A CN 104316052 A CN104316052 A CN 104316052A
- Authority
- CN
- China
- Prior art keywords
- gyro
- orthogonal
- angle
- group
- coordinate system
- 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
Landscapes
- Engineering & Computer Science (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Automation & Control Theory (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Gyroscopes (AREA)
Abstract
本发明属于惯性导航技术领域,特别涉及一种基于正交旋转的九陀螺MEMS惯性测量装置。基于正交旋转的九陀螺MEMS惯性测量装置,惯性测量装置包括三组陀螺,分别为第一正交陀螺组、第二正交陀螺组和第三正交陀螺组,其中第一正交陀螺组与装置的载体坐标系重合;三组陀螺之间的空间关系可由载体坐标系依次绕矢量S沿逆时针方向旋转得到。相比现有发明中设计的九陀螺十八面体配置方案,本发明一种基于正交旋转的九陀螺MEMS惯性测量装置,装置中任意三个陀螺均不共面,其可靠性相当于七套非冗余惯导系统,使系统可靠性进一步提升。
Description
技术领域
本发明属于惯性导航技术领域,特别涉及一种基于正交旋转的九陀螺MEMS惯性测量装置。
技术背景
由微机电系统(micro-electro mechanical systems,MEMS)的惯性器件组成的微型惯性测量单元具有自主性强、体积小、重量轻、成本低及抗冲击力强等优点,通过增加敏感元件的个数进行冗余配置,是目前提高系统可靠性和精度的最主流的方法。将敏感元件按照一定的组合方式进行安装,可以提高惯性测量单元各轴向的冗余度,而且可以利用重复的测量数据提高导航精度。中国航空工业集团公司王京献等人就九陀螺设计了一种十八面体配置方案,其可靠性相当于六套非冗余惯导系统,但由于惯性测量装置中的陀螺有三组共面现象,使得系统的可靠性并未达到最高(王京献,张明辉《一种高可靠捷联惯性测量单元布局》,中国惯性技术学报,2012年6月,第20卷,第3期)。本发明专利一种基于正交旋转的九陀螺MEMS惯性测量装置,装置中包括三组相互正交的陀螺,任意三个均不共面,使系统可靠性得到进一步提升。
发明内容
本发明的目的在于提出一种基于正交旋转的九陀螺MEMS惯性测量装置,该惯性测量装置由装置的载体坐标系沿逆时针方向两次旋转得到,提高了系统的可靠性和精度。
本发明的目的是这样实现的:
基于正交旋转的九陀螺MEMS惯性测量装置,惯性测量装置包括三组陀螺,分别为第一正交陀螺组、第二正交陀螺组和第三正交陀螺组,其中第一正交陀螺组与装置的载体坐标系重合;装置的载体坐标系原点为惯性测量装置的中心,oxb、oyb分别指向装置的横轴和纵轴,ozb与oxb、oyb构成右手直角坐标系,三组陀螺之间的空间关系可由载体坐标系依次绕矢量S沿逆时针方向旋转40°得到,矢量S与载体坐标系各轴的夹角相等,均为54.74°;所有陀螺都与载体坐标系的原点等距离安装,且任意两个相邻陀螺测量轴的夹角均为32.43°,任意两个间隔陀螺测量轴的夹角均为63.32°,任意两个相对陀螺测量轴的夹角均为107.05°;将惯性测量装置中的MEMS陀螺按照T型结构安装方法进行安装。
所述的第一正交陀螺组包括第一陀螺(1)、第四陀螺(4)、第七陀螺(7);第二正交陀螺组包括第二陀螺(2)、第五陀螺(5)、第八陀螺(8);第三正交陀螺组包括第三陀螺(3)、第六陀螺(6)、第九陀螺(9),所述的T型结构将装置中第一陀螺与第二陀螺、第二陀螺与第三陀螺的夹角均为32.43°,第一陀螺与第三陀螺的夹角为63.32°;第四陀螺与第五陀螺、第五陀螺与第六陀螺的夹角均为32.43°,第四陀螺与第六陀螺的夹角为63.32°;第七陀螺与第八陀螺、第八陀螺与第九陀螺的夹角均为32.43°,第七陀螺与第九陀螺的夹角为63.32°,将第一陀螺至第九陀螺按照正交方式进行组合安装,使其满足第一正交陀螺组、第二正交陀螺组、第三正交陀螺组三组相互正交。
本发明的有益效果在于:
(1)相比现有发明中设计的九陀螺十八面体配置方案,本发明专利一种基于正交旋转的九陀螺MEMS惯性测量装置,装置中任意三个陀螺均不共面,其可靠性相当于七套非冗余惯导系统,使系统可靠性进一步提升。
(2)本发明按照T型结构安装方法安装所有陀螺,这样的结构设计相比常规的单个安装更加方便、加工简单、易于工程化。
附图说明
图1为本发明的陀螺配置结构示意图。
图2为本发明的从点o向矢量S的俯视图。
图3为不同配置方案的可靠性曲线图。
图4为本发明的数据处理示意图。
具体实施方式
下面结合附图对本发明做进一步描述。
附图标记:1为1号陀螺,2为2号陀螺,3为3号陀螺,4为4号陀螺,5为5号陀螺,6为6号陀螺,7为7号陀螺,8为8号陀螺,9为9号陀螺。
惯性测量装置包括三组陀螺,分别为正交陀螺组(1、4、7)、正交陀螺组(2、5、8)和正交陀螺组(3、6、9),其中正交陀螺组(1、4、7)与装置的载体坐标系重合;装置的载体坐标系原点为惯性测量装置的中心,oxb、oyb分别指向装置的横轴和纵轴,ozb与oxb、oyb构成右手直角坐标系,三组陀螺之间的空间关系可由载体坐标系依次绕矢量S沿逆时针方向旋转40°得到,矢量S与载体坐标系各轴的夹角相等,均为54.74°。所有陀螺都与载体坐标系的原点等距离安装,且任意两个相邻陀螺测量轴的夹角均为32.43°,任意两个间隔陀螺测量轴的夹角均为63.32°,任意两个相对陀螺测量轴的夹角均为107.05°。
本发明的配置方案按照T型结构安装方法进行安装:将装置中所有陀螺按照(1、2、3)、(4、5、6)、(7、8、9)分成三组;其中陀螺1与陀螺2、陀螺2与陀螺3的夹角均为32.43°,陀螺1与陀螺3的夹角为63.32°;陀螺4与陀螺5、陀螺5与陀螺6的夹角均为32.43°,陀螺4与陀螺6的夹角为63.32°;陀螺7与陀螺8、陀螺8与陀螺9的夹角均为32.43°,陀螺7与陀螺9的夹角为63.32°,最后将三个陀螺组(1、2、3)、(4、5、6)、(7、8、9)按照正交方式进行组合安装,使其满足(1、4、7)、(2、5、8)和(3、6、9)三组相互正交。
为验证本发明专利的陀螺配置结构满足如下两种数学角度情况的最优,做如下证明:
1对于采用n个单自由度陀螺的捷联惯导系统,陀螺的量测方程可表示为:
m=HX+η (1)
式中,m为n×1维惯性测量矢量;H为n×3维配置矩阵;X为3×1维待求矢量;η为n×1维测量噪声矢量。设测量噪声η为零均值、方差为σ2的高斯白噪声,其统计特性为:
E(η)=0;E(ηηT)=σ2In (2)
根据线性最小方差理论,可以求出捷联惯导导航解算输入X的估计值:
同时,可得到相应的估计误差协方差矩阵为:
定义导航特性的最优准则为:
J=min{trace(C)} (5)
式中,trace(C)表示矩阵C的迹,即对角线元素之和。
下面证明上式定义的导航性能最优准则等价于
1)首先证明将配置矩阵H奇异值分解:
其中, diag()表示对角矩阵,()中的元素为对角线上的元素。
则:
2)再证明式(5)与式(7)等价,设λ1、λ2、λ3分别为HTH的特征值。
充分性:假设则:
必要性:假设配置矩阵H为最优矩阵,即C的迹取最小值,由充分性的证明可知, 取等号成立,而 且trace(HTH)=λ1+λ+2λ,即等号成立时,λ1=λ2=λ3=n/3。
2从噪声角度分析最优配置矩阵,设噪声η为零均值高斯白噪声,相应的概率密度函数为:
其中,G=(HTH)-1,η的轨迹满足:
ηTG-1η=K (9)
K为放大因子。
式(9)表示一个椭球族,给定一个K值,即可得到一个固定的椭球,相应的椭球体积可表示为:
由此可知:体积V越小,则噪声η产生的误差就越小,从而系统的导航特性就越好,定义最优准则为:
F取值越小,噪声η产生误差的椭球体积就越小,从而判断选择的配置矩阵为最优。
当陀螺个数为9时,根据导航特性最优的充要条件可知:
由图1可知
由式(12)和(13)可得:α=32.43°,β=63.32°,θ=107.05°。
则一种基于正交旋转的九陀螺MEMS惯性测量装置的最优配置矩阵为:
则式(14)为本发明专利在满足式(12)情况下的最优配置矩阵。
为了对比现有方案相比九陀螺四轴配置方案(李雪莲,孙尧,莫宏伟,姚成凯《一种基于MEMS的九陀螺冗余配置》,哈尔滨工业大学学报,2009年5月,第41卷,第5期)和九陀螺十八面体配置方案的优势,将三种不同的配置方案进行可靠性比较。
所述九陀螺四轴配置方案的配置矩阵为:
所述九陀螺十八面体配置方案的配置矩阵为:
假设单个陀螺的平均无故障时间为20000小时,则保证一个惯导系统正常工作一年,不同的配置方案对应的可靠性曲线如图3所示。
由图3可知,本发明和九陀螺十八面体方案相对九陀螺四轴方案的可靠性提升更高,本发明和九陀螺十八面体方案的可靠性一直高于0.95;且本发明所提出的基于正交旋转的九陀螺MEMS惯性测量装置的可靠性仍比九陀螺十八面方案高。
Claims (2)
1.一种基于正交旋转的九陀螺MEMS惯性测量装置,其特征在于:惯性测量装置包括三组陀螺,分别为第一正交陀螺组、第二正交陀螺组和第三正交陀螺组,其中第一正交陀螺组与装置的载体坐标系重合;装置的载体坐标系原点为惯性测量装置的中心,oxb、oyb分别指向装置的横轴和纵轴,ozb与oxb、oyb构成右手直角坐标系,三组陀螺之间的空间关系可由载体坐标系依次绕矢量S沿逆时针方向旋转40°得到,矢量S与载体坐标系各轴的夹角相等,均为54.74°;所有陀螺都与载体坐标系的原点等距离安装,且任意两个相邻陀螺测量轴的夹角均为32.43°,任意两个间隔陀螺测量轴的夹角均为63.32°,任意两个相对陀螺测量轴的夹角均为107.05°;将惯性测量装置中的MEMS陀螺按照T型结构安装方法进行安装。
2.根据权利要求1所述的一种基于正交旋转的九陀螺MEMS惯性测量装置,其特征在于:所述的第一正交陀螺组包括第一陀螺(1)、第四陀螺(4)、第七陀螺(7);第二正交陀螺组包括第二陀螺(2)、第五陀螺(5)、第八陀螺(8);第三正交陀螺组包括第三陀螺(3)、第六陀螺(6)、第九陀螺(9),所述的T型结构将装置中第一陀螺与第二陀螺、第二陀螺与第三陀螺的夹角均为32.43°,第一陀螺与第三陀螺的夹角为63.32°;第四陀螺与第五陀螺、第五陀螺与第六陀螺的夹角均为32.43°,第四陀螺与第六陀螺的夹角为63.32°;第七陀螺与第八陀螺、第八陀螺与第九陀螺的夹角均为32.43°,第七陀螺与第九陀螺的夹角为63.32°,将第一陀螺至第九陀螺按照正交方式进行组合安装,使其满足第一正交陀螺组、第二正交陀螺组、第三正交陀螺组三组相互正交。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201410619414.2A CN104316052B (zh) | 2014-11-05 | 2014-11-05 | 一种基于正交旋转的九陀螺mems惯性测量装置 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201410619414.2A CN104316052B (zh) | 2014-11-05 | 2014-11-05 | 一种基于正交旋转的九陀螺mems惯性测量装置 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN104316052A true CN104316052A (zh) | 2015-01-28 |
CN104316052B CN104316052B (zh) | 2017-06-20 |
Family
ID=52371316
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201410619414.2A Active CN104316052B (zh) | 2014-11-05 | 2014-11-05 | 一种基于正交旋转的九陀螺mems惯性测量装置 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN104316052B (zh) |
Cited By (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN105277213A (zh) * | 2015-10-13 | 2016-01-27 | 哈尔滨工程大学 | 一种基于冗余配置的捷联惯导系统单轴旋转调制方法 |
CN106767805A (zh) * | 2017-01-08 | 2017-05-31 | 上海拓攻机器人有限公司 | 基于mems传感器阵列的高精度惯性量测量方法及测量系统 |
CN109813309A (zh) * | 2019-03-08 | 2019-05-28 | 哈尔滨工程大学 | 一种六陀螺冗余式捷联惯导系统双故障隔离方法 |
Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US5194872A (en) * | 1990-11-14 | 1993-03-16 | Charles Stark Draper Laboratory, Inc. | Inertial navigation system with automatic redundancy and dynamic compensation of gyroscope drift error |
CN102116629A (zh) * | 2009-12-30 | 2011-07-06 | 中国民航大学 | 一种基于正四面体的六微机械电子陀螺配置方法 |
CN102435190A (zh) * | 2011-09-14 | 2012-05-02 | 中国航空工业第六一八研究所 | 余度传感器惯性测量装置 |
CN103389088A (zh) * | 2013-07-24 | 2013-11-13 | 北京航空航天大学 | 一种四冗余rfins最优配置方案的确定方法 |
-
2014
- 2014-11-05 CN CN201410619414.2A patent/CN104316052B/zh active Active
Patent Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US5194872A (en) * | 1990-11-14 | 1993-03-16 | Charles Stark Draper Laboratory, Inc. | Inertial navigation system with automatic redundancy and dynamic compensation of gyroscope drift error |
CN102116629A (zh) * | 2009-12-30 | 2011-07-06 | 中国民航大学 | 一种基于正四面体的六微机械电子陀螺配置方法 |
CN102435190A (zh) * | 2011-09-14 | 2012-05-02 | 中国航空工业第六一八研究所 | 余度传感器惯性测量装置 |
CN103389088A (zh) * | 2013-07-24 | 2013-11-13 | 北京航空航天大学 | 一种四冗余rfins最优配置方案的确定方法 |
Non-Patent Citations (4)
Title |
---|
李雪莲 等: "一种基于MIMU的九陀螺冗余配置", 《哈尔滨工业大学学报》 * |
梁海波: "基于陀螺冗余的微惯性系统关键技术研究", 《中国博士学位论文全文数据库 工程科技Ⅱ辑》 * |
王京献 等: "一种高可靠捷联惯性测量单元布局", 《中国惯性技术学报》 * |
黄静雯 等: "五冗余捷联惯组系统配置及优化", 《指挥控制与仿真》 * |
Cited By (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN105277213A (zh) * | 2015-10-13 | 2016-01-27 | 哈尔滨工程大学 | 一种基于冗余配置的捷联惯导系统单轴旋转调制方法 |
CN105277213B (zh) * | 2015-10-13 | 2018-01-19 | 哈尔滨工程大学 | 一种基于冗余配置的捷联惯导系统单轴旋转调制方法 |
CN106767805A (zh) * | 2017-01-08 | 2017-05-31 | 上海拓攻机器人有限公司 | 基于mems传感器阵列的高精度惯性量测量方法及测量系统 |
CN106767805B (zh) * | 2017-01-08 | 2023-08-18 | 上海拓攻机器人有限公司 | 基于mems传感器阵列的高精度惯性量测量方法及测量系统 |
CN109813309A (zh) * | 2019-03-08 | 2019-05-28 | 哈尔滨工程大学 | 一种六陀螺冗余式捷联惯导系统双故障隔离方法 |
Also Published As
Publication number | Publication date |
---|---|
CN104316052B (zh) | 2017-06-20 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN103389088B (zh) | 一种四冗余rfins最优配置方案的确定方法 | |
CN100585602C (zh) | 惯性测量系统误差模型验证试验方法 | |
CN103575299B (zh) | 利用外观测信息的双轴旋转惯导系统对准及误差修正方法 | |
CN102735231B (zh) | 一种提高光纤陀螺寻北仪精度的方法 | |
Kim et al. | High-speed train navigation system based on multi-sensor data fusion and map matching algorithm | |
CN103196445B (zh) | 基于匹配技术的地磁辅助惯性的载体姿态测量方法 | |
CN1932444B (zh) | 适用于高速旋转体的姿态测量方法 | |
CN103697894B (zh) | 基于滤波器方差阵修正的多源信息非等间隔联邦滤波方法 | |
CN106949889A (zh) | 针对行人导航的低成本mems/gps组合导航系统及方法 | |
CN110196049A (zh) | 一种动态环境下四陀螺冗余式捷联惯导系统硬故障检测与隔离方法 | |
CN110243377B (zh) | 一种基于分层式结构的集群飞行器协同导航方法 | |
Xu et al. | A reliable hybrid positioning methodology for land vehicles using low-cost sensors | |
CN102853837B (zh) | 一种mimu和gnss信息融合的方法 | |
CN104374388A (zh) | 一种基于偏振光传感器的航姿测定方法 | |
CN103822633A (zh) | 一种基于二阶量测更新的低成本姿态估计方法 | |
CN103471613A (zh) | 一种飞行器惯性导航系统参数仿真方法 | |
CN102520728B (zh) | 一种采用双天线gps实现可控翼伞精确定点回收的方法 | |
CN108983270A (zh) | 一种基于多传感器融合的列车安全定位系统及方法 | |
CN101713654A (zh) | 跨音速飞行阶段大气攻角与惯性攻角的融合方法 | |
CN102519485A (zh) | 一种引入陀螺信息的二位置捷联惯性导航系统初始对准方法 | |
CN106979781A (zh) | 基于分布式惯性网络的高精度传递对准方法 | |
CN108592946A (zh) | 一种基于两套旋转惯导冗余配置下的惯性器件漂移在线监控方法 | |
CN104316052A (zh) | 一种基于正交旋转的九陀螺mems惯性测量装置 | |
CN103453907A (zh) | 基于分层大气模型的行星进入段导航滤波方法 | |
CN103900566A (zh) | 一种消除地球自转角速度对旋转调制型捷联惯导系统精度影响的方法 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
C06 | Publication | ||
PB01 | Publication | ||
C10 | Entry into substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
GR01 | Patent grant | ||
GR01 | Patent grant |