CN104316025A - 一种基于船体姿态信息估计海浪浪高的系统 - Google Patents

一种基于船体姿态信息估计海浪浪高的系统 Download PDF

Info

Publication number
CN104316025A
CN104316025A CN201410546129.2A CN201410546129A CN104316025A CN 104316025 A CN104316025 A CN 104316025A CN 201410546129 A CN201410546129 A CN 201410546129A CN 104316025 A CN104316025 A CN 104316025A
Authority
CN
China
Prior art keywords
wave
state
output
ship
attitude information
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
Application number
CN201410546129.2A
Other languages
English (en)
Other versions
CN104316025B (zh
Inventor
陈虹丽
余沛
王子元
沈丹
宋东辉
高延滨
何昆鹏
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Harbin Engineering University
Original Assignee
Harbin Engineering University
Priority date (The priority date 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 date listed.)
Filing date
Publication date
Application filed by Harbin Engineering University filed Critical Harbin Engineering University
Priority to CN201410546129.2A priority Critical patent/CN104316025B/zh
Publication of CN104316025A publication Critical patent/CN104316025A/zh
Application granted granted Critical
Publication of CN104316025B publication Critical patent/CN104316025B/zh
Expired - Fee Related legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Classifications

    • GPHYSICS
    • G01MEASURING; TESTING
    • G01CMEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
    • G01C5/00Measuring height; Measuring distances transverse to line of sight; Levelling between separated points; Surveyors' levels
    • GPHYSICS
    • G01MEASURING; TESTING
    • G01CMEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
    • G01C13/00Surveying specially adapted to open water, e.g. sea, lake, river or canal
    • G01C13/002Measuring the movement of open water
    • G01C13/004Measuring the movement of open water vertical movement
    • GPHYSICS
    • G01MEASURING; TESTING
    • G01CMEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
    • G01C21/00Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
    • G01C21/10Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration
    • G01C21/12Navigation; 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/16Navigation; 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)
  • Physics & Mathematics (AREA)
  • General Physics & Mathematics (AREA)
  • Life Sciences & Earth Sciences (AREA)
  • Hydrology & Water Resources (AREA)
  • Automation & Control Theory (AREA)
  • Navigation (AREA)

Abstract

本发明属于船体姿态信息估计领域,具体的说是一种基于船体姿态信息估计海浪浪高的系统。包括无迹卡尔曼滤波器、海浪扰动估计器、海浪浪高估计器,船上测量系统的加速度传感器、惯性陀螺仪测出船体姿态信息,海浪扰动估计器接收作用在船上的控制量的同时接收无迹卡尔曼滤波器的输出的水动力系数估计值,得到海浪扰动估计器输出的海浪扰动力、力矩估计序列,浪高估计器接收海浪扰动力、力矩估计序列后,得到海浪浪高估计序列。本发明可以很好的解决所用船体运动方程参数未知和不确定性的情况,最后利用船体姿态反推出的船体所受的海浪扰动间接的求出海浪浪高,达到了较高的计算精度。

Description

