[发明专利]基于惯导辅助单星定位的卡尔曼滤波动目标定位方法

权利要求书

1.一种基于惯导辅助单星定位的卡尔曼滤波动目标定位方法，其特征在于：包括以下步骤：

步骤1：采用积分多普勒单星定位方式获得卫星与定位目标之间的积分多普勒测量值，结合定位目标测高计获得的高度值h和卫星星历中得到的卫星各时刻坐标求出定位目标初始静态定位阶段的定位目标坐标x＝(x,y,z)；

步骤2：以步骤1得到的定位目标初始静态定位阶段的坐标x＝(x,y,z)为初始值，利用连续三个时刻卫星与定位目标间的伪距、INS惯导输入的定位目标位置偏移、卫星坐标和目标测高，联立公式

其中{R_i,R_i+1,R_i+2}分别表示第i、第i+1和第i+2个时刻的卫星和定位目标之间的伪距，卫星在第i、第i+1和第i+2个时刻坐标分别为{X_i,Y_i,Z_i}、{X_i+1,Y_i+1,Z_i+1}和{X_i+2,Y_i+2,Z_i+2}，定位目标在第i、第i+1和第i+2个时刻坐标分别为{x_i,y_i,z_i}、{x_i+1,y_i+1,z_i+1}和{x_i+2,y_i+2,z_i+2}，{R_i,x,R_i,y,R_i,z}、{R_i+2,x,R_i+2,y,R_i+2,z}分别表示i时刻与i+2时刻伪距R_i和R_i+2各自在地心地固坐标系下x,y,z三个方向上的投影；δt_u为接收机钟差；Δx_i,Δy_i,Δz_i和Δx_i+1,Δy_i+1,Δz_i+1为惯导系统记录的目标i时刻与i+1时刻间以及i+1时刻与i+2时刻间的相对位移；

将联立公式在k-1次迭代结果[x_i+2,k-1,δt_u,k-1]^T处泰勒展开，并略去高阶项进行线性化处理之后得到矩阵方程式为：

G·Δx＝b

其中x_i+2,k表示i+2时刻第k次迭代的目标坐标值，x_i+2,k-1表示在第k-1次迭代时对应i+2时刻定位目标的坐标；反复进行迭代直至增量||Δx||满足设定精度后停止，得到i+2时刻定位目标的三维坐标，并将此结果作为初始定位结果x；

步骤3：建立状态变量X＝[x y z V_x V_y V_z a_xa_y a_z]^T，其中状态变量代入值x,y,z、V_x,V_y,V_z和a_x,a_y,a_z分别为定位目标在i+2时刻坐标系中的当前位置、速度和加速度；将状态变量初始化为并将惯导系统记录的目标i时刻与i+1时刻间以及i+1时刻与i+2时刻间的相对位移Δx_i,Δy_i,Δz_i和Δx_i+1,Δy_i+1,Δz_i+1、卫星与目标在i时刻、i+1时刻和i+2时刻的伪距值，以及目标在i+2时刻的测高值代入UKF滤波器，得到i+2时刻的定位结果。