一种基于卡尔曼滤波和启发式的船舶航迹预测及感测规划算法

    公开(公告)号:CN117232529A

    公开(公告)日:2023-12-15

    申请号:CN202311334976.8

    申请日:2023-10-16

    IPC分类号: G01C21/20

    摘要: 本发明提供了一种基于卡尔曼滤波和启发式的船舶航迹预测及感测规划算法,其特征在于:具体包括:步骤1、获取船基系统传输的船舶信息,并对其进行预处理得到船舶的位置、速度和方位信息;步骤2、对船舶的位置、速度和方位信息进行坐标转换和时间配准,将经纬度形式信息转换为极坐标形式信息,使用分段线性插值法将不同步的信息统一到同一时刻;步骤3、根据卡尔曼滤波算法,对处理后的数据进行航迹关联,得到规划出的若干条预测航迹;步骤4、按照启发式算法的判断准则,对步骤3得到的航迹进行融合,得到最终的航迹预测结果。通过卡尔曼滤波算法能够通过对系统状态进行最优估计,并获取实时的运行状态估计与预测。