CN103090884A - 基于捷联惯导系统的多普勒计程仪测速误差抑制方法 - Google Patents
基于捷联惯导系统的多普勒计程仪测速误差抑制方法 Download PDFInfo
- Publication number
- CN103090884A CN103090884A CN2013100533389A CN201310053338A CN103090884A CN 103090884 A CN103090884 A CN 103090884A CN 2013100533389 A CN2013100533389 A CN 2013100533389A CN 201310053338 A CN201310053338 A CN 201310053338A CN 103090884 A CN103090884 A CN 103090884A
- Authority
- CN
- China
- Prior art keywords
- sins
- dvl
- speed
- doppler
- strapdown inertial
- 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)
- Measurement Of Velocity Or Position Using Acoustic Or Ultrasonic Waves (AREA)
Abstract
本发明提供的是一种基于捷联惯导系统的多普勒计程仪测速误差抑制方法。启动多普勒计程仪与捷联惯导系统,将多普勒计程仪(DVL)输出速度与捷联惯导系统(INS)输出速度进行综合处理,并经过进行高通数字滤波,可输出优化后的速度。本发明能在不滤除运动高频信息的同时滤除多普勒计程仪高频噪声,为其它惯性系统初始对准、导航提供速度和加速度参考。
Description
技术领域
本发明涉及的是一种测速误差抑制方法,特别是涉及一种多普勒计程仪的测速误差抑制方法。
背景技术
多普勒计程仪是一种常用船用计程仪,它是利用声波或超声波在水中的多普勒效应制成的计程仪,由于它可以直接测量船舶对地的速度,并且稳定可靠,所以近年来受到广泛应用。在船舶导航系统中,多普勒计程仪(DVL)测量速度通常用作辅助捷联罗经系统,DVL测量速度及其测量速度的差分值(加速度)提供给捷联罗经系统,这样可以去除船舶速度和加速度对于捷联罗经系统导航的影响。但是多普勒计程仪输出的速度中含有大量的噪声高频分量,这样会影响到对于捷联罗经系统的导航解算。
目前针对多普勒计程仪测速问题,国内已有人开始研究,并且提出了一些不错的方法,傅菊英在《海洋技术》发表的《声学多普勒计程仪测速误差分析与补偿》。这篇文章主要对多普勒计程仪的安装偏差、波束方向误差和电路设计误差等固定误差、通过标定试验给出多普勒计程仪的补偿系数并验证其有效性。但是他的标定实在实验室的环境下进行标定,属于事先标定,不能满足实时性的要求,并且精度较差。由于是针对固定误差的标定,所以灵活性也较差。
发明内容
本发明的目的在于提供一种既能很好的滤去多普勒中的高频误差分量,又能避免滤去船舶真实运动信息中的高频部分的基于捷联惯导系统的多普勒计程仪测速误差抑制方法。
本发明的目的是这样实现的:
步骤1:向船舶的多普勒计程仪和船舶捷联惯导系统中输入初始位置信息,并且采集陀螺和加速度计的输出信息;
步骤2:通过步骤1中的初始位置信息和采集的陀螺、加速度计的输出信息,获得初始的捷联惯导系统捷联矩阵
步骤4:多普勒计程仪实时输出第k时刻的多普勒速度Vdvl(k);
步骤5:由捷联惯导系统测量得到导航坐标系下的速度Vn(k),并通过Vn(k)测量得到k时刻的船舶前进速度
本发明还可以包括:
其中[]T表示转置,Vb(k)的矢量形式为
2、所述高通数字滤波中选用高通数字FIR滤波器,选取凯塞窗为
其中函数I[x]定义为:
N=10.4fs
其中fs为采样频率。
在本发明中,应保证捷联惯导系统与多普勒计程仪采样同步,并具有相同的采样频率。
在船用运行过程中,多普勒计算地理系上的测速误差方程如下(由于惯性系统计算中地理系未知,平台系即为计算地理系):
其中,δVp为测速误差在平台系上的投影,u为广义噪声在平台系上的投影,u的振荡幅度很大,且组成形式也比较复杂。组成形主要有两部分,一部分为自身测量噪声,另一部分是复杂的海浪运动对多普勒测量的影响。为常系数误差,为捷联矩阵,Vb为速度在载体系上的投影,由于部分实质上也受到运动变化的影响,因此可以将δVp的误差重新划分。
观察式(2),其中和直接可认定为高频误差;对于部分,由于船舶在航行中多数情况速度稳定,机动的情况比较少,因此可以认为该误差存在低频和高频两部分误差。令表示δVp的高频部分,表示低频部分,则式(2)可以改写为:
但是在船舶运行过程中受舵角水动力、风浪干扰、以及机体震动的影响,所以不仅误差项δVp包含高频项,船舶真实的运动速度Vp也包含了大量的高频部分,所以不能够直接对多普勒所测速度进行低通滤波。
但是惯性导航系统的速度误差与多普勒速度不同,为固有的长周期振荡形式,并且由于导航系统和多普勒共享一个惯性测量元件,所以提供的速度中包含的真实速度与多普勒中包含的真实运动速度Vp一致。两个速度相减就能消去真实速度Vp。并且导航速的速度误差频率主要在84.4分钟附近,与多普勒高频部分的频段相差悬殊。
本发明利用这种双系统工作状态下的特性,用导航系统提供的船舶速度来优化多普勒测速误差,很好的滤去了多普勒中的高频误差分量,同时又避免了滤去船舶真实运动信息中的高频部分。
本发明提供了一种基于捷联惯导系统的多普勒计程仪(DVL)测速误差抑制方法,该方法可以在保留真实运动信息的基础上,对DVL噪声中的高频分量进行滤除,利用处理后的速度进行速度差分,测量得出的船舶运动加速度精度较高。本发明利用捷联惯导系统所提供的速度来优化多普勒速度测量值,去除多普勒速度测量值中的高频误差,使得加速度的影响可以得到补偿,从而提高导航系统的精度。
附图说明
图1a-图1b为本发明多普勒速度误差曲线图,其中图1a为东向速度误差;图1b为北向速度误差。
图2a-图2b为本发明优化后的多普勒速度误差图,其中图2a为东向优化速度误差;图2b为北向优化速度误差。
具体实施方式
下面举例对本发明作更详细的描述。
本发明涉及的坐标系有:p-数学平台坐标系;b-载体坐标系。两个坐标系之间的转换用方向余弦矩阵表示。
1、船舶启动,预热多普勒计程仪和船舶捷联惯导系统,输入初始位置信息,并且采集陀螺和加速度计的输出信息;
3、捷联惯导系统和多普勒计程仪进入导航工作阶段,实时输出信息;
4、多普勒计程仪DVL实时输出第k时刻的多普勒速度Vdvl(k);
5、捷联惯导系统实时测量得到k时刻导航坐标系下的速度Vn(k);
其中上角标表示导航坐标系n系,下角标E、N、U分别表示导航坐标系的东轴、北轴和天轴,并且有k=1,2,…,M,
其中[]T表示转置,Vb(k)的矢量形式为
其中ΔV(k)为处理后的误差速度。
8、然后对误差速度ΔV(k)进行高通滤波处理,得到:
其中函数定义为:
并且有
N=5.2fsf
其中fs为采样频率,f为通带边缘频率,在本发明中,应保证捷联惯导系统与多普勒计程仪采样同步,并具有相同的采样频率。
Udvl(k)为优化后的DVL速度。
10、优化完成,利用Udvl(k)去进行导航系统其他部分的计算。
根据图1a-图1b,图2a-图2b仿真结果图可以看出,优化后的多普勒速度误差去除了高频震荡误差,但是本身的运动信息完整的保留了下来,达到了本发明所需要的效果。
Claims (3)
1.一种基于捷联惯导系统的多普勒计程仪测速误差抑制方法,其特征是:
步骤1:向船舶的多普勒计程仪和船舶捷联惯导系统中输入初始位置信息,并且采集陀螺和加速度计的输出信息;
步骤2:通过步骤1中的初始位置信息和采集的陀螺、加速度计的输出信息,获得初始的捷联惯导系统捷联矩阵
步骤4:多普勒计程仪实时输出第k时刻的多普勒速度Vdvl(k);
3.根据权利要求1或2所述的基于捷联惯导系统的多普勒计程仪测速误差抑制方法,其特征是:所述高通数字滤波中选用高通数字FIR滤波器,选取凯塞窗为
其中函数I[x]定义为:
x为函数I[x]的自变量,取并且有
N=10.4fs
其中fs为采样频率。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201310053338.9A CN103090884B (zh) | 2013-02-19 | 2013-02-19 | 基于捷联惯导系统的多普勒计程仪测速误差抑制方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201310053338.9A CN103090884B (zh) | 2013-02-19 | 2013-02-19 | 基于捷联惯导系统的多普勒计程仪测速误差抑制方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN103090884A true CN103090884A (zh) | 2013-05-08 |
CN103090884B CN103090884B (zh) | 2015-05-20 |
Family
ID=48203746
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201310053338.9A Expired - Fee Related CN103090884B (zh) | 2013-02-19 | 2013-02-19 | 基于捷联惯导系统的多普勒计程仪测速误差抑制方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN103090884B (zh) |
Cited By (10)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN103454662A (zh) * | 2013-09-04 | 2013-12-18 | 哈尔滨工程大学 | 一种基于ckf的sins/北斗/dvl组合对准方法 |
CN103940416A (zh) * | 2014-03-04 | 2014-07-23 | 哈尔滨工程大学 | 一种电磁计程仪辅助的auv多程序并行解算导航方法 |
CN104482943A (zh) * | 2014-12-22 | 2015-04-01 | 北京航空航天大学 | 一种多普勒计程仪刻度因子误差在线标定方法 |
CN104748763A (zh) * | 2015-03-19 | 2015-07-01 | 北京航天自动控制研究所 | 适用于车载晃动的捷联惯组快速对准方法 |
CN105091907A (zh) * | 2015-07-28 | 2015-11-25 | 东南大学 | Sins/dvl组合中dvl方位安装误差估计方法 |
CN107765032A (zh) * | 2017-09-10 | 2018-03-06 | 西安天和海防智能科技有限公司 | 多普勒测速仪速度修正方法及水下自主航行器导航误差修正方法 |
CN110542438A (zh) * | 2019-09-30 | 2019-12-06 | 中国船舶重工集团公司第七0七研究所 | 一种基于sins/dvl组合导航误差标定的方法 |
CN110763872A (zh) * | 2019-11-21 | 2020-02-07 | 中国船舶重工集团公司第七0七研究所 | 一种多普勒测速仪多参数在线标定方法 |
CN111060920A (zh) * | 2019-12-18 | 2020-04-24 | 重庆大学 | 一种消除调频连续波激光测距系统多普勒误差的方法 |
CN111323012A (zh) * | 2020-04-24 | 2020-06-23 | 东南大学 | 载体高动态环境下的ins辅助dvl测速误差补偿方法 |
Citations (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
RU2300081C1 (ru) * | 2005-11-07 | 2007-05-27 | Александр Викторович Захарин | Способ определения инструментальных погрешностей измерителей инерциальной навигационной системы на этапе начальной выставки |
CN101187567A (zh) * | 2007-12-18 | 2008-05-28 | 哈尔滨工程大学 | 基于多普勒的光纤陀螺捷联惯导系统初始姿态确定方法 |
-
2013
- 2013-02-19 CN CN201310053338.9A patent/CN103090884B/zh not_active Expired - Fee Related
Patent Citations (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
RU2300081C1 (ru) * | 2005-11-07 | 2007-05-27 | Александр Викторович Захарин | Способ определения инструментальных погрешностей измерителей инерциальной навигационной системы на этапе начальной выставки |
CN101187567A (zh) * | 2007-12-18 | 2008-05-28 | 哈尔滨工程大学 | 基于多普勒的光纤陀螺捷联惯导系统初始姿态确定方法 |
Non-Patent Citations (3)
Title |
---|
YUEYANG BEN ETC.: "DVL Aided Fine Alignment for Marine SINS", 《2011 IEEE INTERNATIONAL CONFERENCE ON MECHATRONICS AND AUTOMATION》 * |
曹冰: "动态环境下舰船瞬时线运动测量技术", 《中国优秀硕士学位论文全文数据库信息科技辑》 * |
鲍桂清等: "多普勒计程仪辅助捷联惯导初始对准技术研究", 《电光与控制》 * |
Cited By (14)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN103454662A (zh) * | 2013-09-04 | 2013-12-18 | 哈尔滨工程大学 | 一种基于ckf的sins/北斗/dvl组合对准方法 |
CN103454662B (zh) * | 2013-09-04 | 2016-06-29 | 哈尔滨工程大学 | 一种基于ckf的sins/北斗/dvl组合对准方法 |
CN103940416B (zh) * | 2014-03-04 | 2016-06-29 | 哈尔滨工程大学 | 一种电磁计程仪辅助的auv多程序并行解算导航方法 |
CN103940416A (zh) * | 2014-03-04 | 2014-07-23 | 哈尔滨工程大学 | 一种电磁计程仪辅助的auv多程序并行解算导航方法 |
CN104482943A (zh) * | 2014-12-22 | 2015-04-01 | 北京航空航天大学 | 一种多普勒计程仪刻度因子误差在线标定方法 |
CN104482943B (zh) * | 2014-12-22 | 2017-02-22 | 北京航空航天大学 | 一种多普勒计程仪刻度因子误差在线标定方法 |
CN104748763A (zh) * | 2015-03-19 | 2015-07-01 | 北京航天自动控制研究所 | 适用于车载晃动的捷联惯组快速对准方法 |
CN105091907A (zh) * | 2015-07-28 | 2015-11-25 | 东南大学 | Sins/dvl组合中dvl方位安装误差估计方法 |
CN105091907B (zh) * | 2015-07-28 | 2017-11-28 | 东南大学 | Sins/dvl组合中dvl方位安装误差估计方法 |
CN107765032A (zh) * | 2017-09-10 | 2018-03-06 | 西安天和海防智能科技有限公司 | 多普勒测速仪速度修正方法及水下自主航行器导航误差修正方法 |
CN110542438A (zh) * | 2019-09-30 | 2019-12-06 | 中国船舶重工集团公司第七0七研究所 | 一种基于sins/dvl组合导航误差标定的方法 |
CN110763872A (zh) * | 2019-11-21 | 2020-02-07 | 中国船舶重工集团公司第七0七研究所 | 一种多普勒测速仪多参数在线标定方法 |
CN111060920A (zh) * | 2019-12-18 | 2020-04-24 | 重庆大学 | 一种消除调频连续波激光测距系统多普勒误差的方法 |
CN111323012A (zh) * | 2020-04-24 | 2020-06-23 | 东南大学 | 载体高动态环境下的ins辅助dvl测速误差补偿方法 |
Also Published As
Publication number | Publication date |
---|---|
CN103090884B (zh) | 2015-05-20 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN103090884B (zh) | 基于捷联惯导系统的多普勒计程仪测速误差抑制方法 | |
CN109737956B (zh) | 一种基于双应答器的sins/usbl相位差紧组合导航定位方法 | |
Hegrenaes et al. | Model-aided INS with sea current estimation for robust underwater navigation | |
CN109579850B (zh) | 基于对水速度辅助惯导的深水智能导航方法 | |
CN103822636B (zh) | 一种空对地制导武器捷联寻的视线重构方法 | |
CN102213594A (zh) | 一种无人潜航器海流观测数据融合方法 | |
CN102323586B (zh) | 一种基于海流剖面的uuv辅助导航方法 | |
CN104316025B (zh) | 一种基于船体姿态信息估计海浪浪高的系统 | |
CN112987067B (zh) | 组合导航的洋流速度估计方法、装置和一种处理器 | |
CN111076728A (zh) | 基于dr/usbl的深潜载人潜水器组合导航方法 | |
CN108871379B (zh) | 一种dvl测速误差在线标定方法 | |
CN103809170B (zh) | 一种多普勒频偏修正方法及系统 | |
Qu et al. | Wind feed-forward control of a USV | |
Huang et al. | Weight self-adjustment Adams implicit filtering algorithm for attitude estimation applied to underwater gliders | |
CN103499347A (zh) | 基于准静态模型的船体形变测量技术 | |
CN110333369B (zh) | 基于水面gps校正的uuv的dvl测速系统及自适应去噪方法 | |
CN110703205B (zh) | 基于自适应无迹卡尔曼滤波的超短基线定位方法 | |
CN115096302A (zh) | 捷联惯性基导航系统信息滤波鲁棒对准方法、系统及终端 | |
CN117146830B (zh) | 一种自适应多信标航位推算和长基线的紧组合导航方法 | |
Cohen et al. | LiBeamsNet: AUV velocity vector estimation in situations of limited DVL beam measurements | |
CN102589551B (zh) | 一种基于小波变换的船用光纤陀螺信号实时滤波方法 | |
CN103335650A (zh) | 一种基于惯性测量单元的坐标失配测量方法 | |
Zhu et al. | Technology of SINS/USBL highly tightly coupled integrated navigation based on phase difference measurements | |
CN103940416B (zh) | 一种电磁计程仪辅助的auv多程序并行解算导航方法 | |
Wu et al. | A new integrated Gaussian-Markov process model for precision shipboard transfer alignment |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
C06 | Publication | ||
PB01 | Publication | ||
C10 | Entry into substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
C14 | Grant of patent or utility model | ||
GR01 | Patent grant | ||
CF01 | Termination of patent right due to non-payment of annual fee | ||
CF01 | Termination of patent right due to non-payment of annual fee |
Granted publication date: 20150520 Termination date: 20210219 |