CN101949699A - 数字式自适应万向组合陀螺仪 - Google Patents
数字式自适应万向组合陀螺仪 Download PDFInfo
- Publication number
- CN101949699A CN101949699A CN2010102565408A CN201010256540A CN101949699A CN 101949699 A CN101949699 A CN 101949699A CN 2010102565408 A CN2010102565408 A CN 2010102565408A CN 201010256540 A CN201010256540 A CN 201010256540A CN 101949699 A CN101949699 A CN 101949699A
- Authority
- CN
- China
- Prior art keywords
- gyroscope
- digital self
- data
- adoptive
- self
- 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
Images
Landscapes
- Navigation (AREA)
Abstract
本发明公开一种数字式自适应万向组合陀螺仪,其优选卫星处理器输入/输出端口与对应的数字化自适应陀螺仪的输入/输出端口连接;数字化自适应陀螺仪数据输出端口与优选数字化自适应陀螺仪的输入端口连接;优选数字化自适应陀螺仪处理器的数据输出端口与数据融合及卡尔曼滤波器数据输入端口连接;数据融合及卡尔曼滤波器的数据输出端口与输出数据控制器的数据输入端口连接;惯性陀螺仪的数据输入/输出端口与数据融合及卡尔曼滤波器的输入/输出端口连接;惯性陀螺仪的数据输出端口与输出数据控制器的接收惯性陀螺仪数据输入端口连接。本发明将数字化自适应陀螺仪和惯性陀螺仪组合成为数字式自适应万向组合陀螺仪,充分发挥各自的优点,缺点互补。
Description
技术领域
本发明涉及的一种自适应陀螺仪,尤其涉及一种数字式自适应万向组合陀螺仪。
背景技术
传统的惯性陀螺仪包括机电惯性陀螺仪和光纤(激光)陀螺仪,是依据高速转动质量体的角动量守恒原理,当转速足够大时高速转动质量体保持恒定方向制成的,其具有自主工作能力较强,不受环境影响的特点,但其存在零点漂移较大,姿态角误差较大,对水平坐标系不能自适应等缺点。专利号为200610096130.5的中国专利公开了一种数字化自适应陀螺仪,这种数字化自适应陀螺仪的工作原理是利用至少三个小天线和多通道接收机接收至少四颗全球导航定位卫星的信号及数据,利用每颗导航卫星到达三个小天线和多通道接收机之间的相位差和三个小天线的相对坐标便可计算出三个小天线的相对坐标系(陀螺仪)的航向角、俯仰角和横滚角。全球导航定位卫星包括北斗、Galileo、GPS、GLONASS等任何现代全球导航定位卫星系统。这种数字化自适应陀螺仪解决了零点漂移的问题,姿态角度精度高,对水平坐标系和其他坐标系有自适应能力。但是在障碍物遮挡住全球导航定位卫星(以下简称导航卫星)时,这种数字化自适应陀螺仪不能正常工作,比如山地或建筑物的遮挡,或在移动载体转弯或翻滚运动时会对导航卫星的遮挡。
发明内容
发明目的:本发明的目的是针对现有技术的不足,提供一种既能克服零点漂移的问题且姿态角度精度高,又能抗遮挡的数字式自适应万向组合陀螺仪。
技术方案:为实现上述目的,本发明所述的数字式自适应万向组合陀螺仪,其特征在于它包括1~3个数字化自适应陀螺仪、1~3个优选卫星处理器、优选数字化自适应陀螺仪处理器、数据融合及卡尔曼滤波器、惯性陀螺仪和输出数据控制器,所述优选卫星处理器输入/输出端口与对应的数字化自适应陀螺仪的优选卫星处理器输入/输出端口连接;所述数字化自适应陀螺仪数据输出端口与所述优选数字化自适应陀螺仪处理器数据输入端口连接;所述优选数字化自适应陀螺仪处理器的数据输出端口与所述数据融合及卡尔曼滤波器数据输入端口连接;所述数据融合及卡尔曼滤波器的数据输出端口与所述输出数据控制器的数据输入端口连接;所述惯性陀螺仪的数据输入/输出端口与所述数据融合及卡尔曼滤波器的输入/输出端口连接;所述惯性陀螺仪的数据输出端口与所述输出数据控制器的接收惯性陀螺仪数据输入端口连接。1~3个数字化自适应陀螺仪可克服移动载体遮挡导航卫星的问题,而惯性陀螺仪可克服障碍物(山地或建筑物)遮挡导航卫星的问题,两者结合,优势互补。在无障碍物(山地或建筑物)遮挡导航卫星时优选数字化自适应陀螺仪的数据输出;在有障碍物(山地或建筑物)遮挡导航卫星时优选惯性陀螺仪的数据输出。
每个数字化自适应陀螺仪上包括由三个天线组成的天线组、三个导航卫星多通道接收机和定位及姿态角处理器。用6个(或9个)天线、6个(或9个)多通道接收机同时接收三颗全球导航定位卫星信号(其中一个天线及多通道接收机能接收第4颗全球导航定位卫星信号,用于定位)进行互相之间相位差测量,经处理和变换得到姿态角(航向角、俯仰角和横滚角)数据。
所述数字化自适应陀螺仪和优选卫星处理器可以为分体设置,也可以根据需要,将所述优选卫星处理器内置于数字化自适应陀螺仪中,使两者成一体设置。
使用时,用全球导航定位卫星信号测定姿态角技术对数字化自适应陀螺仪的天线进行互相之间相位差测量,并利用各天线位置的坐标,经处理和变换得到姿态角(航向角、俯仰角和横滚角)数据。为保证姿态角精度,采用高精度相位差测量方法进行测量。当相位差大于多个2π出现不定值时,采用相位差测量消除模糊技术解决。
在不存障碍物(山地或建筑物)遮挡导航卫星的情况(如平原、海上、空中和外空)和不出现移动载体遮挡导航卫星的情况,数字化自适应陀螺仪单独使用为最好的技术方案。数字式自适应万向组合陀螺仪有三种具有抗遮挡能力的技术方案:(1)移动载体短时间处于障碍物(山地或建筑物)遮挡导航卫星的情况和不出现移动载体遮挡导航卫星的情况,数字式自适应万向组合陀螺仪中的数字化自适应陀螺仪采用1个,对应的优选卫星处理器也采用1个,无障碍物(山地或建筑物)遮挡时,数字化自适应陀螺仪实时校准惯性陀螺仪数据,短时间处于障碍物(山地或建筑物)遮挡导航卫星时,惯性陀螺仪输出移动载体姿态数据,姿态数据精度优于单独使用惯性陀螺仪的姿态数据精度;(2)移动载体有转弯运动,且保持上下姿态情况下(无翻滚)和短时间处于障碍物(山地或建筑物)遮挡导航卫星情况,数字式自适应万向组合陀螺仪中的数字化自适应陀螺仪采用2个,对应的优选卫星处理器也采用2个,2个数字化自适应陀螺仪上的2个天线组分别置于移动载体的两侧,2个天线组之间成110~130°夹角,可克服移动载体有转弯运动时移动载体遮挡导航卫星和短时间处于障碍物(山地或建筑物)遮挡导航卫星的问题;(3)移动载体有转弯和翻滚运动情况下,数字式自适应万向组合陀螺仪中的数字化自适应陀螺仪采用3个,对应的优选卫星处理器也采用3个,3个数字化自适应陀螺仪上的3个天线组分别置于移动载体的上面和两侧下部,3个天线组之间成110~130°夹角,可克服移动载体有转弯及翻滚运动时移动载体遮挡导航卫星和短时间处于障碍物(山地或建筑物)遮挡导航卫星的问题。
有益效果:本发明与现有技术相比,其有益效果为:1、本发明将数字化自适应陀螺仪和惯性陀螺仪组合成为数字式自适应万向组合陀螺仪,充分发挥各自的优点,缺点互补,具有给出姿态角(航向角、俯仰角和横滚角)精度较高、不受载体转弯和翻滚的遮挡导航卫星影响、无零点漂移、自适应水平坐标系或其他一些坐标系、在导航卫星受障碍物(山地高山或建筑物)遮挡时使用惯性陀螺仪的姿态角精度比单用惯性陀螺仪高的姿态角精度高的优点;2、本发明装置中的数字化自适应陀螺仪在不遮挡导航卫星时不断校准惯性陀螺仪的输出数据,消除零点漂移误差,当障碍物(山地或建筑物)遮挡导航卫星时使用惯性陀螺仪的输出数据,优于单独使用惯性陀螺仪的姿态角测量精度;3、本发明数字式自适应万向组合陀螺仪可广泛应用于弹道飞行器(含母舱)发射和机动高精度控制,轨道飞行器发射、运行、机动、变轨高精度控制,高超声速飞行器纵深大机动的高精度控制,空气动力飞行器和未来无人飞机的长航时飞行高精度控制,地面车辆和海面船只的长时间运行和航行的高精度控制等领域,而不降低姿态角(航向角、俯仰角和横滚角)测量精度。
附图说明
图1为本发明数字式自适应万向组合陀螺仪的组成结构示意图。
具体实施方式
下面结合附图,对最佳实施例进行详细说明,但是本发明的保护范围不局限于所述实施例。
如图1所示,一种数字式自适应万向组合陀螺仪由1~3个数字化自适应陀螺仪1、1~3个优选卫星处理器2(将优选卫星处理器和数字化自适应陀螺仪做为一体或将优选卫星处理器2内置于数字化自适应陀螺仪1中)、优选数字化自适应陀螺仪处理器3、数据融合及卡尔曼滤波器4、惯性陀螺仪5和输出数据控制器6等组成,所述优选卫星处理器2输入/输出端口与对应的数字化自适应陀螺仪1的优选卫星处理器输入/输出端口连接;所述数字化自适应陀螺仪1数据输出端口与所述优选数字化自适应陀螺仪处理器3数据输入端口连接;所述优选数字化自适应陀螺仪处理器3的数据输出端口与所述数据融合及卡尔曼滤波器4数据输入端口连接;所述数据融合及卡尔曼滤波器4的数据输出端口与所述输出数据控制器6的数据输入端口连接;所述惯性陀螺仪5的数据输入/输出端口与所述数据融合及卡尔曼滤波器4的输入/输出端口连接;所述惯性陀螺仪5的数据输出端口与所述输出数据控制器6的接收惯性陀螺仪数据输入端口连接。
下面分别对采用1至3个数字化自适应陀螺仪的数字式自适应万向组合陀螺仪进行说明:
1型数字式自适应万向组合陀螺仪:用于移动载体短时间处于障碍物(山地或建筑物)遮挡导航卫星的情况和不出现移动载体遮挡导航卫星的情况。1型数字式自适应万向组合陀螺仪由一个数字化自适应陀螺仪1、一个优选卫星处理器2、一个惯性陀螺仪5、数据融合及卡尔曼滤波器4和输出数据控制器6等组成。数字化自适应陀螺仪1的三个小天线架设在移动载体上不遮挡导航卫星的位置。优选卫星处理器2的作用是在三个小天线共同接收到的导航卫星中优选出姿态角测量精度较高的暂时不进入地平线以下的和信杂比较高的几组导航卫星(每组3颗导航卫星)排队使用。数据融合及卡尔曼滤波器4的作用是几组导航卫星计算的姿态角数据进行数据融合及卡尔曼滤波,以提高姿态角数据的精度。输出数据控制器6的作用是在无障碍物(山地或建筑物)遮挡导航卫星时优选数字化自适应陀螺仪1的数据输出;在有障碍物(山地或建筑物)遮挡导航卫星时优选惯性陀螺仪5的数据输出。
2型数字式自适应万向组合陀螺仪:用于移动载体有转弯(无翻滚)运动,且保持上下姿态,移动载体有可能遮挡导航卫星和短时间处于障碍物(山地或建筑物)遮挡导航卫星的情况。2型数字式自适应万向组合陀螺仪由两个数字化自适应陀螺仪1、两个优选卫星处理器2、一个惯性陀螺仪5、优选数字化自适应陀螺仪处理器3、数据融合及卡尔曼滤波器4和输出数据控制器6等组成。两个数字化自适应陀螺仪1的两个天线组分别架设在移动载体的两侧面,在横断面内偏上,两个天线组之间成110~130°夹角。天线的波束宽度约120~150°,几乎覆盖上半球。优选数字化自适应陀螺仪处理器3的作用是根据移动载体的运动方向和导航卫星的分布情况优选那一个数字化自适应陀螺仪1输出数据。优选卫星处理器2、数据融合及卡尔曼滤波器4、惯性陀螺仪5和输出数据控制器6等的作用同1型数字式自适应万向组合陀螺仪。当出现障碍物(山地或建筑物)遮挡导航卫星时优选惯性陀螺仪5的数据输出。
3型数字式自适应万向组合陀螺仪:用于移动载体有转弯和翻滚运动,移动载体可能遮挡导航卫星和短时间处于障碍物(山地或建筑物)遮挡导航卫星的情况。3型数字式自适应万向组合陀螺仪由三个数字化自适应陀螺仪1、三个优选卫星处理器2、一个惯性陀螺仪5、优选数字化自适应陀螺仪处理器3、数据融合及卡尔曼滤波器4和输出数据控制器6等组成。三个天线组分别架设在移动载体的上面和两侧偏下,在横断面内,三个天线组之间成110~130°夹角。天线的波束宽度约120~150°,几乎覆盖上半球和下半球。不论移动载体转弯和翻滚到任何方向都能接收到足够多的导航卫星的信号和数据。优选数字化自适应陀螺仪处理器3可在三个数字化自适应陀螺仪1中优选1~3个数字化自适应陀螺仪1的姿态角数据送入数据融合及卡尔曼滤波器4。优选卫星处理器2、数据融合及卡尔曼滤波器4、惯性陀螺仪5和输出数据控制器6等的作用同1型数字式自适应万向组合陀螺仪。当出现障碍物(山地或建筑物)遮挡导航卫星时优选惯性陀螺仪5的数据输出。
熟知本领域的人士将理解,虽然这里为了便于解释已描述了具体实施例,但是可在不背离本发明精神和范围的情况下作出各种改变。因此,除了所附权利要求之外,不能用于限制本发明。
Claims (7)
1.一种数字式自适应万向组合陀螺仪,其特征在于它包括1~3个数字化自适应陀螺仪(1)、1~3个优选卫星处理器(2)、优选数字化自适应陀螺仪处理器(3)、数据融合及卡尔曼滤波器(4)、惯性陀螺仪(5)和输出数据控制器(6),所述优选卫星处理器(2)输入/输出端口与对应的数字化自适应陀螺仪(1)的优选卫星处理器输入/输出端口连接;所述数字化自适应陀螺仪(1)数据输出端口与所述优选数字化自适应陀螺仪处理器(3)数据输入端口连接;所述优选数字化自适应陀螺仪处理器(3)的数据输出端口与所述数据融合及卡尔曼滤波器(4)数据输入端口连接;所述数据融合及卡尔曼滤波器(4)的数据输出端口与所述输出数据控制器(6)的数据输入端口连接;所述惯性陀螺仪(5)的数据输入/输出端口与所述数据融合及卡尔曼滤波器(4)的输入/输出端口连接;所述惯性陀螺仪(5)的数据输出端口与所述输出数据控制器(6)的接收惯性陀螺仪数据输入端口连接。
2.根据权利要求1所述的数字式自适应万向组合陀螺仪,其特征在:所述数字化自适应陀螺仪(1)上包括由三个天线组成的天线组、三个导航卫星多通道接收机和定位及姿态角处理器。
3.根据权利要求1或2所述的数字式自适应万向组合陀螺仪,其特征在于:所述数字化自适应陀螺仪(1)和优选卫星处理器(2)为分体设置。
4.根据权利要求1或2所述的数字式自适应万向组合陀螺仪,其特征在于:所述优选卫星处理器(2)内置于数字化自适应陀螺仪(1)中。
5.根据权利要求2所述的数字式自适应万向组合陀螺仪,其特征在:所述数字化自适应陀螺仪(1)为1个,所述优选卫星处理器(2)也为1个。
6.根据权利要求2所述的数字式自适应万向组合陀螺仪,其特征在:所述数字化自适应陀螺仪(1)为2个,所述优选卫星处理器(2)也为2个;2个数字化自适应陀螺仪(1)上的2个天线组分别置于移动载体的两侧,2个天线组之间成110~130°夹角。
7.根据权利要求2所述的数字式自适应万向组合陀螺仪,其特征在:所述数字化自适应陀螺仪(1)为3个,所述优选卫星处理器(2)也为3个;3个数字化自适应陀螺仪(1)上的3个天线组分别置于移动载体的上面和两侧下部,3个天线组之间成110~130°夹角。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN2010102565408A CN101949699B (zh) | 2010-08-17 | 2010-08-17 | 数字式自适应万向组合陀螺仪 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN2010102565408A CN101949699B (zh) | 2010-08-17 | 2010-08-17 | 数字式自适应万向组合陀螺仪 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN101949699A true CN101949699A (zh) | 2011-01-19 |
CN101949699B CN101949699B (zh) | 2012-01-25 |
Family
ID=43453280
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN2010102565408A Expired - Fee Related CN101949699B (zh) | 2010-08-17 | 2010-08-17 | 数字式自适应万向组合陀螺仪 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN101949699B (zh) |
Cited By (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN107783539A (zh) * | 2017-10-25 | 2018-03-09 | 上海联适导航技术有限公司 | 基于北斗卫星导航的四轮载具自动驾驶装置及其操控方法 |
Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN1924522A (zh) * | 2006-09-22 | 2007-03-07 | 中国电子科技集团公司第二十八研究所 | 数字化自适应陀螺仪 |
CN1948910A (zh) * | 2006-11-09 | 2007-04-18 | 复旦大学 | 利用gps与陀螺仪、里程计的组合定位方法与装置 |
TW200837330A (en) * | 2007-03-09 | 2008-09-16 | Mitac Int Corp | Integrated positioning apparatus and implementation method thereof |
CN201497509U (zh) * | 2009-06-12 | 2010-06-02 | 西安星展测控科技有限公司 | 一种双天线gps/ins组合导航仪 |
-
2010
- 2010-08-17 CN CN2010102565408A patent/CN101949699B/zh not_active Expired - Fee Related
Patent Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN1924522A (zh) * | 2006-09-22 | 2007-03-07 | 中国电子科技集团公司第二十八研究所 | 数字化自适应陀螺仪 |
CN1948910A (zh) * | 2006-11-09 | 2007-04-18 | 复旦大学 | 利用gps与陀螺仪、里程计的组合定位方法与装置 |
CN100541134C (zh) * | 2006-11-09 | 2009-09-16 | 复旦大学 | 利用gps与陀螺仪、里程计的组合定位方法与装置 |
TW200837330A (en) * | 2007-03-09 | 2008-09-16 | Mitac Int Corp | Integrated positioning apparatus and implementation method thereof |
CN201497509U (zh) * | 2009-06-12 | 2010-06-02 | 西安星展测控科技有限公司 | 一种双天线gps/ins组合导航仪 |
Non-Patent Citations (3)
Title |
---|
《中国民航学院学报》 19930630 周其焕 双基线载波相位差GPS干涉仪的姿态航向基准系统 14-22 1- 第11卷, 第2期 2 * |
《机电设备》 19820831 P.C.梅克利兰等 斯佩里操舵系统和海协规则 43-47 1-7 , 第04期 2 * |
《系统工程与电子技术》 20080415 徐田来等 车载多传感器组合导航系统设计与实现 , 第04期 2 * |
Cited By (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN107783539A (zh) * | 2017-10-25 | 2018-03-09 | 上海联适导航技术有限公司 | 基于北斗卫星导航的四轮载具自动驾驶装置及其操控方法 |
Also Published As
Publication number | Publication date |
---|---|
CN101949699B (zh) | 2012-01-25 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN110208842A (zh) | 一种车联网环境下车辆高精度定位方法 | |
CN103852082B (zh) | 一种星间测量和陀螺的姿态轨道一体化滤波估计方法 | |
CN110487266B (zh) | 一种适用于海面目标的机载光电高精度无源定位方法 | |
CN105823481A (zh) | 一种基于单天线的gnss-ins车辆定姿方法 | |
CN111829512B (zh) | 一种基于多传感器数据融合的auv导航定位方法及系统 | |
CN103972654B (zh) | 直升机旋翼遮挡下的动中通天线卫星对星跟踪装置 | |
CN105043418B (zh) | 一种适用于船载动中通的惯导系统快速初始粗对准方法 | |
CN106226780A (zh) | 基于激光扫描雷达的多旋翼室内定位系统及实现方法 | |
CN110672871B (zh) | 一种基于组合惯导信息和光电转塔视频跟踪的运动目标测速测向方法 | |
CN105258698A (zh) | 一种高动态自旋制导炮弹空中组合导航方法 | |
CN111367167B (zh) | 一种有限时间约束的高轨目标抵近观测方法 | |
CN102157790A (zh) | 一种用于动中通的天线跟踪系统 | |
CN109855649B (zh) | 一种水下滑翔机平台运动轨迹被动确定方法 | |
CN101786505B (zh) | 基于气动力姿态控制的低轨飞行器及其姿态控制方法 | |
CN105180728A (zh) | 基于前数据的旋转制导炮弹快速空中对准方法 | |
CN102722179A (zh) | 基于三维悬浮技术的目标跟踪平台稳定控制系统 | |
CN109991993A (zh) | 基于rtk差分定位的天地双飞控系统及飞控 | |
Ding et al. | Adding optical flow into the GPS/INS integration for UAV navigation | |
Medina et al. | On the Kalman filtering formulation for RTK joint positioning and attitude quaternion determination | |
CN105445757B (zh) | 一种交通工具引导系统及引导方法 | |
CN108151765A (zh) | 一种在线实时估计补偿磁强计误差的定位测姿方法 | |
Kim et al. | Flight test results of GPS/INS navigation loop for an autonomous unmanned aerial vehicle (UAV) | |
CN101949699B (zh) | 数字式自适应万向组合陀螺仪 | |
He et al. | Research on GNSS INS & GNSS/INS Integrated Navigation Method for Autonomous Vehicles: A Survey | |
CN108759864A (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 | ||
C53 | Correction of patent for invention or patent application | ||
CB03 | Change of inventor or designer information |
Inventor after: Liu Xing Inventor after: Li Yunru Inventor after: Chang Chuanwen Inventor after: Lu Wenguang Inventor after: Jiang Fei Inventor before: Liu Xing |
|
COR | Change of bibliographic data |
Free format text: CORRECT: INVENTOR; FROM: LIU XING TO: LIU XING LI YUNRU CHANG ZHUANWEN LU WENGUANG JIANG FEI |
|
C14 | Grant of patent or utility model | ||
GR01 | Patent grant | ||
CF01 | Termination of patent right due to non-payment of annual fee |
Granted publication date: 20120125 Termination date: 20200817 |
|
CF01 | Termination of patent right due to non-payment of annual fee |