CN110763188B - 一种适用于捷联惯导系统的带杆臂补偿的升沉测量方法 - Google Patents
一种适用于捷联惯导系统的带杆臂补偿的升沉测量方法 Download PDFInfo
- Publication number
- CN110763188B CN110763188B CN201910976972.7A CN201910976972A CN110763188B CN 110763188 B CN110763188 B CN 110763188B CN 201910976972 A CN201910976972 A CN 201910976972A CN 110763188 B CN110763188 B CN 110763188B
- Authority
- CN
- China
- Prior art keywords
- heave
- inertial navigation
- navigation system
- strapdown inertial
- 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.)
- Active
Links
Images
Classifications
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
- G01C5/00—Measuring height; Measuring distances transverse to line of sight; Levelling between separated points; Surveyors' levels
Landscapes
- Physics & Mathematics (AREA)
- Engineering & Computer Science (AREA)
- General Physics & Mathematics (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Navigation (AREA)
Abstract
本发明涉及一种适用于捷联惯导系统的带杆臂补偿的升沉测量方法,所述方法包括如下步骤:给定初始导航参数t=0时刻:捷联惯导系统初始对准得到初始纵摇姿态角θ(0)、初始横摇姿态角γ(0)、初始艏摇角ψ(0)、主航向角ζ(0);系统设置采样周期h,实时采集三个轴上陀螺和加速度计的输出信号;递推测量tk时刻载体坐标系b与半固定坐标系s的关系矩阵;利用方向余弦矩阵和加速度计的输出计算得到捷联惯导系统安装点处的升沉加速度;利用陀螺的输出和捷联惯导系统安装点与舰船重力中心点之间的杆臂误差在载体坐标系的投影得到重力中心处的升沉加速度;升沉滤波器F(k)对重力中心处的升沉加速度进行滤波处理。本发明实现了捷联惯导系统带杆臂补偿的的升沉测量,提高了船舶的可操作性。
Description
技术领域
本发明涉及升沉测量方法领域,尤其涉及一种适用于捷联惯导系统的带杆臂补偿的升沉测量方法领域。
背景技术
舰船在作业过程中会受到海浪等海洋环境因素扰动,被动地产生六自由度摇荡运动,即沿着三个坐标轴的旋转运动(横摇、纵摇、艏摇)和平移运动(横荡、纵荡、升沉),其中沿天向轴的升沉运动对舰船影响和危害最大。升沉运动的准确提取在舰船补给、气垫船登陆、货物(集装箱等)吊装搬运方面起着非常重要的作用,精确测量舰船升沉运动十分必要。传统测高方法(如气压测高法、无线电测高法等)的测量精度不高,受外部环境影响较大,对设备要求严格,不适用于海洋环境中的舰船升沉运动测量;而基于惯性导航系统的测量方法抗干扰性强,可在各种复杂环境下自主工作,并且短期精度高,稳定性好,是目前舰船升沉运动测量的主要手段。
但是在已发表的文章中,如在《Optik-International Journal for Light andElectron Optics》第125卷第14期的刘建业、曾庆化的一篇《A Kalman filter algorithmbased on exact modeling for FOG GPS/SINS integration》文章中利用惯导与卫星组合测量升沉,其虽能达到米级的舰船绝对定位精度,但海洋环境下卫星信号易受干扰,测量结果不能满足升沉应用中厘米级的短时相对测量精度要求。还有在《仪器仪表学报》第33卷第1期的孙伟、孙枫的一篇《基于惯导解算的舰船升沉测量技术》文章中分析了捷联惯导系统解算过程对舰船升沉测量的影响,总结了测量升沉运动的具体实施方案并提出利用数字高通滤波器完成对海浪等高频扰动的分离,但存在相位误差的问题。严恭敏、苏幸君、翁浚、秦永元在《导航定位学报》第4卷第2期的《基于惯导和无时延滤波器的舰船升沉测量》文章中采用了无时延滤波器来进行升沉测量,解决了相位误差的问题,但存在低频衰减较慢并且收敛时间较长的缺点。
以上已发表的文章都对升沉测量进行了叙述和探究,但是都没有考虑实际工程应用中捷联惯导系统安装点与舰船重力中心点、观测点与舰船重力中心点之间的杆臂误差对升沉信息产生的影响。捷联惯导系统安装点与舰船重力中心点之间的杆臂误差将会产生干扰加速度,干扰加速度通过升沉滤波器将会产生一个瞬态脉冲响应,导致测量的升沉信息产生振荡。观测点与舰船重力中心点通常不在同一点,它们之间的杆臂误差与横纵摇相互作用也会产升升沉误差。因此研究一种带杆臂补偿的舰船升沉测量方法具有创新性和实际工程价值。
发明内容
本发明的目的在于针对舰船的升沉测量问题提供了一种适用于捷联惯导系统的带杆臂补偿的升沉测量方法,能够实现精确的升沉测量。
本发明是这样实现的:
一种适用于捷联惯导系统的带杆臂补偿的升沉测量方法,所述方法包括如下步骤:
(1)给定初始导航参数t=0时刻:捷联惯导系统初始对准得到初始纵摇姿态角θ(0)、初始横摇姿态角γ(0)、初始艏摇角ψ(0)、主航向角ζ(0);捷联惯导系统安装点INS与舰船重力中心点COG之间的杆臂误差在载体坐标系的投影为其中为捷联惯导系统安装点INS与舰船重力中心点COG之间的杆臂误差在载体坐标系中x方向的投影,为捷联惯导系统安装点INS与舰船重力中心点COG之间的杆臂误差在载体坐标系中y方向的投影,为捷联惯导系统安装点INS与舰船重力中心点COG之间的杆臂误差在载体坐标系中z方向的投影;升沉观测点M与舰船重力中心点COG之间的杆臂误差在载体坐标系的投影为其中为升沉观测点M与舰船重力中心点COG之间的杆臂误差在载体坐标系中x方向的投影,为升沉观测点M与舰船重力中心点COG之间的杆臂误差在载体坐标系中y方向的投影,为升沉观测点M与舰船重力中心点COG之间的杆臂误差在载体坐标系中z方向的投影;
(2)系统设置采样周期h,实时采集三个轴上陀螺和加速度计的输出信号;升沉解算周期H,升沉解算周期循环标志k=0,1,2…,即tk到tk+1时间段代表一个升沉解算周期H,升沉解算周期等于系统采样周期,即H=h;
(3)递推测量tk时刻载体坐标系b与半固定坐标系s的关系矩阵;
所述步骤(3)中,由时刻姿态信息纵摇角θ(k)、横摇角γ(k)、艏摇角ψ(k)和主航向角ζ(k)构成载体坐标系b与半固定坐标系s的关系矩阵
其中:
其中:
所述步骤(6)中,重力中心处的升沉位移信息pCOG(k)的计算方法为:
其中:
其中exp()代表指数函数,ωc为升沉滤波器的截止频率,一般选择ωc大于海浪运动中的最长海浪周期的三分之一;h为捷联惯导系统的采样周期。
所述步骤(7)中,所述观测点M处升沉信息pM(k)其计算方法为:
其中,pCOG(k)为重力中心点COG处的升沉信息。
本发明的有益效果是:本发明实现了捷联惯导系统带杆臂补偿的的升沉测量,提高了船舶的可操作性。有利于舰载机的起降、舰载武器的发射、气垫船登陆、潜艇浅水行使、钻井平台升沉补偿装置设计、舰船补给等许多方面。
附图说明
图1为本发明的适用于捷联惯导系统的带杆臂补偿的升沉测量方法流程图。
具体实施方式
下面结合附图对本发明做更详细地描述。
一种适用于捷联惯导系统的带杆臂补偿的升沉测量方法,包括如下步骤:
步骤1.给定初始导航参数(t=0时刻):捷联惯导系统初始对准得到初始纵摇姿态角θ(0)、初始横摇姿态角γ(0)、初始艏摇角ψ(0)、主航向角ζ(0);捷联惯导系统安装点与舰船重力中心点之间的杆臂误差在载体坐标系的投影升沉观测点M与舰船重力中心点之间的杆臂误差在载体坐标系的投影
步骤2、系统设置采样周期h,实时采集三个轴上陀螺和加速度计的输出信号;升沉解算周期H,升沉解算周期循环标志k=0,1,2…,即tk到tk+1时间段代表一个升沉解算周期H。升沉解算周期等于系统采样周期,即H=h。
步骤3、递推测量tk时刻载体坐标系b与半固定坐标系s的关系矩阵。利用时刻姿态信息:纵摇角θ(k)、横摇角γ(k)、艏摇角ψ(k),主航向角ζ(k)构成载体坐标系b与半固定坐标系s的关系矩阵
其中
C11(k)=cosζ(k)(cosγ(k)·cosψ(k)+sinγ(k)·sinψ(k)·sinθ(k))-sinζ(k)·sinψ(k)·cosθ(k)
C12(k)=sinζ(k)(cosγ(k)·cosψ(k)+sinγ(k)·sinψ(k)·sinθ(k))-cosζ(k)·sinψ(k)·cosθ(k)
C13(k)=sinγ(k)·cosψ(k)-cosγ(k)·sinψ(k)·sinθ(k)
C21(k)=cosζ(k)(-cosγ(k)·sinψ(k)+sinγ(k)·cosψ(k)·sinθ(k))-sinζ(k)·cosψ(k)·cosθ(k)
C22(k)=-sinζ(k)(-cosγ(k)·sinψ(k)+sinγ(k)·cosψ(k)·sinθ(k))+cosζ(k)·cosψ(k)·cosθ(k)
C23(k)=-sinγ(k)·sinψ(k)-cosγ(k)·cosψ(k)·sinθ(k)
C31(k)=cosζ(k)(-sinγ(k)·cosθ(k))-sinζ(k)·sinθ(k)
C32(k)=sinζ(k)(-sinγ(k)·cosθ(k))+cosζ(k)·sinθ(k)
C33(k)=cosγ(k)·cosθ(k)
其中:
其中
其中exp()代表指数函数,ωc为升沉滤波器的截止频率,一般选择ωc大于海浪运动中的最长海浪周期的三分之一;h为捷联惯导系统的采样周期;
至此就完成了补偿杆臂效应的舰船升沉更新。
综上所述,本发明提供的是捷联惯导系统的一种带杆臂补偿的舰船升沉测量方法。包括:给定初始导航参数(t=0时刻):捷联惯导系统初始对准得到初始纵摇姿态角θ(0)、初始横摇姿态角γ(0)、初始艏摇角ψ(0)、主航向角ζ(0);捷联惯导系统安装点与舰船重力中心点之间的杆臂误差在载体坐标系的投影升沉观测点M与舰船重力中心点之间的杆臂误差在载体坐标系的投影系统设置采样周期h,实时采集三个轴上陀螺和加速度计的输出信号;利用时刻姿态信息:纵摇角θ(k)、横摇角γ(k)、艏摇角ψ(k),主航向角ζ(k)构成载体坐标系b与半固定坐标系s的关系矩阵;利用上述得到的方向余弦矩阵和加速度计的输出计算得到捷联惯导系统安装点处的升沉加速度利用陀螺的输出 和捷联惯导系统安装点与舰船重力中心点之间的杆臂误差在载体坐标系的投影得到重力中心处的升沉加速度升沉滤波器F(k)对重力中心处的升沉加速度进行滤波处理获得重力中心处的升沉位移信息pCOG(k);利用方向余弦矩阵和升沉观测点M与舰船重力中心点之间的杆臂误差在载体坐标系的投影得到补偿杆臂效应的观测点M处升沉信息。至此就完成了补偿杆臂效应的舰船升沉更新。
Claims (5)
1.一种适用于捷联惯导系统的带杆臂补偿的升沉测量方法,其特征在于:所述方法包括如下步骤:
(1)给定初始导航参数t=0时刻:捷联惯导系统初始对准得到初始纵摇姿态角θ(0)、初始横摇姿态角γ(0)、初始艏摇角ψ(0)、主航向角ζ(0);捷联惯导系统安装点INS与舰船重力中心点COG之间的杆臂误差在载体坐标系的投影为 其中为捷联惯导系统安装点INS与舰船重力中心点COG之间的杆臂误差在载体坐标系中x方向的投影,为捷联惯导系统安装点INS与舰船重力中心点COG之间的杆臂误差在载体坐标系中y方向的投影,为捷联惯导系统安装点INS与舰船重力中心点COG之间的杆臂误差在载体坐标系中z方向的投影;升沉观测点M与舰船重力中心点COG之间的杆臂误差在载体坐标系的投影为 其中为升沉观测点M与舰船重力中心点COG之间的杆臂误差在载体坐标系中x方向的投影,为升沉观测点M与舰船重力中心点COG之间的杆臂误差在载体坐标系中y方向的投影,为升沉观测点M与舰船重力中心点COG之间的杆臂误差在载体坐标系中z方向的投影;
(2)系统设置采样周期h,实时采集三个轴上陀螺和加速度计的输出信号;升沉解算周期H,升沉解算周期循环标志k=0,1,2…,即tk到tk+1时间段代表一个升沉解算周期H,升沉解算周期等于系统采样周期,即H=h;
(3)递推测量tk时刻载体坐标系b与半固定坐标系s的关系矩阵;
所述步骤(3)中,由时刻姿态信息纵摇角θ(k)、横摇角γ(k)、艏摇角ψ(k)和主航向角ζ(k)构成载体坐标系b与半固定坐标系s的关系矩阵
其中:
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201910976972.7A CN110763188B (zh) | 2019-10-15 | 2019-10-15 | 一种适用于捷联惯导系统的带杆臂补偿的升沉测量方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201910976972.7A CN110763188B (zh) | 2019-10-15 | 2019-10-15 | 一种适用于捷联惯导系统的带杆臂补偿的升沉测量方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN110763188A CN110763188A (zh) | 2020-02-07 |
CN110763188B true CN110763188B (zh) | 2021-07-23 |
Family
ID=69331111
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201910976972.7A Active CN110763188B (zh) | 2019-10-15 | 2019-10-15 | 一种适用于捷联惯导系统的带杆臂补偿的升沉测量方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN110763188B (zh) |
Families Citing this family (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN111174974B (zh) * | 2020-02-17 | 2021-07-30 | 燕山大学 | 一种车辆悬架升沉测量方法及系统 |
CN112629540B (zh) * | 2020-12-16 | 2024-02-09 | 北京航天控制仪器研究所 | 一种基于载体姿态信息的升沉测量方法 |
CN113703020B (zh) * | 2021-01-30 | 2023-12-05 | 东南大学 | 一种海面小型目标升沉运动测量方法 |
CN113175942B (zh) * | 2021-04-02 | 2023-03-17 | 上海机电工程研究所 | 动态环境下的杆臂速度补偿方法、系统及介质 |
CN113175943A (zh) * | 2021-04-21 | 2021-07-27 | 哈尔滨工程大学 | 一种采用多重低通滤波单元的捷联惯导升沉测量方法 |
CN113432621A (zh) * | 2021-06-24 | 2021-09-24 | 中国船舶重工集团公司第七0七研究所 | 一种基于摇摆台的捷联惯导系统时延测试方法 |
CN115201866B (zh) * | 2022-09-16 | 2022-12-09 | 中国船舶重工集团公司第七0七研究所 | 一种大型水面舰船惯导及北斗紧耦合方案空间修正方法 |
Citations (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN109682376A (zh) * | 2019-02-19 | 2019-04-26 | 合肥楚航科技有限公司 | 一种利用惯性导航系统对物体垂直方向进行定位的方法 |
Family Cites Families (15)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US5349347A (en) * | 1993-03-29 | 1994-09-20 | Alliedsignal Inc. | Method and apparatus for correcting dynamically induced errors in static pressure, airspeed and airspeed rate |
JPH10132565A (ja) * | 1996-10-25 | 1998-05-22 | Kaijo Corp | ヒービング計測装置及びその方法 |
US5870912A (en) * | 1997-10-10 | 1999-02-16 | Lawman Armor Corporation | Anti-theft brake locking device |
WO2002039138A1 (en) * | 2000-11-06 | 2002-05-16 | Lin Ching Fang | Positioning and ground proximity warning method and system thereof for vehicle |
CN101793521B (zh) * | 2010-01-06 | 2012-10-31 | 哈尔滨工程大学 | 基于光纤陀螺惯性测量系统的舰船横纵荡信息测量方法 |
CN103115625A (zh) * | 2013-02-28 | 2013-05-22 | 中国海洋石油总公司 | 一种浮体横纵荡及升沉运动的测量方法及系统 |
CN103954282B (zh) * | 2014-03-04 | 2016-09-14 | 哈尔滨工程大学 | 基于加速度计输出增量的捷联惯性导航方法 |
CN103900568B (zh) * | 2014-03-08 | 2016-06-29 | 哈尔滨工程大学 | 一种改进的捷联惯性导航系统快速阻尼方法 |
CN103940429A (zh) * | 2014-03-21 | 2014-07-23 | 哈尔滨工程大学 | 一种惯性导航系统横坐标系下载体姿态的实时测量方法 |
KR101946492B1 (ko) * | 2017-02-16 | 2019-02-11 | 삼영이엔씨 (주) | 위성 신호를 이용한 선박의 상하운동 측정방법 및 시스템 |
CN109425339B (zh) * | 2017-08-21 | 2022-09-27 | 哈尔滨工程大学 | 一种基于惯性技术的考虑杆臂效应的舰船升沉误差补偿方法 |
CN109443356A (zh) * | 2019-01-07 | 2019-03-08 | 大连海事大学 | 一种含测量噪声的无人船位置与速度估计结构及设计方法 |
CN109883392B (zh) * | 2019-03-08 | 2021-07-16 | 哈尔滨工程大学 | 一种基于相位补偿的捷联惯导升沉测量方法 |
CN110296688A (zh) * | 2019-05-16 | 2019-10-01 | 武汉新瑞通达信息技术有限公司 | 一种基于被动地理定位技术的侦测一体倾斜航测吊舱 |
CN110702110A (zh) * | 2019-10-16 | 2020-01-17 | 江苏科技大学 | 一种基于无迹卡尔曼滤波的舰船升沉运动测量方法 |
-
2019
- 2019-10-15 CN CN201910976972.7A patent/CN110763188B/zh active Active
Patent Citations (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN109682376A (zh) * | 2019-02-19 | 2019-04-26 | 合肥楚航科技有限公司 | 一种利用惯性导航系统对物体垂直方向进行定位的方法 |
Also Published As
Publication number | Publication date |
---|---|
CN110763188A (zh) | 2020-02-07 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN110763188B (zh) | 一种适用于捷联惯导系统的带杆臂补偿的升沉测量方法 | |
CN110031882B (zh) | 一种基于sins/dvl组合导航系统的外量测信息补偿方法 | |
CN109443379A (zh) | 一种深海潜航器的sins/dvl水下抗晃动对准方法 | |
CN109425339B (zh) | 一种基于惯性技术的考虑杆臂效应的舰船升沉误差补偿方法 | |
Ishibashi et al. | Accuracy improvement of an inertial navigation system brought about by the rotational motion | |
RU2348903C1 (ru) | Способ определения навигационных параметров бесплатформенной инерциальной навигационной системой | |
Ishibashi et al. | The rotation control system to improve the accuracy of an inertial navigation system installed in an autonomous underwater vehicle | |
CN105509769B (zh) | 一种运载火箭捷联惯导全自主对准方法 | |
CN103439727B (zh) | 一种地面坐标的测量方法 | |
CN107063198A (zh) | 一种船载自稳定云台测量系统及应用方法 | |
CN101617199A (zh) | 一种用于补偿位置测量设备中的漂移的方法 | |
CN109269526B (zh) | 基于阻尼网络的旋转式格网惯导水平阻尼方法 | |
CN111829512A (zh) | 一种基于多传感器数据融合的auv导航定位方法及系统 | |
CN104776847B (zh) | 一种适用于水下导航系统单点估计陀螺漂移的方法 | |
CN110186461A (zh) | 一种基于重力梯度信息测距的协同导航方法 | |
WO2022222939A1 (zh) | 一种采用多重低通滤波单元的捷联惯导升沉测量方法 | |
CN111722295B (zh) | 一种水下捷联式重力测量数据处理方法 | |
CN108413982B (zh) | 一种舰船动态对准位置杆臂补偿方法 | |
CN112611382B (zh) | 一种带有相位补偿的捷联惯导系统升沉测量方法 | |
WO2021253487A1 (zh) | 水下导航与重力测量一体化系统 | |
CN115235460B (zh) | 基于法向量位置模型的船舶惯导容错阻尼方法及系统 | |
CN112629540B (zh) | 一种基于载体姿态信息的升沉测量方法 | |
CN105928513B (zh) | 一种基于位置姿态测量系统的机载合成孔径雷达运动参数测量方法 | |
CN113375626A (zh) | 一种基于惯性装置的空间矢量相对平行度测量方法 | |
CN111307179A (zh) | 一种高动态无人机的加速度计干扰加速度自补偿方法 |
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 |