CN111397603B - 载体姿态动态情况下的惯性/多普勒动基座粗对准方法 - Google Patents
载体姿态动态情况下的惯性/多普勒动基座粗对准方法 Download PDFInfo
- Publication number
- CN111397603B CN111397603B CN202010333308.3A CN202010333308A CN111397603B CN 111397603 B CN111397603 B CN 111397603B CN 202010333308 A CN202010333308 A CN 202010333308A CN 111397603 B CN111397603 B CN 111397603B
- Authority
- CN
- China
- Prior art keywords
- dvl
- matrix
- information
- attitude
- time
- 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
- 238000000034 method Methods 0.000 title claims abstract description 29
- 239000011159 matrix material Substances 0.000 claims abstract description 84
- 238000005259 measurement Methods 0.000 claims abstract description 34
- 206010034719 Personality change Diseases 0.000 claims abstract description 11
- 230000009466 transformation Effects 0.000 claims description 27
- 230000008859 change Effects 0.000 claims description 3
- 230000005484 gravity Effects 0.000 claims description 3
- 230000008054 signal transmission Effects 0.000 claims description 3
- 230000006978 adaptation Effects 0.000 description 1
- 238000004458 analytical method Methods 0.000 description 1
- 238000012986 modification Methods 0.000 description 1
- 230000004048 modification Effects 0.000 description 1
- 230000008569 process Effects 0.000 description 1
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/165—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 combined with non-inertial navigation instruments
-
- 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)
- Measurement Of Velocity Or Position Using Acoustic Or Ultrasonic Waves (AREA)
Abstract
本发明公开了一种载体姿态动态情况下的惯性/多普勒动基座粗对准方法,包括:首先将DVL测速信息转换为多普勒频移信息;其次用SINS更新的姿态变化信息补偿载体姿态动态情况下DVL测速误差,结合多普勒频移信息估计当前速度;对补偿后的DVL测速信息及SINS输出信息进行积分,构建参考矢量和观测矢量;采用最优基四元数法计算初始姿态矩阵,最终更新当前姿态信息。本发明能有效地提高SINS/DVL组合导航***粗对准阶段的收敛速度,精度及鲁棒性。
Description
技术领域
本发明是一种载体姿态动态情况下的惯性/多普勒动基座粗对准方法,属于组合导航对准技术,特别适用于水下组合导航领域。
背景技术
在水下组合导航***中,基于SINS(即:捷联惯性导航***)/DVL(即:多普勒测速仪)的组合导航具有高自主性和隐蔽性,是最常用的水下组合导航方式之一。SINS/DVL组合导航***中,初始姿态精度作为关键指标,影响着整个组合导航***精度。粗对准通过计算粗略的姿态信息,为精对准和后续导航提供初始姿态信息,在整个水下航行任务中起着关键作用。
现有技术中对SINS/DVL组合导航***的粗对准方法主要有解析法,矢量定姿法等多种方法。现有粗对准方法未考虑载体动态情况下由于姿态变化引入的DVL测速误差。该误差作为观测进入SINS/DVL粗对准算法,将大幅降低粗对准速度,精度指标。为了提高SINS/DVL 粗对准鲁棒性,亟需提出一种适用于载体姿态动态情况的粗对准方法。
发明内容
发明目的:为了提高SINS/DVL***粗对准的收敛速度,精度及鲁棒性,本发明提出了一种载体姿态动态情况下的惯性/多普勒(SINS/DVL)动基座粗对准方法。
技术方案:为实现本发明的目的,本发明所采用的技术方案是:
一种载体姿态动态情况下的惯性/多普勒动基座粗对准方法,该方法包括如下步骤:
S1:将DVL测速信息转换为多普勒频移信息;
S2:用SINS更新的姿态变化信息补偿载体姿态动态情况下DVL测速误差,结合多普勒频移信息估计当前速度;
S3:对补偿后的DVL测速信息及SINS输出信息进行积分,构建参考矢量和观测矢量;
S4:采用最优基四元数法计算初始姿态矩阵,更新当前姿态信息。
所述的载体姿态动态情况下的惯性/多普勒动基座粗对准方法,所述步骤S1具体包括以下过程:
若DVL输出测速信息,则将DVL输出的测速信息转换为多普勒频移信息:
若DVL直接输出多普勒频移信息,则直接使用DVL输出多普勒频移信息。
所述的载体姿态动态情况下的惯性/多普勒动基座粗对准方法,所述步骤S2具体包括以下过程:
用SINS更新的姿态变化信息补偿载体姿态动态情况下DVL测速误差,结合多普勒频移信息估计当前速度:
S2.1用SINS中陀螺输出角速度跟踪载体系b系在DVL信号发射t1时刻和信号接收t2 时刻间的变化情况,构建相应姿态变化矩阵:
S2.2用SINS信息补偿并估计当前DVL测速信息:
其中,为t2接收时刻b系下的DVL速度,C为超声波波速,I为单位阵,为t2时刻b系到t1时刻b系的转换矩阵,A为转换矩阵,[Δf1 Δf2 Δf3 Δf4]T为DVL四轴向频移信息,f0为DVL发射的超声波信号频率。
所述的载体姿态动态情况下的惯性/多普勒动基座粗对准方法,所述步骤S3具体包括以下过程:
对补偿后的DVL测速信息及SINS输出信息进行积分,构建参考矢量α和观测矢量β:
所述的载体姿态动态情况下的惯性/多普勒动基座粗对准方法,所述步骤S4具体包括以下过程:
采用最优基四元数法计算初始姿态矩阵,更新当前姿态信息:
S4.1构建K矩阵:
其中,K(t)为K矩阵,α为参考矢量,β为观测矢量,[×]为反对称阵;
S4.2离散化K矩阵:
其中,Kk为k时刻K矩阵,Kk-1为k-1时刻K矩阵,ΔK为K矩阵增量,α为参考矢量,β为观测矢量,Δt为DVL测量间隔;
计算当前姿态矩阵:
有益效果:
本发明利用载体姿态变化信息补偿DVL测速误差并辅助SINS估算初始姿态,提高了粗对准的速度,精度与鲁棒性。
附图说明
图1为本发明的载体姿态动态情况下的惯性/多普勒动基座粗对准方法流程图。
具体实施方式
下面结合附图,对本发明的技术方案作进一步说明。应当了解,以下提供的实施例仅是为了详尽地且完全地公开本发明,并且向所属技术领域的技术人员充分传达本发明的技术构思,本发明还可以用许多不同的形式来实施,并且不局限于此处描述的实施例。对于表示在附图中的示例性实施方式中的术语并不是对本发明的限定。
本发明提供的载体姿态动态情况下的惯性/多普勒动基座粗对准方法,实现原理如图1所示。其流程主要包括以下步骤:
步骤S1,将DVL测速信息转换为多普勒频移信息。具体包括以下过程:
若DVL输出测速信息,则将DVL输出的测速信息转换为多普勒频移信息:
若DVL直接输出多普勒频移信息,则直接使用DVL输出多普勒频移信息。
步骤S2,用SINS更新的姿态变化信息补偿载体姿态动态情况下DVL测速误差,结合多普勒频移信息估计当前速度。具体包括以下过程:
S2.1用SINS中陀螺输出角速度跟踪载体系b系在DVL信号发射t1时刻和信号接收t2 时刻间的变化情况,构建相应姿态变化矩阵:
S2.2用SINS信息补偿并估计当前DVL测速信息:
其中,为t2接收时刻b系下的DVL速度,C为超声波波速,I为单位阵,为t2时刻b系到t1时刻b系的转换矩阵,A为转换矩阵,[Δf1 Δf2 Δf3 Δf4]T为DVL四轴向频移信息,f0为DVL发射的超声波信号频率。
步骤S3,对补偿后的DVL测速信息及SINS输出信息进行积分,构建参考矢量和观测矢量。具体包括以下过程:
对补偿后的DVL测速信息及SINS输出信息进行积分,构建参考矢量α和观测矢量β:
步骤S4,采用最优基四元数法计算初始姿态矩阵,更新当前姿态信息。具体包括以下过程:
S4.1构建K矩阵:
其中,K(t)为K矩阵,α为参考矢量,β为观测矢量,[×]为反对称阵;
S4.2离散化K矩阵:
其中,Kk为k时刻K矩阵,Kk-1为k-1时刻K矩阵,ΔK为K矩阵增量,α为参考矢量,β为观测矢量,Δt为DVL测量间隔;
计算当前姿态矩阵:
本发明方案所公开的技术手段不仅限于上述实施方式所公开的技术手段,还包括由以上技术特征任意组合所组成的技术方案。应当指出,对于本技术领域的普通技术人员来说,在不脱离本发明原理的前提下,还可以做出若干改进和润饰,这些改进和润饰也视为本发明的保护范围。
Claims (1)
1.一种载体姿态动态情况下的惯性/多普勒动基座粗对准方法,其特征在于,包括以下步骤:
S1:将DVL测速信息转换为多普勒频移信息;
S2:用SINS更新的姿态变化信息补偿载体姿态动态情况下DVL测速误差,结合多普勒频移信息估计当前速度;
S3:对补偿后的DVL测速信息及SINS输出信息进行积分,构建参考矢量和观测矢量;
S4:采用最优基四元数法计算初始姿态矩阵,更新当前姿态信息;
所述步骤S1具体包括以下过程:
若DVL输出测速信息,则将DVL输出的测速信息转换为多普勒频移信息:
若DVL直接输出多普勒频移信息,则直接使用DVL输出多普勒频移信息;
所述步骤S2具体包括以下过程:
用SINS更新的姿态变化信息补偿载体姿态动态情况下DVL测速误差,结合多普勒频移信息估计当前速度:
S2.1用SINS中陀螺输出角速度跟踪载体系b系在DVL信号发射t1时刻和信号接收t2时刻间的变化情况,构建相应姿态变化矩阵:
S2.2用SINS信息补偿并估计当前DVL测速信息:
其中,为t2接收时刻b系下的DVL速度,C为超声波波速,I为单位阵,为t2时刻b系到t1时刻b系的转换矩阵,A为转换矩阵,[Δf1 Δf2 Δf3 Δf4]T为DVL四轴向频移信息,f0为DVL发射的超声波信号频率;
所述步骤S3具体包括以下过程:
对补偿后的DVL测速信息及SINS输出信息进行积分,构建参考矢量α和观测矢量β:
所述步骤S4具体包括以下过程:
采用最优基四元数法计算初始姿态矩阵,更新当前姿态信息:
S4.1构建K矩阵:
其中,K(t)为K矩阵,α为参考矢量,β为观测矢量,[×]为反对称阵;
S4.2离散化K矩阵:
其中,Kk为k时刻K矩阵,Kk-1为k-1时刻K矩阵,ΔK为K矩阵增量,α为参考矢量,β为观测矢量,Δt为DVL测量间隔;
计算当前姿态矩阵:
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202010333308.3A CN111397603B (zh) | 2020-04-24 | 2020-04-24 | 载体姿态动态情况下的惯性/多普勒动基座粗对准方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202010333308.3A CN111397603B (zh) | 2020-04-24 | 2020-04-24 | 载体姿态动态情况下的惯性/多普勒动基座粗对准方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN111397603A CN111397603A (zh) | 2020-07-10 |
CN111397603B true CN111397603B (zh) | 2022-07-12 |
Family
ID=71435311
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202010333308.3A Active CN111397603B (zh) | 2020-04-24 | 2020-04-24 | 载体姿态动态情况下的惯性/多普勒动基座粗对准方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN111397603B (zh) |
Families Citing this family (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN111854747B (zh) * | 2020-08-25 | 2022-08-12 | 东南大学 | 一种载体大机动情况下的dvl辅助sins粗对准方法 |
CN112747770B (zh) * | 2020-12-16 | 2022-10-04 | 中国船舶重工集团有限公司第七一0研究所 | 一种基于速度量测的载体机动中初始对准方法 |
CN112945274B (zh) * | 2021-02-05 | 2022-11-18 | 哈尔滨工程大学 | 一种舰船捷联惯导***航行间粗对准方法 |
Citations (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN101187567A (zh) * | 2007-12-18 | 2008-05-28 | 哈尔滨工程大学 | 基于多普勒的光纤陀螺捷联惯导***初始姿态确定方法 |
CN103245357A (zh) * | 2013-04-03 | 2013-08-14 | 哈尔滨工程大学 | 一种船用捷联惯导***二次快速对准方法 |
CN106595711A (zh) * | 2016-12-21 | 2017-04-26 | 东南大学 | 一种基于递推四元数的捷联惯性导航***粗对准方法 |
CN107941242A (zh) * | 2017-11-13 | 2018-04-20 | 东南大学 | 一种基于惯性系的组合导航初始粗对准方法 |
CN108592943A (zh) * | 2018-03-16 | 2018-09-28 | 东南大学 | 一种基于opreq方法的惯性系粗对准计算方法 |
CN109443379A (zh) * | 2018-09-28 | 2019-03-08 | 东南大学 | 一种深海潜航器的sins/dvl水下抗晃动对准方法 |
CN110398257A (zh) * | 2019-07-17 | 2019-11-01 | 哈尔滨工程大学 | Gps辅助的sins***快速动基座初始对准方法 |
-
2020
- 2020-04-24 CN CN202010333308.3A patent/CN111397603B/zh active Active
Patent Citations (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN101187567A (zh) * | 2007-12-18 | 2008-05-28 | 哈尔滨工程大学 | 基于多普勒的光纤陀螺捷联惯导***初始姿态确定方法 |
CN103245357A (zh) * | 2013-04-03 | 2013-08-14 | 哈尔滨工程大学 | 一种船用捷联惯导***二次快速对准方法 |
CN106595711A (zh) * | 2016-12-21 | 2017-04-26 | 东南大学 | 一种基于递推四元数的捷联惯性导航***粗对准方法 |
CN107941242A (zh) * | 2017-11-13 | 2018-04-20 | 东南大学 | 一种基于惯性系的组合导航初始粗对准方法 |
CN108592943A (zh) * | 2018-03-16 | 2018-09-28 | 东南大学 | 一种基于opreq方法的惯性系粗对准计算方法 |
CN109443379A (zh) * | 2018-09-28 | 2019-03-08 | 东南大学 | 一种深海潜航器的sins/dvl水下抗晃动对准方法 |
CN110398257A (zh) * | 2019-07-17 | 2019-11-01 | 哈尔滨工程大学 | Gps辅助的sins***快速动基座初始对准方法 |
Non-Patent Citations (1)
Title |
---|
《极区间接横向惯性导航方法》;姚逸卿等;《中国惯性技术学报》;20150228;第23卷(第1期);全文 * |
Also Published As
Publication number | Publication date |
---|---|
CN111397603A (zh) | 2020-07-10 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN111397603B (zh) | 载体姿态动态情况下的惯性/多普勒动基座粗对准方法 | |
US8224574B2 (en) | System for multiple navigation components | |
CN109324330B (zh) | 基于混合无导数扩展卡尔曼滤波的usbl/sins紧组合导航定位方法 | |
US5991692A (en) | Zero motion detection system for improved vehicle navigation system | |
EP1585939B1 (en) | Attitude change kalman filter measurement apparatus and method | |
EP2187170B1 (en) | Method and system for estimation of inertial sensor errors in remote inertial measurement unit | |
CN111323012B (zh) | 载体高动态环境下的ins辅助dvl测速误差补偿方法 | |
US7421343B2 (en) | Systems and methods for reducing vibration-induced errors in inertial sensors | |
US6029111A (en) | Vehicle navigation system and method using GPS velocities | |
EP1221586A2 (en) | Position and heading error-correction method and apparatus for vehicle navigation systems | |
JP2003043129A (ja) | 全地球測位システムで使用するための2段階相互作用マルチモデルフィルタ | |
JP2003509671A (ja) | 物体の位置を追跡するためのナビゲーションシステムおよび方法 | |
CN111854747B (zh) | 一种载体大机动情况下的dvl辅助sins粗对准方法 | |
CN113203418A (zh) | 基于序贯卡尔曼滤波的gnssins视觉融合定位方法及*** | |
JP2000502801A (ja) | 多重軸加速度計を使用する改良された車両ナビゲーションシステム及びその方法 | |
CN117053782A (zh) | 一种水陆两栖机器人组合导航方法 | |
CN116222541A (zh) | 利用因子图的智能多源组合导航方法及装置 | |
CN103697887B (zh) | 一种基于捷联惯导***和多普勒计程仪的优化导航方法 | |
JP3421706B2 (ja) | 車上測位装置 | |
CN115031729A (zh) | Sins/dvl/usbl水下紧组合导航方法及装置、水下载体控制设备 | |
JPH0949737A (ja) | 航法信号出力方法 | |
JP6673106B2 (ja) | 角速度センサ補正装置および角速度センサ補正方法 | |
JP2009139342A (ja) | 加速度計測装置 | |
CN113776525B (zh) | 一种基于斜距差匹配的惯性/单声源被动组合导航方法 | |
JP3303175B2 (ja) | 車上測位装置 |
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 |