CN109425339B - 一种基于惯性技术的考虑杆臂效应的舰船升沉误差补偿方法 - Google Patents
一种基于惯性技术的考虑杆臂效应的舰船升沉误差补偿方法 Download PDFInfo
- Publication number
- CN109425339B CN109425339B CN201710717244.5A CN201710717244A CN109425339B CN 109425339 B CN109425339 B CN 109425339B CN 201710717244 A CN201710717244 A CN 201710717244A CN 109425339 B CN109425339 B CN 109425339B
- Authority
- CN
- China
- Prior art keywords
- heave
- ship
- coordinate system
- error
- lever arm
- 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
- 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
Landscapes
- Engineering & Computer Science (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Automation & Control Theory (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Navigation (AREA)
Abstract
本发明公开一种基于惯性技术的考虑杆臂效应的舰船升沉误差补偿方法,属于船舶导航技术领域。本发明首先建立舰船研究对象建立载体与地理坐标坐标系,采集传感器数据;然后计算舰船的横摇γ纵摇θ和解算加速度;再通过积分运算、数字滤波和再次积分得到补偿前的升沉H;其次计算误差升沉;最后用未补偿的升沉Hins减去误差升沉Hi得到补偿后的升沉Hout。在惯性导航***的基础上,建立升沉解算误差补偿模型,不仅仅利用捷联惯导姿态角输出信息,而且利用了惯性测量元件安装的杆臂信息。该方法大大降低了惯性测量元件安装的局限性,从而提高舰船升沉精度,进而提高惯性导航***的导航精度。
Description
技术领域
本发明涉及一种基于惯性技术的考虑杆臂效应的舰船升沉误差补偿方法,属于船舶导航技术领域。
背景技术
随着惯性导航***(Inertial Navigation System,INS)和惯性测量技术的迅速发展,惯性导航***在舰船导航中的应用也逐渐深入,且对其导航的精确性和功能性要求也不断提升。惯导***所能提供的速度、位置、姿态信息已经不能完全满足使用者的需求,特别是当海况恶劣且舰船的航行状态不稳定时,舰船瞬时运动信息的准确提取对舰载武器的对准、舰载飞行器升降控制有十分重要的意义。
舰船在海上航行过程中,会受到海浪和海风等复杂海洋环境因素的激励,会产生6自由度的摇荡运动,其中包括6个角运动即纵摇、横摇和艏摇,以及3个线运动即横荡、纵荡和垂荡(即升沉)。目前舰升沉通常由舰船上的惯性测量组件实时监测获得。惯性测量组件核心部件由一个体积很小的捷联惯性测量单元构成,包括3个加速度计、3个光纤陀螺仪和一个实时处理计算单元。3个加速度计主要用于监测运动物体在3个坐标轴上的轴向线性加速度,舰船升沉解算通常用高通数字滤波器滤除导航***中舒勒振荡和加速度计偏值测量误差的影响,再经过线性加速度二次积分得到垂向位置偏移,进而获得准确的升沉运动信息。而大多数升沉模型通常把船舶的质心与惯性器件看成一体,把惯性测量组件解算出的升沉当作是船舶质心的升沉。而实际应用中,质心通常无法与取得一致,两者间的存在杆臂。传统意义上杆臂效应是指由于惯性组件安装位置与载体摇摆中心不重合带来的离心加速度和切向加速度所引起的加速度计测量误差。而升沉解算需要的加速度信息来自加速度计,这间接地导致惯性测量算出的升沉与船舶质心处的升沉不同。若要解算船舶质心处升沉,则必须惯性测量组件解算出的升沉进行补偿归算。
发明内容
本发明的目的是为了解决上述问题,提供一种基于惯性技术的考虑杆臂效应的舰船升沉误差补偿方法。
本发明的目的是通过以下步骤实现的:
一种基于惯性技术的考虑杆臂效应的舰船升沉误差补偿方法,其特征在于,包含以下步骤:
步骤一以船舶质心为原点,建立舰船载体坐标系b系和当地地理坐标系t系;载体坐标系中,x轴指向船首,y轴指向右弦,z轴垂直于x、y轴构成平面向天;惯性导航初始对准后(粗对准与精对准),利用四元数法计算并实时更新三个姿态角即横摇γ纵摇θ航向和捷联矩阵其中是舰船载体坐标系b系与地理坐标系t系的关系矩阵;
步骤三对步骤二中的加速度ft信息一次积分,得到速度vin,其中积分时间为惯导解算采样时间0.01s;公式为:
其中t-t0=0.01s,v0为上一时刻的速度值;
设计并运用巴特沃斯高通数字滤波器,滤除舒勒周期对升沉运动的干扰,提取线运动升沉信息;其中巴特沃斯高通数字滤波器为转移函数差分方程为:
其中Fb[0]、Fb[1]、Fb[2]、Fb[3];Fa[0]、Fa[1]、Fa[2]、Fa[3]为滤波器系数;滤波输出得到速度信息vfilter,对vfilter再次积分得到补偿前的升沉Hins;公式如下:
其中t-t0=0.01s,H0为上一时刻补偿前的升沉;
步骤四测量惯性测量组件安装位置相对于船舶质心位置的杆臂长度L1、L2、L3;其中 L1是x轴的分量,L2是y轴分量,L3是z轴分量;其补偿部分为由杆臂引起的误差升沉;该部分为升沉的主要误差,其数学模型为:
Hi=Z-L3=L1 sinθ-L2 sinγcosθ+L3(cosγcosθ-1) (4)
式中,Z为地理坐标系下的惯性测量组件安装处与船舶质心处(坐标系原点)的动态垂向位移差;其公式为:
Z=L1 sinθ-L2 sinγcosθ+L3 cosγcosθ (5)
式中L3为载体坐标系下z轴的杆臂;
步骤五由补偿前的升沉Hins和误差升沉Hi得到补偿后的升沉Hout;公式为:
Hout=Hins-Hi (6)
舰船的升沉补偿完成。
本发明的优点在于:
(1)减小舰船的升沉误差;
(2)惯性测量组件无需安装在船舶质心处,只需要提供惯性测量原件距质心的杆臂与所处位置的横纵摇信息,便可以求出船舶整体的升沉,降低导航设备安装局限性。
附图说明
图1是本发明的步骤流程图;
图2是本发明的原理图;
图3是本发明利用Matlab仿真输入的升沉真实值;
图4是本发明利用Matlab仿真得到的升沉补偿前后对比图(第一组仿真实验);
图5是本发明利用Matlab仿真得到的升沉补偿前后对比图(第二组仿真实验);
图6是本发明利用Matlab仿真得到的升沉补偿前后对比图(第三组仿真实验)。
具体实施方式
下面结合附图对本发明做进一步描述。
步骤一:以船舶质心为原点,建立舰船载体坐标系b系和当地地理坐标系t系。载体坐标系中,x轴指向船首,y轴指向右弦,z轴垂直于x、y轴构成平面向天。惯性导航初始对准后(粗对准与精对准),利用四元数法计算并实时更新三个姿态角即横摇γ纵摇θ航向和捷联矩阵其中是舰船载体坐标系b系与地理坐标系t系的关系矩阵。
步骤三:对步骤二中的加速度ft信息一次积分,得到速度vin,其中积分时间为惯导解算采样时间0.01s。公式为
其中t-t0=0.01s,v0为上一时刻的速度值。
设计并运用巴特沃斯高通数字滤波器,滤除舒勒周期对升沉运动的干扰,提取线运动升沉信息。其中巴特沃斯高通数字滤波器为转移函数差分方程为:
其中Fb[0]、Fb[1]、Fb[2]、Fb[3];Fa[0]、Fa[1]、Fa[2]、Fa[3]为滤波器系数。滤波输出得到速度信息vfilter,对vfilter再次积分得到补偿前的升沉Hins。公式如下
其中t-t0=0.01s,H0为上一时刻补偿前的升沉。
步骤四:测量惯性测量组件安装位置相对于船舶质心位置的杆臂长度L1、L2、L3。其中 L1是x轴的分量,L2是y轴分量,L3是z轴分量。其补偿部分为由杆臂引起的误差升沉。该部分为升沉的主要误差,其数学模型为:
Hi=Z-L3=L1 sinθ-L2 sinγcosθ+L3 (cosγcosθ-1) (4)
式中,Z为地理坐标系下的惯性测量组件安装处与船舶质心处(坐标系原点)的动态垂向位移差。其公式为
Z=L1 sinθ-L2 sinγcosθ+L3 cosγcosθ (5)
式中L3为载体坐标系下z轴的杆臂。
步骤五:由补偿前的升沉Hins和误差升沉Hi得到补偿后的升沉Hout。公式为
Hout=Hins-Hi (6)
舰船的升沉补偿完成。
对本发明的有益效果说明如下:
MATLAB仿真
(1)在以下的仿真条件下,对该方法进行仿真实验:
捷联导航***基本参数:
载体初始位置:北纬45.796度,东经126.6705度;
载体姿态角:
γ=10度*sin(2*pi*k*hn/T_p),其中T_p为纵摇周期10秒,k等于1800000。
θ=5度*sin(2*pi*k*hn/T_r),其中T_r为横摇周期10秒,k等于1800000。
φ=0度;其中γ,θ,φ分别表示舰船的横摇角纵摇角和航向角;
载体姿态误差角:γ=0度,θ=0度,φ=0度;其中γ,θ,φ分别表示舰船的横摇角纵摇角和航向角;
赤道半径:Re=6378393米
地球自转角速度(弧度/秒):
地球表面重力加速度:g0=9.78049;
陀螺仪常值漂移:0度/小时;
加速度计零偏:0米/秒平方
采样频率hn=0.01s
仿真时间t=5小时。
升沉解算参数:
三阶巴特沃斯差分方程系数如下:
Fb[0]=0.999476538272341;Fb[1]=-2.998429614817024;
Fb[2]=2.998429614817024;Fb[3]=-0.999476538272341;
Fa[0]=1.000000000000000;Fa[1]=-2.998952802460766;
Fa[2]=2.997906153161101;Fa[3]=-0.998953350556863;
升沉真实值为1*sin(2*pi*k*hn/T_heave)米,其中T_heave为10秒,k等于1800000
载体坐标系下的惯性测量元件杆臂长度L1=2.1米、L2=0.6米、L3=3.1米。
上述发明方法未补偿的升沉值Hins幅值为1.26米、补偿后升沉值Hout幅值为0.961米。补偿后的升沉误差为3.9厘米,而惯性测量组件升沉精度为5厘米,补偿效果良好。
(2)改变载体姿态角,对比仿真1,考察对不同姿态角的升沉补偿效果。在以下的仿真条件下,对该方法进行仿真实验:
捷联导航***基本参数:
载体初始位置:北纬45.796度,东经126.6705度;
载体姿态角:
γ=15度*sin(2*pi*k*hn/T_p),其中T_p为纵摇周期10秒,k等于1800000。
θ=10度*sin(2*pi*k*hn/T_r),其中T_r为横摇周期10秒,k等于1800000。
φ=0度;其中γ,θ,φ分别表示舰船的横摇角纵摇角和航向角;
载体姿态误差角:γ=0度,θ=0度,φ=0度;其中γ,θ,φ分别表示舰船的横摇角纵摇角和航向角;赤道半径:Re=6378393米;
地球自转角速度(弧度/秒);
地球表面重力加速度:g0=9.78049;
陀螺仪常值漂移:0度/小时;
加速度计零偏:0米/秒平方;
采样频率hn=0.01s;
仿真时间t=5小时;
上述发明方法未补偿升沉值Hins幅值为1.67米、补偿后升沉值Hout幅值为0.968米。补偿后的误差3.2厘米,而惯性测量组件升沉精度为5厘米,补偿效果良好。
升沉解算参数:
三阶巴特沃斯差分方程系数如下:
Fb[0]=0.999476538272341;Fb[1]=-2.998429614817024;
Fb[2]=2.998429614817024;Fb[3]=-0.999476538272341;
Fa[0]=1.000000000000000;Fa[1]=-2.998952802460766;
Fa[2]=2.997906153161101;Fa[3]=-0.998953350556863;
升沉真实值为1*sin(2*pi*k*hn/T_heave)米,其中T_heave为升沉周期10秒,k等于1800000
载体坐标系下的惯性测量元件杆臂长度L1=2.1米、L2=0.6米、L3=3.1米。
发明所述方法得到补偿前升沉Hins幅值为米、补偿后升沉值Hout为0.977米。补偿后的升沉误差2.3厘米,而惯性测量组件升沉精度为5厘米,补偿效果良好。
(3)改变杆臂参数,对比仿真1,考察对不同杆臂对升沉补偿效果的影响。在以下的仿真条件下,对该方法进行仿真实验:
捷联导航***基本参数:
载体初始位置:北纬45.796度,东经126.6705度;
载体姿态角:
γ=10度*sin(2*pi*k*hn/T_p),其中T_p为10秒,k等于1800000。
θ=5度*sin(2*pi*k*hn/T_r),其中T_r为10秒,k等于1800000。
φ=0度;其中γ,θ,φ分别表示舰船的横摇角纵摇角和航向角;
载体姿态误差角:γ=0度,θ=0度,φ=0度;其中γ,θ,φ分别表示舰船的横摇角纵摇角和航向角;
赤道半径:Re=6378393米
地球自转角速度(弧度/秒):
地球表面重力加速度:g0=9.78049;
陀螺仪常值漂移:0度/小时;
加速度计零偏:0米/秒平方
采样频率hn=0.01s
仿真时间t=5小时。
升沉解算参数:
三阶巴特沃斯差分方程系数如下:
Fb[0]=0.999476538272341;Fb[1]=-2.998429614817024;
Fb[2]=2.998429614817024;Fb[3]=-0.999476538272341;
Fa[0]=1.000000000000000;Fa[1]=-2.998952802460766;
Fa[2]=2.997906153161101;Fa[3]=-0.998953350556863;
升沉真实值幅值为1*sin(2*pi*k*hn/T_heave)米,其中T_heave为升沉周期10秒,k 等于1800000,
载体坐标系下的杆臂长度L1=1.1米、L2=0.3米、L3=1.5米。
发明所述方法未补偿的升沉值Hins幅值为1.09米、补偿后升沉值Hout幅值为0.98米。补偿后的误差2.0厘米,而惯性测量组件升沉精度为5厘米,补偿效果良好。
Claims (1)
1.一种基于惯性技术的考虑杆臂效应的舰船升沉误差补偿方法,其特征在于,包含以下步骤:
步骤一:以船舶质心为原点,建立舰船载体坐标系b系和地理坐标系t系;舰船载体坐标系b系中,x轴指向船首,y轴指向右弦,z轴垂直于x、y轴构成平面向天;惯性导航初始对准后,利用四元数法计算并实时更新三个姿态角即横摇γ纵摇θ航向和捷联矩阵其中是舰船载体坐标系b系与地理坐标系t系的关系矩阵;
步骤三:对步骤二中的加速度信息ft一次积分,得到速度vin,其中积分时间为惯导解算采样时间0.01s;公式为:
其中,t-to=0.01s,v0为上一时刻的速度值;
设计并运用巴特沃斯高通数字滤波器,滤除舒勒周期对升沉运动的干扰,提取线运动升沉信息;其中巴特沃斯高通数字滤波器的转移函数差分方程为:
其中Fb[0]、Fb[1]、Fb[2]、Fb[3]、Fa[0]、Fa[1]、Fa[2]、Fa[3]为滤波器系数;滤波输出得到速度信息vfilter,对vfilter再次积分得到补偿前的升沉Hins;公式如下:
其中t-to=0.01s,H0为上一时刻补偿前的升沉;
步骤四:测量惯性测量组件安装位置相对于船舶质心位置的杆臂长度L1、L2、L3;其中L1是x轴的分量,L2是y轴分量,L3是z轴分量;其补偿部分为由杆臂引起的误差升沉;该部分为升沉的主要误差,其数学模型为:
Hi=Z-L3=L1sinθ-L2sinγcosθ+L3(cosγcosθ-1) (4)
式中,Z为地理坐标系t系下的惯性测量组件安装处与船舶质心处的动态垂向位移差;其公式为:
Z=L1sinθ-L2sinγcosθ+L3cosγcosθ (5)
步骤五:由补偿前的升沉Hins和误差升沉Hi得到补偿后的升沉Hout;公式为:
Hout=Hins-Hi (6)
舰船的升沉补偿完成。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201710717244.5A CN109425339B (zh) | 2017-08-21 | 2017-08-21 | 一种基于惯性技术的考虑杆臂效应的舰船升沉误差补偿方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201710717244.5A CN109425339B (zh) | 2017-08-21 | 2017-08-21 | 一种基于惯性技术的考虑杆臂效应的舰船升沉误差补偿方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN109425339A CN109425339A (zh) | 2019-03-05 |
CN109425339B true CN109425339B (zh) | 2022-09-27 |
Family
ID=65497592
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201710717244.5A Active CN109425339B (zh) | 2017-08-21 | 2017-08-21 | 一种基于惯性技术的考虑杆臂效应的舰船升沉误差补偿方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN109425339B (zh) |
Families Citing this family (9)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN110057383B (zh) * | 2019-05-05 | 2023-01-03 | 哈尔滨工程大学 | 一种auv推位导航***杆臂误差标校方法 |
CN110763188B (zh) * | 2019-10-15 | 2021-07-23 | 哈尔滨工程大学 | 一种适用于捷联惯导***的带杆臂补偿的升沉测量方法 |
CN111174974B (zh) * | 2020-02-17 | 2021-07-30 | 燕山大学 | 一种车辆悬架升沉测量方法及*** |
CN112629525B (zh) * | 2020-11-13 | 2022-09-06 | 河北汉光重工有限责任公司 | 一种基于历史数据互相关进行舰船升沉相位补偿的方法 |
CN112629540B (zh) * | 2020-12-16 | 2024-02-09 | 北京航天控制仪器研究所 | 一种基于载体姿态信息的升沉测量方法 |
CN112945274B (zh) * | 2021-02-05 | 2022-11-18 | 哈尔滨工程大学 | 一种舰船捷联惯导***航行间粗对准方法 |
CN113175942B (zh) * | 2021-04-02 | 2023-03-17 | 上海机电工程研究所 | 动态环境下的杆臂速度补偿方法、***及介质 |
CN113175943A (zh) * | 2021-04-21 | 2021-07-27 | 哈尔滨工程大学 | 一种采用多重低通滤波单元的捷联惯导升沉测量方法 |
CN117288188B (zh) * | 2023-11-27 | 2024-03-19 | 中国船舶集团有限公司第七〇七研究所 | 一种波浪升沉测量补偿计算方法 |
Family Cites Families (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US6836707B2 (en) * | 2002-05-30 | 2004-12-28 | Honeywell International Inc. | Methods and systems for determining heave and heave rate of vessels |
WO2010138624A1 (en) * | 2009-05-27 | 2010-12-02 | Teledyne Rd Instruments | System and method for determining wave characteristics from a moving platform |
CN101694390B (zh) * | 2009-10-20 | 2012-08-22 | 哈尔滨工程大学 | 基于光纤惯性测量***的舰船升沉运动测量方法 |
CN105698789A (zh) * | 2016-01-12 | 2016-06-22 | 西北工业大学 | 舰船升沉测量方法及其测量*** |
CN106643728A (zh) * | 2016-12-16 | 2017-05-10 | 哈尔滨工程大学 | 基于自适应频率估计的船舶升沉运动信息估计方法 |
CN107063243B (zh) * | 2017-03-30 | 2020-05-15 | 哈尔滨工程大学 | 一种基于带限傅里叶线性组合的舰船升沉测量方法 |
-
2017
- 2017-08-21 CN CN201710717244.5A patent/CN109425339B/zh active Active
Also Published As
Publication number | Publication date |
---|---|
CN109425339A (zh) | 2019-03-05 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN109425339B (zh) | 一种基于惯性技术的考虑杆臂效应的舰船升沉误差补偿方法 | |
CN110031882B (zh) | 一种基于sins/dvl组合导航***的外量测信息补偿方法 | |
CN107270893B (zh) | 面向不动产测量的杆臂、时间不同步误差估计与补偿方法 | |
CN101672649B (zh) | 一种基于数字低通滤波的船用光纤捷联***系泊对准方法 | |
CN111024064B (zh) | 一种改进Sage-Husa自适应滤波的SINS/DVL组合导航方法 | |
CN102486377B (zh) | 一种光纤陀螺捷联惯导***初始航向的姿态获取方法 | |
CN103471616B (zh) | 一种动基座sins大方位失准角条件下初始对准方法 | |
CN106482734A (zh) | 一种用于imu多传感器数据融合的滤波方法 | |
CN104698485B (zh) | 基于bd、gps及mems的组合导航***及导航方法 | |
CN103389092B (zh) | 一种系留飞艇姿态测量装置及测量方法 | |
CN111102993A (zh) | 一种旋转调制型捷联惯导***晃动基座初始对准方法 | |
CN110954102A (zh) | 用于机器人定位的磁力计辅助惯性导航***及方法 | |
CN108592943B (zh) | 一种基于opreq方法的惯性系粗对准计算方法 | |
CN106017452A (zh) | 双陀螺抗扰动寻北方法 | |
CN112683274A (zh) | 一种基于无迹卡尔曼滤波的无人机组合导航方法和*** | |
CN112197765A (zh) | 一种实现水下机器人精细导航的方法 | |
CN111722295B (zh) | 一种水下捷联式重力测量数据处理方法 | |
CN102305635A (zh) | 一种光纤捷联罗经***的对准方法 | |
CN111121820B (zh) | 基于卡尔曼滤波的mems惯性传感器阵列融合方法 | |
CN109029499B (zh) | 一种基于重力视运动模型的加速度计零偏迭代寻优估计方法 | |
CN111812737B (zh) | 水下导航与重力测量一体化*** | |
CN112798014A (zh) | 一种基于重力场球谐模型补偿垂线偏差的惯导自对准方法 | |
CN114674345B (zh) | 一种惯导/相机/激光测速仪在线联合标定方法 | |
Zhe et al. | Adaptive complementary filtering algorithm for imu based on mems | |
Sun et al. | Novel approach to GPS/SINS integration for IMU alignment |
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 |