CN104251708A - 一种新的惯导快速双位置对准方法 - Google Patents
一种新的惯导快速双位置对准方法 Download PDFInfo
- Publication number
- CN104251708A CN104251708A CN201310261738.9A CN201310261738A CN104251708A CN 104251708 A CN104251708 A CN 104251708A CN 201310261738 A CN201310261738 A CN 201310261738A CN 104251708 A CN104251708 A CN 104251708A
- Authority
- CN
- China
- Prior art keywords
- dtri
- epsiv
- error
- inertial
- measurement unit
- 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.)
- Pending
Links
Classifications
-
- 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)
- Manufacturing & Machinery (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Navigation (AREA)
Abstract
本发明属于一种惯性导航方法,具体涉及一种新的惯导快速双位置对准方法。它包括如下步骤,设置一个单轴旋转机构;单轴旋转机构负责安装惯性测量单元,按照预定方式旋转,实现对惯性器件误差的调制;将惯性测量单元安装在旋转机构上,启动旋转机构旋转;惯性测量单元导航计算;进行卡尔曼滤波计算;本发明的优点是,通过旋转调制技术抑制惯性器件误差,通过闭环卡尔曼滤波器消除初始误差影响,通过采用“速度+位置”匹配方式避免动态挠曲变形的影响,从而可在有动态挠曲变形且不提高惯性器件精度的情况下实现惯导系统的高精度动基座传递对准。
Description
技术领域
本发明属于一种惯性导航方法,具体涉及一种惯导快速双位置对准方法。
背景技术
主、子惯导在进行动基座对准时,为提高对准精度,一般采用“速度+姿态”的匹配方式。目前,国内外对这一方法的研究与应用已比较成熟,如:张洪钺编写的《几种传递对准方程的比较研究》,中国惯性技术学报,2003年第6期;陈凯等编写的《传递对准中一种新的姿态匹配算法》,西北工业大学学报,2007年第5期;李璞等编写的《速度加姿态匹配的传递对准算法研究》,导弹与航天运载技术,2009年第5期。
但是,在某些场合,主、子惯导之间距离较远,两者之间存在较大的动态挠曲变形,这会严重影响动基座对准的精度;此时,只能采用“速度”或“位置“匹配方式,对准精度会受到陀螺精度的限制,并且会受到初始装订误差的影响。
发明内容
本发明的目的是提供一种新的惯导快速双位置对准方法,它能够避免动态挠曲变形和初始航姿角误差对动基座对准精度的影响,并抑制陀螺漂移造成的对准误差。
本发明是这样实现的,一种新的惯导快速双位置对准方法,它包括如下步骤,
1)设置一个单轴旋转机构
单轴旋转机构负责安装惯性测量单元,按照预定方式旋转,实现对惯性器件误差的调制;
2)将惯性测量单元安装在旋转机构上
在单轴旋转机构上安装惯性测量单元,使得旋转轴与惯性测量单元的垂向轴平行;
3)启动旋转机构旋转
旋转机构在[-π,π]之间以10°/s的角速度匀速往复旋转;
4)惯性测量单元导航计算
装订主基准提供的导航参数,利用加速度计和陀螺的输入,按照标准捷联惯导解算流程进行导航计算,输出位置、速度和航姿角信息;
5)进行卡尔曼滤波计算
根据速度和位置观测量,采用闭环卡尔曼滤波器来估计、修正初始航姿角误差;滤波计算流程编排如下:
状态一步预测:Xk/k-1=Φk,k-1Xk-1
状态方差阵一步预测:
滤波增益:
状态估计:Xk=Xk/k-1+Kk(Zk-KkXk/k-1)
状态方差阵更新:Pk=(I-KkHk)Pk/k-1
其中
依次表示纬度误差、经度误差、北速误差、天速误差、东速误差、北向偏角、方位偏角、东西偏角、三个加速度计零偏、三个陀螺漂移;
6)每完成一次滤波计算,随后进行一次闭环修正
位置修正:L=L-X(1)λ=λ-X(2)
速度修正:VN=VN-X(3),VU=VU-X(4),VE=VE-X(5)
姿态修正:
加表零偏修正:
陀螺漂移修正:
状态向量修正:X(i)=0,(i=1-14)
按照以上步骤即可实现动基座传递对准。
本发明的优点是,通过旋转调制技术抑制惯性器件误差,通过闭环卡尔曼滤波器消除初始误差影响,通过采用“速度+位置”匹配方式避免动态挠曲变形的影响,从而可在有动态挠曲变形且不提高惯性器件精度的情况下实现惯导系统的高精度动基座传递对准。
附图说明
图1为某次对准试验方位角收敛过程。
具体实施方式
下面结合附图和实施例对本发明进行详细描述:
本发明在捷联惯导系统内部设有一个单轴旋转机构,将惯性测量单元安装在双轴旋转机构上,通过旋转机构的连续整周旋转来调制陀螺漂移、加速度计零偏等误差,抑制其对传递对准精度的影响;本发明采用“速度+位置”匹配方式,以避免动态挠曲变形的影响;本发明采用闭环卡尔曼滤波技术,以消除初始航姿角误差的影响。
一种新的惯导快速双位置对准方法,它包括如下步骤:
1)设置一个单轴旋转机构
单轴旋转机构负责安装惯性测量单元,按照预定方式旋转,实现对惯性器件误差的调制。
2)将惯性测量单元安装在旋转机构上
在单轴旋转机构上安装惯性测量单元,使得旋转轴与惯性测量单元的垂向轴平行。
3)启动旋转机构旋转
旋转机构在[-π,π]之间以10°/s的角速度匀速往复旋转。
4)惯性测量单元导航计算
装订主基准提供的导航参数,利用加速度计和陀螺的输入,按照标准捷联惯导解算流程进行导航计算,输出位置、速度和航姿角信息。
5)进行卡尔曼滤波计算
根据速度和位置观测量,采用闭环卡尔曼滤波器来估计、修正初始航姿角误差;滤波计算流程编排如下:
状态一步预测:Xk/k-1=Φk,k-1Xk-1
状态方差阵一步预测:
滤波增益:
状态估计:Xk=Xk/k-1+Kk(Zk-KkXk/k-1)
状态方差阵更新:Pk=(I-KkHk)Pk/k-1
其中
依次表示纬度误差、经度误差、北速误差、天速误差、东速误差、北向偏角、方位偏角、东西偏角、三个加速度计零偏、三个陀螺漂移。
6)每完成一次滤波计算,随后进行一次闭环修正
位置修正:L=L-X(1) λ=λ-X(2)
速度修正:VN=VN-X(3),VU=VU-X(4),VE=VE-X(5)
姿态修正:
加表零偏修正:
陀螺漂移修正:
状态向量修正:X(i)=0,(i=1-14)
按照以上步骤即可实现动基座传递对准。
通过旋转调制下的闭环卡尔曼滤波初始对准,某惯导系统在试验艇上8次动基座对准的结果如表1所示,可见,最大对准误差为3.16'。
表1旋转调制下闭环卡尔曼滤波对准结果
图1给出了一次对准过程中方位角的收敛过程,可见,采用闭环对准方式可使误差迅速收敛。
Claims (1)
1.一种新的惯导快速双位置对准方法,其特征在于:它包括如下步骤,
1)设置一个单轴旋转机构
单轴旋转机构负责安装惯性测量单元,按照预定方式旋转,实现对惯性器件误差的调制;
2)将惯性测量单元安装在旋转机构上
在单轴旋转机构上安装惯性测量单元,使得旋转轴与惯性测量单元的垂向轴平行;
3)启动旋转机构旋转
旋转机构在[-π,π]之间以10°/s的角速度匀速往复旋转;
4)惯性测量单元导航计算
装订主基准提供的导航参数,利用加速度计和陀螺的输入,按照标准捷联惯导解算流程进行导航计算,输出位置、速度和航姿角信息;
5)进行卡尔曼滤波计算
根据速度和位置观测量,采用闭环卡尔曼滤波器来估计、修正初始航姿角误差;滤波计算流程编排如下:
状态一步预测:Xk/k-1=Φk,k-1Xk-1
状态方差阵一步预测:
滤波增益:
状态估计:Xk=Xk/k-1+Kk(Zk-KkXk/k-1)
状态方差阵更新:Pk=(I-KkHk)Pk/k-1
其中
依次表示纬度误差、经度误差、北速误差、天速误差、东速误差、北向偏角、方位偏角、东西偏角、三个加速度计零偏、三个陀螺漂移;
6)每完成一次滤波计算,随后进行一次闭环修正
位置修正:L=L-X(1) λ=λ-X(2)
速度修正:VN=VN-X(3),VU=VU-X(4),VE=VE-X(5)
姿态修正:
加表零偏修正:
陀螺漂移修正:
状态向量修正:X(i)=0,(i=1-14)
按照以上步骤即可实现动基座传递对准。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201310261738.9A CN104251708A (zh) | 2013-06-27 | 2013-06-27 | 一种新的惯导快速双位置对准方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201310261738.9A CN104251708A (zh) | 2013-06-27 | 2013-06-27 | 一种新的惯导快速双位置对准方法 |
Publications (1)
Publication Number | Publication Date |
---|---|
CN104251708A true CN104251708A (zh) | 2014-12-31 |
Family
ID=52186822
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201310261738.9A Pending CN104251708A (zh) | 2013-06-27 | 2013-06-27 | 一种新的惯导快速双位置对准方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN104251708A (zh) |
Cited By (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN105674988A (zh) * | 2016-02-15 | 2016-06-15 | 河南理工大学 | 一种mems等效单轴旋转惯导的传递对准方法 |
CN106705992A (zh) * | 2015-11-12 | 2017-05-24 | 北京自动化控制设备研究所 | 一种双轴光纤惯导系统快速自标定自对准方法 |
CN109959390A (zh) * | 2018-12-26 | 2019-07-02 | 中国电子科技集团公司第二十研究所 | 一种旋转调制系统双位置安装偏差补偿方法 |
CN109974709A (zh) * | 2019-04-09 | 2019-07-05 | 天津时空经纬信息技术有限公司 | 导航系统以及确定导航信息的方法 |
CN110646012A (zh) * | 2018-06-27 | 2020-01-03 | 北京自动化控制设备研究所 | 一种惯导系统单位置初始对准最优方法 |
CN112179340A (zh) * | 2020-10-10 | 2021-01-05 | 中国人民解放军战略支援部队航天工程大学 | 一种冗余配置惯性测量单元双轴旋转调制方法 |
CN118149862A (zh) * | 2024-05-11 | 2024-06-07 | 西安中科华航光电科技有限公司 | 一种用于旋转调制惯导系统的高精度转动传递对准方法 |
-
2013
- 2013-06-27 CN CN201310261738.9A patent/CN104251708A/zh active Pending
Non-Patent Citations (1)
Title |
---|
周绍磊等: "一种新的捷联惯导快速双位置对准方法", 《中国惯性技术学报》 * |
Cited By (11)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN106705992A (zh) * | 2015-11-12 | 2017-05-24 | 北京自动化控制设备研究所 | 一种双轴光纤惯导系统快速自标定自对准方法 |
CN106705992B (zh) * | 2015-11-12 | 2020-08-21 | 北京自动化控制设备研究所 | 一种双轴光纤惯导系统快速自标定自对准方法 |
CN105674988A (zh) * | 2016-02-15 | 2016-06-15 | 河南理工大学 | 一种mems等效单轴旋转惯导的传递对准方法 |
CN110646012A (zh) * | 2018-06-27 | 2020-01-03 | 北京自动化控制设备研究所 | 一种惯导系统单位置初始对准最优方法 |
CN109959390A (zh) * | 2018-12-26 | 2019-07-02 | 中国电子科技集团公司第二十研究所 | 一种旋转调制系统双位置安装偏差补偿方法 |
CN109959390B (zh) * | 2018-12-26 | 2022-11-22 | 中国电子科技集团公司第二十研究所 | 一种旋转调制系统双位置安装偏差补偿方法 |
CN109974709A (zh) * | 2019-04-09 | 2019-07-05 | 天津时空经纬信息技术有限公司 | 导航系统以及确定导航信息的方法 |
CN112179340A (zh) * | 2020-10-10 | 2021-01-05 | 中国人民解放军战略支援部队航天工程大学 | 一种冗余配置惯性测量单元双轴旋转调制方法 |
CN112179340B (zh) * | 2020-10-10 | 2022-06-07 | 中国人民解放军战略支援部队航天工程大学 | 一种冗余配置惯性测量单元双轴旋转调制方法 |
CN118149862A (zh) * | 2024-05-11 | 2024-06-07 | 西安中科华航光电科技有限公司 | 一种用于旋转调制惯导系统的高精度转动传递对准方法 |
CN118149862B (zh) * | 2024-05-11 | 2024-07-26 | 西安中科华航光电科技有限公司 | 一种用于旋转调制惯导系统的高精度转动传递对准方法 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN104251708A (zh) | 一种新的惯导快速双位置对准方法 | |
CN103245360B (zh) | 晃动基座下的舰载机旋转式捷联惯导系统自对准方法 | |
CN102508275B (zh) | 多天线gps/gf-ins深度组合定姿方法 | |
CN108680942B (zh) | 一种惯性/多天线gnss组合导航方法及装置 | |
CN105698822B (zh) | 基于反向姿态跟踪的自主式惯性导航行进间初始对准方法 | |
CN103344260B (zh) | 基于rbckf的捷联惯导系统大方位失准角初始对准方法 | |
CN102829781B (zh) | 一种旋转式捷联光纤罗经实现的方法 | |
CN103557876A (zh) | 一种用于天线跟踪稳定平台的捷联惯导初始对准方法 | |
CN103697878B (zh) | 一种单陀螺单加速度计旋转调制寻北方法 | |
CN102519485B (zh) | 一种引入陀螺信息的二位置捷联惯性导航系统初始对准方法 | |
CN111102993A (zh) | 一种旋转调制型捷联惯导系统晃动基座初始对准方法 | |
CN102052921B (zh) | 一种单轴旋转捷联惯导系统初始航向的确定方法 | |
CN104236586B (zh) | 基于量测失准角的动基座传递对准方法 | |
CN102679978B (zh) | 一种旋转式捷联惯性导航系统静基座初始对准方法 | |
CN103575299A (zh) | 利用外观测信息的双轴旋转惯导系统对准及误差修正方法 | |
CN102003967B (zh) | 基于罗经原理的旋转式船用捷联惯导方位对准方法 | |
CN102628691A (zh) | 一种完全自主的相对惯性导航方法 | |
Zhao | GPS/IMU integrated system for land vehicle navigation based on MEMS | |
CN103900565A (zh) | 一种基于差分gps的惯导系统姿态获取方法 | |
CN103822633A (zh) | 一种基于二阶量测更新的低成本姿态估计方法 | |
CN102768043B (zh) | 一种无外观测量的调制型捷联系统组合姿态确定方法 | |
CN103697911A (zh) | 一种纬度未知情形下的捷联惯导系统初始姿态确定方法 | |
CN102393204B (zh) | 一种基于sins/cns的组合导航信息融合方法 | |
CN108303079A (zh) | 一种水下usbl反向应用的数据平滑方法 | |
CN103424127A (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 | ||
RJ01 | Rejection of invention patent application after publication | ||
RJ01 | Rejection of invention patent application after publication |
Application publication date: 20141231 |