一种基于船体姿态信息估计海浪浪高的系统
技术领域
本发明属于船体姿态信息估计领域,具体的说是一种基于船体姿态信息估计海浪浪高的系统。
背景技术
海洋是世界重要的组成部分,要对其进行研究,首先要考虑海浪,我们知道,海浪是海洋中的一种普遍自然现象,它是由海水的不规则波动而产生的,并且影响着人们在海上的各种活动,无论是民用的渔船,还是军用船舶,在海上航行时都会因为海浪的影响而产生剧烈摇荡,轻则影响航行,重则可能会损坏船只或者使其沉没,因此为了减小海浪对海上航行船只的威胁性,对海浪特性的研究有着相当重要的意义。
在了解海浪特性方面,传统的系统是运用一些仪器来测量海浪的相关数据,在实际中有不少船只使用浪高仪来测量浪高,对于这种情况,同样也会出现一些问题,如浪高仪本身的故障以及浪级上的限制,也就是说浪高仪并不是在任何情况下都是可以使用的,它具有一定的局限性,当然也有比较先进的船只配备了随船海浪摄像测量系统,这种系统虽然也可以达到目的,但是由于其复杂性以及价格昂贵,使其不能在所有船只都能使用,这也就限制了这种系统的应用范围。综合考虑这些系统都并不太令人满意,因此找出更好的测量海浪浪高的系统,增加船舶在航行时的安全性,仍是当前重要的课题。
对于传统的使用仪器测量海浪浪高的系统中,浪高仪的工作原理是在使用时需要投放测量海域,利用其中传感器进行测量计算而输出相应的浪高数据,待测量完毕后进行回收,而同样的原理,将海中航行的船体作为一个浪高仪时,利用船体自身的一些航行姿态变量对海浪的浪高进行计算,同样也可以得到相应的信息,并且减少了投放与回收的过程,更加方便。
本发明通过建立的船体运动方程,应用无迹卡尔曼滤波器对船体模型参数进行辨识,并依此反推出船体所受的海浪扰动。通过运用神经网络的系统找出海浪扰动与海浪浪高之间的关系,间接求出海浪浪高。这其中并没有运用新的测量仪器,只是运用船体在海中航行的过程中提供的一些航行参数,该法是一种较为安全、便捷的海浪浪高测量系统。
发明内容
本发明的目的在于提供一种更高计算精度的基于船体姿态信息估计海浪浪高的系统。
本发明的目的是这样实现的
基于船体姿态信息估计海浪浪高的系统,包括无迹卡尔曼滤波器(1)、海浪扰动估计器(2)、海浪浪高估计器(3),船上测量系统的加速度传感器、惯性陀螺仪测出船体姿态信息:纵荡速度、横荡速度、艏摇角速度,传递给无迹卡尔曼滤波器(1),将作用在船上的控制量分别发送给无迹卡尔曼滤波器(1)和海浪扰动估计器(2),无迹卡尔曼滤波器(1)同时接收船体姿态信息和作用在船上的控制量后得到水动力系数估计值;海浪扰动估计器(2)接收作用在船上的控制量的同时接收无迹卡尔曼滤波器(1)的输出的水动力系数估计值,得到海浪扰动估计器(2)输出的海浪扰动力、力矩估计序列,浪高估计器(3)接收海浪扰动力、力矩估计序列后,得到海浪浪高估计序列。
无迹卡尔曼滤波器是通过sigma点发生器获取sigma点,经过非线性状态函数进行时间更新获得状态一步预报和状态一步预报协方差,经过非线性量测函数进行测量更新获得输出预测、输出预测自协方差和输出预测互方差,将实际输出值、输出预测、输出预测自协方差、输出预测互协方差、状态一步预报和状态一步预报协方差送给状态估计器后得到水动力系数估计值;所述的非线性状态函数和非线性量测函数为:
xk是n维状态向量,yk是r维输出向量,θk是p维未知参数向量,wk是n维状态噪声向量,vk是r维量测噪声向量,是n+p维的状态向量,ηk是p维状态噪声向量,此处,假设序列wk,ηk与vk均为离散的高斯白噪声;
sigma点发生器是采用对称采样策略获取sigma点:
时间更新是指将Sigma点集中的每一个点带入到非线性状态函数中去,
状态一步预报为
状态一步预报协方差为
测量更新是指基于时间更新中的状态一步预报和状态一步预报协方差P′x,k,利用sigma点发生器获得sigma点经过非线性量测函数传播
γ k | k - 1 i = h ( x k | k - 1 i )
输出预测为 y ^ k ′ = Σ i = 1 n + p W i ( m ) γ k | k - 1 i ,
输出预测自协方差为 P y , k = Σ i = 0 n + p W i ( c ) [ γ k | k - 1 i - y ^ k ′ ] [ γ k | k - 1 i - y ^ k ′ ] T ,
输出预测互协方差为
状态估计器是指运用实际输出的值来修正计算的状态后验估计值:
所述的实际输出值是指通过测量系统得到的船体姿态信息,极纵荡速度、横荡速度以及艏摇角速度,测量系统是指线加速度传感器、惯性陀螺仪,状态后验估计值是指水动力系数及船体姿态辨识值,海浪扰动估计器为:
τ ^ E ( k ) = M ^ x ^ ( k + 1 ) + D ^ x ^ ( k ) + C ^ ( k ) x ^ ( k ) - τ ( k ) ,
海浪浪高估计器为:
y k ( x j ) = Σ i = 1 m w ik exp ( - 1 2 σ 2 | | x j - c i | | 2 ) k = 1,2 , . . . , p , j = 1,2 , . . . b .
对于求取海浪浪高,本发明具有以下的优点:
该系统是为解决航行船体测量海浪浪高相对复杂而产生的,它是以船体自身为浪高仪进行测量计算的,降低了传统仪器测量时的复杂性,另外,由于建立船体运动模型的非线性,利用无迹卡尔曼滤波器来完成参数的辨识,可以很好的解决所用船体运动方程参数未知和不确定性的情况,最后利用船体姿态反推出的船体所受的海浪扰动间接的求出海浪浪高,达到了较高的计算精度。
附图说明
图1为基于船体姿态信息估计海浪浪高的结构框图;
图2为船体运动方程参数估计结构示意图;
图3为UKF滤波辨识水动力系数相对误差;
图4为通过神经网络最后估计出的海浪浪高与真实值的对比图。
具体实施系统
下面结合附图对本发明做进一步描述。
针对传统海浪测量系统的不足与使用的局限性,本发明提出了运用船体姿态通过计算间接求出海浪浪高的系统。本发明的目的是这样实现的:
包括无迹卡尔曼滤波器(1)、海浪扰动估计器(2)、海浪浪高估计器(3)。船上测量系统(加速度传感器、惯性陀螺仪)测出船体姿态信息(纵荡速度、横荡速度、艏摇角速度),传递给无迹卡尔曼滤波器(1),作用在船上的控制量分别发送给无迹卡尔曼滤波器(1)和海浪扰动估计器(2),无迹卡尔曼滤波器(1)同时接收船体姿态信息和作用在船上的控制量后得到水动力系数估计值;海浪扰动估计器(2)接收作用在船上的控制量的同时还接收无迹卡尔曼滤波器(1)的输出数据(水动力系数估计值),得到海浪扰动估计器(2)的输出数据(海浪扰动力、力矩估计序列),最后浪高估计器(3)接收海浪扰动(力、力矩)估计序列后,得到海浪浪高估计序列。
本发明的基于船体姿态信息估计海浪浪高的系统还可以包括:
1、所述的无迹卡尔曼滤波器是通过sigma点发生器获取sigma点,经过非线性状态函数进行时间更新获得状态一步预报和状态一步预报协方差,经过非线性量测函数进行测量更新获得输出预测、输出预测自协方差和输出预测互方差,将实际输出值、输出预测、输出预测自协方差、输出预测互协方差、状态一步预报和状态一步预报协方差送给状态估计器后得到状态后验估计值。
2、所述的非线性状态函数和非线性量测函数为:
3、所述的sigma点发生器是采用对称采样策略获取sigma点:
4、所述的时间更新是指将Sigma点集中的每一个点带入到非线性状态函数中去,
状态一步预报为
状态一步预报协方差为
5、所述的测量更新是指基于权利要求5时间更新中的和P′x,k利用sigma点发生器获得sigma点经过非线性量测函数传播
γ k | k - 1 i = h ( x k | k - 1 i ) - - - ( 15 )
输出预测为 y ^ k ′ = Σ i = 1 n + p W i ( m ) γ k | k - 1 i - - - ( 16 )
输出预测自协方差为 P y , k = Σ i = 0 n + p W i ( c ) [ γ k | k - 1 i - y ^ k ′ ] [ γ k | k - 1 i - y ^ k ′ ] T - - - ( 17 )
输出预测互协方差为
6、所述的状态估计器是指运用实际输出的值来修正计算的状态后验估计值:
7、所述的实际输出值是指通过测量系统得到的船体姿态信息
8、所述的船体姿态信息是指纵荡速度、横荡速度以及艏摇角速度。
9、所述的测量系统是指线加速度传感器、惯性陀螺仪。
10、所述的状态后验估计值是指水动力系数及船体姿态辨识值。
11、所述的海浪扰动估计器为:
τ ^ E ( k ) = M ^ x ^ ( k + 1 ) + D ^ x ^ ( k ) + C ^ ( k ) x ^ ( k ) - τ ( k ) - - - ( 20 )
12、所述的海浪浪高估计器为:
y k ( x j ) = Σ i = 1 m w ik exp ( - 1 2 σ 2 | | x j - c i | | 2 ) k = 1,2 , . . . , p , j = 1,2 , . . . b - - - ( 21 )
本发明的工作原理是:对原非线性状态方程也就是船体运动方程进行参数增广,得到相应的状态方程与观测方程,并离散化;运用扩展无迹卡尔曼(UKF)非线性观测器对船体运动方程的参数进行辨识及对船体姿态信息滤波;利用船体姿态信息借助海浪扰动估计器求出相对应的船体所受的海浪扰动;运用海浪浪高数据和相应的船体所受的海浪扰动对神经网络(海浪浪高估计器)进行训练,将海浪扰动作为输入,求出相应的海浪浪高。
本发明描述的是一种海浪浪高的估计系统,与传统的海浪浪高测量系统相比,该系统能够快速并且准确的得到船体航行时当前的海浪浪高的情况,操作方便且节省成本。本发明的设计方案如图1所示,具体的步骤如下:
1.船体运动方程参数的增广与辨识的准备,具体过程如下:
使用无迹卡尔曼(UKF)滤波器来处理非线性方程的参数辨识问题时,主要经过以下两个阶段:第一个是预报阶段,在该阶段中,主要是计算状态的预报值与此时所对应的状态预报误差的协方差;在第二个阶段中,主要完成的是状态预报误差与协方差的更新步骤,根据由计算得出的UKF滤波器的滤波增益,对其进行更新,同时也要完成对预报状态的更新。
假设θ是将要估计的参数向量,对原非线性状态方程进行增广,也就是将参数向量θ和原状态一起作为状态而进行非线性状态方程的扩展,然后对该扩展状态下的非线性方程进行UKF滤波,此时也可以将该滤波称为扩展UKF滤波。通过估计θ的最小方差来完成对未知参数向量的最优估计。
假定离散系统的描述如下,并且其中包含有未知参数:
x k + 1 = f ( x k , θ k ) + w k y k = h ( x k , θ k ) + v k - - - ( 1 )
式中,xk是n维状态向量,yk是r维输出向量,θk是p维未知参数向量,wk是n维状态噪声向量,vk是r维量测噪声向量。
为了便于描述和运用UKF进行估计,式(1)所描述的离散状态空间表示为:
上式中,是n+p维的状态向量,ηk是p维状态噪声向量,此处,假设序列wk,ηk与vk均为离散的高斯白噪声。
2.对船体运动方程水动力系数的辨识,具体过程如下:
针对文献“Gianluca Antonelli,Stefano Chiaverini,Nilanjan Sarkar,Michael West.AdaptiveControl of an Autonomous Underwater Vehicle:Experimental Results on ODIN[J].
TRANSACTIONS ON CONTROL SYSTEMS TECHNOLOGY,2001,9(5)”给出的球形水下机器人ODIN,假设ODIN保持在某一定深进行航行,其水平面的运动方程为:
x · ( x ) x + D ( x ) x = τ E + τ - - - ( 3 )
式中:x=[u v r]T,u,v,r为ODIN纵荡速度、横荡速度、艏摇角速度;M为惯性矩阵,包括附加质量;C(x)为向心力和科氏力矩阵,包括附加质量产生的向心力和科氏力;D(x)为水动力阻力和升力矩阵;τE为海浪扰动;τ表示作用在ODIN载体坐标系下的控制向量,即力和力矩。
M = m - X u · 0 0 0 m - Y v · m x G - Y r · 0 m x G - N v · I z - N r · - - - ( 4 )
C ( x ) = 0 0 - m ( x G r + v ) 0 0 mu m ( x G r + v ) - mu 0 - - - ( 5 )
所考虑的ODIN的状态即u,v,r均比较小,因此二阶阻尼矩阵可以忽略,则:
D ( x ) = - X u 0 0 0 Y v Y r 0 N v N r - - - ( 6 )
式中,m表示的是船体质量,xG表示的是浮心在体坐标系中x轴坐标,Iz表示的是船体关于z轴的转动惯量。
运用扩展UKF滤波器对船体运动方程的参数进行辨识,并建立辨识模型,其辨识结构示意图如图2所示,在运用扩展无迹卡尔曼滤波器来对运动方程的参数进行估计时,所要估计的参数主要有将待估计的未知参数记为向量θ,令 θ = X u · X u Y v · Y r · Y r Y v N v · N r · N v N r T .
式(3)可写为:
x = · M - 1 [ τ E + τ - D ( x ) x - C ( x ) x ] - - - ( 7 )
从而得到微分方程即:
f(x,θ)=M-1E+τ-D(x)x-C(x)x]             (8)
将运动方程水动力系数θ扩展到状态变量x中,并进行离散化可以得到非线性离散状态方程及相应的量测方程,见式(2),式中yk是该离散系统的测量向量且为yk=[uk vk rk]T。接着将UKF滤波理论应用到式(2)中,通过辨识就可以得到水动力系数,将带入式(4)~式(6)得到 辨识结果相对误差见表1。
UKF滤波过程如下:
(1)sigma点发生器采用对称采样策略获取sigma点:
式中为k-1时刻状态均值和协方差,n+p=13,ρ为比例系数,用于调节之间的距离,的平方根矩阵的第i列。
(2)时间更新:
将Sigma点集中的每一个点带入到非线性状态函数中去,得
状态一步预报为
式中
W 0 ( m ) = ρ / ( n + ρ )
W i ( m ) = 1 / [ 2 ( n + ρ ) ] , i = 1 , . . . , n + p
状态一步预报协方差为
式中 W 0 ( c ) = ρ / ( n + ρ ) + ( 1 + α 2 + β ) , W i ( c ) = W i ( m ) , Qk的方差,β、α确定周围sigma点的分布状况。
(3)测量更新:
基于时间更新(2)中的和P′x,k,利用sigma点发生器获得sigma点经过非线性量测函数传播为
γ k | k - 1 i = h ( x k | k - 1 i ) - - - ( 15 )
输出预测为 y ^ k ′ = Σ i = 1 n + p W i ( m ) γ k | k - 1 i - - - ( 16 )
输出预测自协方差为 P y , k = Σ i = 0 n + p W i ( c ) [ γ k | k - 1 i - y ^ k ′ ] [ γ k | k - 1 i - y ^ k ′ ] T - - - ( 17 )
输出预测互协方差为
式中Rk为vk的方差。
(4)状态估计器
运用实际输出的值来修正计算的状态后验估计值:
式中状态协方差更新为Pk=P′x,k-KPy,kKT
3.利用海浪扰动估计器进行船体所受海浪扰动的推算,具体过程如下:
根据运用UKF滤波器估计出的水动力系数得到具体的船体运动方程,而船体所受的海浪扰动在该方程中有所体现,此时由式(7)可以得出船体所受海浪扰动估计的离散化方程为:
τ ^ E ( k ) = M ^ x ^ ( k + 1 ) + D ^ x ^ ( k ) + C ^ ( k ) x ^ ( k ) - τ ( k ) - - - ( 20 )
式中 M ^ = m - X ^ u · 0 0 0 m - Y ^ v · mx G - Y ^ r · 0 mx G - N ^ v · I z - N ^ r · , C ^ ( x ) = 0 0 - m ( x G r ^ + v ^ ) 0 0 m u ^ m ( x G r ^ + v ^ ) - m v ^ 0 , D ^ ( x ) = - X ^ u 0 0 0 Y ^ v Y ^ r 0 N ^ v N ^ r , x ^ = [ u ^ v ^ r ^ ] T .
在航行时,根据船体运行姿态信息,则可以估计出当前情况下所受的海浪扰动,进而可以依据这些扰动得出海浪的在各个时刻的海浪浪高。
4.海浪浪高估计器是依据海浪扰动与海浪浪高的关系估计海浪浪高,具体过程如下:
船体在海中行进时,会受到海浪扰动的作用,由实验可知,不同的船只在相同的海浪干扰下,船体所受的海浪扰动也会有所不同,因此,在根据船体所受的海浪扰动估计海浪浪高时,并没有现成有效的计算公式或者经验可寻,为了能够有效的解决这一难题,在此引入了径向基函数(RBF)神经网络。利用神经网络的学习能力来解决海浪扰动与海浪浪高之间关系未知的问题,进一步根据这种关系求出海浪的浪高。
RBF神经网络如下:
y k ( x j ) = Σ i = 1 m w ik exp ( - 1 2 σ 2 | | x j - c i | | 2 ) k = 1,2 , . . . , p , j = 1,2 , . . . b - - - ( 21 )
式中xj是第j个输入样本,σ为高斯函数方差,m是指隐含层节点数,范数||xj-ci||表示的是输入量xj到高斯基函数中心ci的距离。wik是网络联接权值,yk是与输入样本对应的网络的第k个输出结点的实际输出。
由海浪扰动与相应的海浪浪高数据作为RBF的输入、输出量,对神经网络进行训练。但是由于输入数据与输出数据的量纲并不相同,因此,需要对这些原始数据进行归一化处理。然后将求取的数据进行反归一化输出即可得到海浪浪高,图4表示的是5级海清时得到的海浪浪高估计序列。

