基于航速修正处理的单舰被动定位算法

提出一种基于航速修正处理的单舰被动定位算法,在修正增益推广卡尔曼滤波器的基础上,该算法把运动目标舰艇的航速约束当作输出为0的增加的观测数据加入到测量方程,约束的强度由约束条件的噪声方差确定。提出一种规避因子,用来约束目标状态方程中的航速,基本思想是根据当前估计的目标位置和航速,估计下一个周期将航行到陆地岛礁或即将航行到陆地岛礁时,用规避因子矩阵来修正航速的方向和大小,避免了出现目标航行到陆地岛礁的情况。计算机模拟结果表明,航速修正处理后不会出现穿越陆地岛礁的运动舰艇航迹,同时还能提高对海上运动舰艇辐射源的被动定位精度。