[发明专利]一种基于双贝叶斯估计的水下运动体运动状态估计方法

权利要求书

1.一种基于双贝叶斯估计的水下运动体运动状态估计方法，其特征在于，包括以下几个 步骤：

(1)建立水下运动体的运动状态估计模型：

(1.1)建立水下运动体的观测模型：

ξ=R cos E cos A+xη=R sin E+yζ=R cos E sin A+z]]>

(1.2)建立水下运动体的运动模型

ξ·=v cosφcosθη·=v sinφcosθζ·=v sinθ]]>

(1.3)建立对水下运动体速度大小和方向进行估计的自适应贝叶斯估计器系统模型：

φkφ·kθkθ·kvkv·k=1T0000010000001T0000010000001T000001φk+1φ·k+1θk+1θ·k+1vk+1v·k+1+000100000010000001wφ·kwθ·kwv·k]]>

φkθkvk=100000001000000010φk+1φ·k+1θk+1θ·k+1vk+1v·k+1+Vk]]>

(1.4)建立对水下运动体位置进行估计的无迹贝叶斯估计器系统模型：

X_k+1＝f(X_k,φ,θ,v)+W_k

y_k＝HX_k+V_k

(2)利用观测量解算出前一时刻水下运动体的速度大小及方向：

通过观测量解算出前一时刻水下运动体的速度及其方向；

(3)利用下一时刻的观测信息更新贝叶斯估计参数：

在获得下一时刻的观测信息后，对贝叶斯估计的参数进行更新；分别进行自适应估计器 和无迹估计器的相关参数更新；

(3.1)更新自适应估计器的参数，将水下运动体的角加速度和加速度的变化量视作系统 噪声，使用噪声估计器进行估计；

(3.2)利用观测信息更新无迹估计器的参数；

(4)利用自适应贝叶斯运动估计方法，估计出水下运动体当前时刻的速度大小及方向；

通过自适应贝叶斯运动估计方法中的估计方程，得到下一时刻水下运动体的速度大小和 方向的估计值；

(5)利用水下运动体当前时刻位置和自适应贝叶斯的估计结果，通过无迹贝叶斯运动估 计方法，得到下一时刻的水下运动体位置。