Claims (5)

1.一种基于船体姿态信息估计海浪浪高的系统,其特征在于:包括无迹卡尔曼滤波器(1)、海浪扰动估计器(2)、海浪浪高估计器(3),船上测量系统的加速度传感器、惯性陀螺仪测出船体姿态信息:纵荡速度、横荡速度、艏摇角速度,传递给无迹卡尔曼滤波器(1),将作用在船上的控制量分别发送给无迹卡尔曼滤波器(1)和海浪扰动估计器(2),无迹卡尔曼滤波器(1)同时接收船体姿态信息和作用在船上的控制量后得到水动力系数估计值;海浪扰动估计器(2)接收作用在船上的控制量的同时接收无迹卡尔曼滤波器(1)的输出的水动力系数估计值,得到海浪扰动估计器(2)输出的海浪扰动力、力矩估计序列,浪高估计器(3)接收海浪扰动力、力矩估计序列后,得到海浪浪高估计序列。 
2.根据权利要求1所述的一种基于船体姿态信息估计海浪浪高的系统,其特征在于:所述的无迹卡尔曼滤波器是通过sigma点发生器获取sigma点,经过非线性状态函数进行时间更新获得状态一步预报和状态一步预报协方差,经过非线性量测函数进行测量更新获得输出预测、输出预测自协方差和输出预测互方差,将实际输出值、输出预测、输出预测自协方差、输出预测互协方差、状态一步预报和状态一步预报协方差送给状态估计器后得到水动力系数估计值;所述的非线性状态函数和非线性量测函数为: 
xk是n维状态向量,yk是r维输出向量,θk是p维未知参数向量,wk是n维状态噪声向量,vk是r维量测噪声向量,是n+p维的状态向量,ηk是p维状态噪声向量,此处,假设序列wk,ηk与vk均为离散的高斯白噪声; 
所述的sigma点发生器是采用对称采样策略获取sigma点: 
3.根根据权利要求2所述的一种基于船体姿态信息估计海浪浪高的系统,其特征在于:所述的时间更新是指将Sigma点集中的每一个点带入到非线性状态函数中去, 
状态一步预报为 
状态一步预报协方差为 
4.根根据权利要求3所述的一种基于船体姿态信息估计海浪浪高的系统,其特征在于:所述的测量更新是指基于时间更新中的状态一步预报和状态一步预报协方差P′x,k,利用sigma点发生器获得sigma点经过非线性量测函数传播 
输出预测为
输出预测自协方差为
输出预测互协方差为
5.根据权利要求2所述的一种基于船体姿态信息估计海浪浪高的系统,其特征在于:所述的状态估计器是指运用实际输出的值来修正计算的状态后验估计值: 
所述的实际输出值是指通过测量系统得到的船体姿态信息,极纵荡速度、横荡速度以及艏摇角速度,测量系统是指线加速度传感器、惯性陀螺仪,状态后验估计值是指水动力系数及船体姿态辨识值,海浪扰动估计器为: 
海浪浪高估计器为: 
CN201410546129.2A 2014-10-16 2014-10-16 一种基于船体姿态信息估计海浪浪高的系统 Expired - Fee Related CN104316025B (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN201410546129.2A CN104316025B (zh) 2014-10-16 2014-10-16 一种基于船体姿态信息估计海浪浪高的系统

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN201410546129.2A CN104316025B (zh) 2014-10-16 2014-10-16 一种基于船体姿态信息估计海浪浪高的系统

Publications (2)

Publication Number Publication Date
CN104316025A true CN104316025A (zh) 2015-01-28
CN104316025B CN104316025B (zh) 2017-01-11

Family

ID=52371291

Family Applications (1)

Application Number Title Priority Date Filing Date
CN201410546129.2A Expired - Fee Related CN104316025B (zh) 2014-10-16 2014-10-16 一种基于船体姿态信息估计海浪浪高的系统

Country Status (1)

Country Link
CN (1) CN104316025B (zh)

Cited By (8)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN104787260A (zh) * 2015-03-27 2015-07-22 哈尔滨工程大学 一种基于融合滤波器的水翼双体船纵向姿态估计方法
CN106599427A (zh) * 2016-12-06 2017-04-26 哈尔滨工程大学 一种基于贝叶斯理论和气垫船姿态信息的海浪信息预测方法
CN107545250A (zh) * 2017-08-31 2018-01-05 哈尔滨工程大学 一种基于海浪图像遥感和人工智能的海洋浮体运动实时预报系统
CN109781075A (zh) * 2018-12-13 2019-05-21 中国航空工业集团公司上海航空测控技术研究所 一种海洋浪高测量系统及方法
CN110852619A (zh) * 2019-11-12 2020-02-28 山东交通学院 一种在船舶性能的评估中对海浪阻力的修正方法
CN110887506A (zh) * 2019-10-14 2020-03-17 交通运输部水运科学研究所 一种受海浪影响的惯性传感器的运动幅度检测方法及系统
CN113229806A (zh) * 2021-05-14 2021-08-10 哈尔滨工程大学 可穿戴人体步态检测及导航系统及其运行方法
CN113344275A (zh) * 2021-06-15 2021-09-03 上海交通大学 一种基于lstm模型的浮式平台波浪爬升在线预报方法

Citations (8)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US6382022B1 (en) * 2000-03-27 2002-05-07 The United States Of America As Represented By The Secretary Of The Navy Shipboard wave measurement system
CN101603825A (zh) * 2008-06-11 2009-12-16 特林布尔导航有限公司 推算高度计和方法
CN101706275A (zh) * 2009-11-09 2010-05-12 哈尔滨工程大学 动态海浪测量装置及测量方法
CN102768043A (zh) * 2012-06-14 2012-11-07 辽宁工程技术大学 一种无外观测量的调制型捷联系统组合姿态确定方法
CN102830707A (zh) * 2012-09-21 2012-12-19 中国航空无线电电子研究所 航行器起降俯仰姿态控制系统
CN103630123A (zh) * 2013-10-29 2014-03-12 中国船舶重工集团公司第七〇七研究所 一种波浪传感器
KR20140043192A (ko) * 2012-09-28 2014-04-08 한국전력공사 동체 탑재형 파랑 측정장치
CN103900541A (zh) * 2014-03-06 2014-07-02 哈尔滨工程大学 一种海况估计器

Patent Citations (8)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US6382022B1 (en) * 2000-03-27 2002-05-07 The United States Of America As Represented By The Secretary Of The Navy Shipboard wave measurement system
CN101603825A (zh) * 2008-06-11 2009-12-16 特林布尔导航有限公司 推算高度计和方法
CN101706275A (zh) * 2009-11-09 2010-05-12 哈尔滨工程大学 动态海浪测量装置及测量方法
CN102768043A (zh) * 2012-06-14 2012-11-07 辽宁工程技术大学 一种无外观测量的调制型捷联系统组合姿态确定方法
CN102830707A (zh) * 2012-09-21 2012-12-19 中国航空无线电电子研究所 航行器起降俯仰姿态控制系统
KR20140043192A (ko) * 2012-09-28 2014-04-08 한국전력공사 동체 탑재형 파랑 측정장치
CN103630123A (zh) * 2013-10-29 2014-03-12 中国船舶重工集团公司第七〇七研究所 一种波浪传感器
CN103900541A (zh) * 2014-03-06 2014-07-02 哈尔滨工程大学 一种海况估计器

Non-Patent Citations (2)

* Cited by examiner, † Cited by third party
Title
赵希人,陈虹丽,叶葵,魏东: "基于扩展卡尔曼滤波的船舶纵向运动受扰力与力矩的估计", 《中国造船》 *
陈虹丽,余沛,刘纹岩: "基于信息融合最优估计的船舶舵减纵摇非线性预测控制", 《第三十二届中国控制会》 *

Cited By (9)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN104787260A (zh) * 2015-03-27 2015-07-22 哈尔滨工程大学 一种基于融合滤波器的水翼双体船纵向姿态估计方法
CN104787260B (zh) * 2015-03-27 2017-05-24 哈尔滨工程大学 一种基于融合滤波器的水翼双体船纵向姿态估计方法
CN106599427A (zh) * 2016-12-06 2017-04-26 哈尔滨工程大学 一种基于贝叶斯理论和气垫船姿态信息的海浪信息预测方法
CN107545250A (zh) * 2017-08-31 2018-01-05 哈尔滨工程大学 一种基于海浪图像遥感和人工智能的海洋浮体运动实时预报系统
CN109781075A (zh) * 2018-12-13 2019-05-21 中国航空工业集团公司上海航空测控技术研究所 一种海洋浪高测量系统及方法
CN110887506A (zh) * 2019-10-14 2020-03-17 交通运输部水运科学研究所 一种受海浪影响的惯性传感器的运动幅度检测方法及系统
CN110852619A (zh) * 2019-11-12 2020-02-28 山东交通学院 一种在船舶性能的评估中对海浪阻力的修正方法
CN113229806A (zh) * 2021-05-14 2021-08-10 哈尔滨工程大学 可穿戴人体步态检测及导航系统及其运行方法
CN113344275A (zh) * 2021-06-15 2021-09-03 上海交通大学 一种基于lstm模型的浮式平台波浪爬升在线预报方法

Also Published As

Publication number Publication date
CN104316025B (zh) 2017-01-11

Similar Documents

Publication Publication Date Title
CN104316025A (zh) 一种基于船体姿态信息估计海浪浪高的系统
CN108197350B (zh) 一种无人船速度和不确定性估计系统及设计方法
CN103970021B (zh) 一种基于模型预测控制的松弛动力定位控制系统
Skjetne et al. A nonlinear ship manoeuvering model: Identification and adaptive control with experiments for a model ship
CN101833338B (zh) 无人潜航器垂直面欠驱动运动控制方法
CN107168312A (zh) 一种补偿uuv运动学和动力学干扰的空间轨迹跟踪控制方法
CN110906933B (zh) 一种基于深度神经网络的auv辅助导航方法
CN111596333B (zh) 一种水下定位导航方法及系统
CN103217160A (zh) 一种船舶动力定位卡尔曼滤波方法
CN106054607A (zh) 水下检测与作业机器人动力定位方法
CN109345875A (zh) 一种提高船舶自动识别系统测量精度的估计方法
CN106643723A (zh) 一种无人艇安全航行船位推算方法
Huang et al. Weight self-adjustment Adams implicit filtering algorithm for attitude estimation applied to underwater gliders
CN105005679A (zh) 一种基于粒子滤波的船舶参数辨识方法
CN109579850A (zh) 基于对水速度辅助惯导的深水智能导航方法
CN115421483A (zh) 一种无人船操纵运动预报方法
CN104061930A (zh) 基于捷联惯性制导和多普勒计程仪的导航方法
Tomera Nonlinear observers design for multivariable ship motion control
CN104155043A (zh) 一种动力定位系统外界环境力测量方法
CN109974695A (zh) 基于Krein空间的水面舰艇导航系统的鲁棒自适应滤波方法
Yan et al. Moving long baseline positioning algorithm with uncertain sound speed
Garcia-Garcia et al. Wave filtering for heading control of an AUV based on passive observer
CN103697887B (zh) 一种基于捷联惯导系统和多普勒计程仪的优化导航方法
Yuan et al. Reaearch on underwater integrated navigation system based on SINS/DVL/magnetometer/depth-sensor
CN113501114B (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
GR01 Patent grant
GR01 Patent grant
CF01 Termination of patent right due to non-payment of annual fee

Granted publication date: 20170111