一种基于主元加权迭代的水下纯方位目标跟踪方法及系统与流程
本发明属于水下被动探测与目标跟踪,具体涉及纯方位目标运动分析(botma)的解算方法,可应用于自主水下航行器(uuv)、潜艇、水面舰艇等平台搭载被动声呐设备的隐蔽式目标定位与跟踪场景。
背景技术:
1、纯方位目标运动分析是利用被动声呐等探测设备仅获取目标方位信息,进而推算目标初始距离、航速、航向等运动要素的核心技术。由于全程被动接收目标辐射信号、不主动发射探测波,该技术具有隐蔽性好、作用距离远的优势,是水下隐蔽侦察、反潜作战等场景中的核心支撑技术。
2、目前主流的botma求解方法主要分为两类:
3、递推类方法,包括卡尔曼滤波、粒子滤波、sut-h∞滤波等,通过逐次更新观测信息进行递推求解,具备实时性高的特点。但此类方法对递推初始值高度敏感,必须提供准确的目标初始运动参数才能保证收敛,而水下被动探测场景中往往无法提前获取目标初始信息,工程应用受限。
4、批处理方法,包括最小二乘法、最大似然法、分段解算法等,通过多组观测数据批量建立模型求解,无需目标初始运动信息。但受系统非线性与方位测量误差影响,此类方法普遍存在收敛速度慢、易陷入局部最优解的问题,解算精度难以保证。
5、从系统本质来看,botma系统天然具有弱可观测性,仅在观测平台满足特定机动条件时系统才有唯一解;工程应用中,方位测量的随机误差会进一步导致系统方程组呈现病态特性。理论上可通过fisher信息矩阵(fim)描述系统可观测性:当fim可逆时系统可观测,当fim条件数越大时,系统病态程度越高、可观测性越差,微小的测量误差就会导致解算结果出现大幅波动。这也是传统最小二乘等批处理方法常出现解算发散、精度不足的核心原因。
6、综上,现有技术尚未有效解决botma系统弱可观测性与病态方程组的求解难题,无法同时兼顾“无需目标初始信息”与“高实时性、高精度解算”的双重需求,难以适配水下被动探测的复杂工程场景。
技术实现思路
1、有鉴于此,本发明提出了一种基于主元加权迭代的水下纯方位目标跟踪方法,用于解决现有水下纯方位目标跟踪技术中系统可观测性弱、方程组病态程度高、解算精度不足,且难以兼顾无需目标初始信息与解算实时性的技术问题。
2、本发明的核心思路是:基于批处理思路构建纯方位目标运动的超定方程组,通过主元加权降低系数矩阵的条件数、缓解方程组病态特性,改善系统数值可观测性,再通过迭代递推的方式完成方程组的数值求解,最终融合批处理方法无需初始信息与递推方法实时性高的双重优势,实现高精度的水下纯方位目标跟踪。
3、具体技术方案如下:
4、一种基于主元加权迭代的水下纯方位目标跟踪方法,应用于搭载被动探测设备的水下观测平台,包括以下步骤:
5、s1获取多组观测时刻、对应时刻目标瞬时方位角测量值及观测平台位置坐标,全部数据用于构建方程组系数矩阵与右端向量;
6、s2基于目标匀速直线运动假设,以初始时刻对应的目标初始距离、x轴速度分量、y轴速度分量三组固定参数为未知量,构建线性超定方程组;
7、s3对超定方程组进行方阵化处理,得到正规方程;
8、s4引入主元加权因子,叠加对角正则项得到加权修正方程组,降低矩阵条件数以缓解病态、抑制方位测量误差干扰,其中为单位矩阵;
9、s5将加权修正方程组转化为迭代递推形式,无需目标运动先验信息即可初始化迭代,仅对三组固定参数迭代修正至误差达标,得到最优解后基于匀速直线运动假设外推目标轨迹,完成水下纯方位目标跟踪。
10、进一步的,步骤s2中:
11、系数矩阵为矩阵,第行元素依次为、、;
12、其中为观测初始时刻的目标初始方位角,即初始时刻观测平台正北至观测平台-目标连线的基准夹角;为第观测时刻采集到的目标瞬时方位角测量值;为第个观测时刻;
13、右端向量为维列向量,第个元素为,其中为第时刻观测平台的位置坐标。
14、进一步的,步骤s5中所述迭代递推形式为:
15、,
16、其中为迭代次数,为第次迭代得到的目标初始距离、x轴速度分量、y轴速度分量的估计值;全程针对所述三组固定参数进行修正;迭代终止条件为相邻两次迭代误差小于预设阈值。
17、进一步的,步骤s5中,根据最优解计算目标航速与航向,结合初始方位角确定目标初始位置,基于匀速直线运动模型外推任意时刻目标位置,生成目标运动轨迹以支撑持续跟踪。
18、进一步的,所述水下观测平台包括自主水下航行器uuv、潜艇或水面舰艇,所述目标瞬时方位角测量值由平台搭载的被动声呐获取。
19、一种基于主元加权迭代的水下纯方位目标跟踪系统,搭载于水下观测平台,包括:
20、数据获取模块,用于获取多组观测时刻、目标瞬时方位角测量值以及观测平台位置坐标,供给方程构建模块生成系数矩阵与右端向量;
21、方程构建模块,用于基于目标匀速直线运动假设,以目标初始时刻参数为未知量构建线性超定方程组并完成方阵化处理;
22、主元加权模块,用于引入主元加权因子叠加对角正则项,生成加权修正方程组;
23、迭代求解模块,用于无需目标运动先验信息即可启动迭代,对初始时刻参数逐次修正得到最优解,外推目标轨迹并输出跟踪结果。
24、进一步的,所述数据获取模块与平台搭载的被动声呐通信连接,所述水下观测平台为自主水下航行器uuv。
25、一种计算机可读存储介质,其上存储有计算机程序,所述计算机程序被处理器执行时实现任一项所述的基于主元加权迭代的水下纯方位目标跟踪方法。
26、有益效果
27、1、系统可观测性显著改善,求解成功率大幅提升本发明通过引入主元加权对角正则项对正规方程进行修正,可直接降低系数矩阵的条件数,从数学根源缓解 botma 系统固有的病态特性,有效解决了传统方法中系统弱可观测性导致的解算发散难题。与现有方法相比,目标运动要素的求解成功率提升 30% 以上,复杂工况下的适配性更强。
28、2、目标运动要素解算精度优异,抗测量干扰能力强主元加权机制能够抑制方位测量随机误差在解算过程中的传递与放大,降低噪声对最终结果的干扰。经 5000 次蒙特卡洛仿真验证,本方法对目标初始距离相对误差≤5% 的概率达 83%,速度相对误差≤5% 的概率达 82%,航向绝对误差小于 2° 的概率达 95% 以上,各项精度指标均显著优于传统分段解算法。
29、3、兼具无初始信息依赖与高解算实时性,补齐现有技术短板本方法融合了两类现有技术的核心优势:既继承了批处理方法无需目标初始运动先验信息的特点,突破了递推滤波类方法对初始值高度敏感的应用限制;同时通过迭代递推的数值求解方式,避免了传统批处理方法一次性矩阵求逆计算量大、实时性差的缺陷,可同时满足水下隐蔽侦察场景的隐蔽性与实时性需求。
30、4、收敛速度与稳定性更优,不易陷入局部最优采用不动点迭代的求解策略,迭代过程针对同一组初始固定参数逐次修正,相比传统分段解算等批处理方法,收敛速度更快,收敛过程更平稳,有效降低了病态方程组下解算结果陷入局部最优的概率,在观测条件不佳、测量噪声偏大的工况下,解算稳定性更突出。
31、5、工程可实现性强,部署与升级成本低本发明算法流程清晰、逻辑连贯,整体计算量适中,无需对现有被动探测平台的硬件架构进行改造,可直接以软件算法形式集成至uuv、潜艇等平台的现有被动声呐系统中,工程落地难度低,升级改造成本小。
32、6、适用场景覆盖广泛,适配多类被动探测需求本方法不仅适用于水下自主水下航行器、潜艇、水面舰艇等平台搭载被动声呐的目标跟踪场景,还可推广应用至被动雷达、红外等其他被动探测领域;对不同航速、不同初始距离的匀速运动目标均具备良好的解算效果,适配场景丰富,通用性强。
版权声明:本站专利文献数据主要来源于国家知识产权局等公开渠道,由 技术新讯 进行整理汇编。页面设计及数据汇编的著作权归本站所有。全部内容仅供个人学习、科研评估与技术交流参考,严禁用于任何商业用途(包括但不限于直接生产制造、技术转让、倒卖数据等)。
免责条款:专利技术具有时效性,本站不对资料的绝对准确性、完整性和可实施性提供任何明示或暗示的担保。因参考本站内容造成的直接或间接损失,本站不承担相关法律责任。若您认为本站内容有侵权问题,请及时提供权属证明与我们联系,本站将在核实后依法处理。反馈意见:yyfuon@163.com