一种水下机器人多传感器融合与运动轨迹预测方法

摘要

本发明是一种水下机器人多传感器融合与运动轨迹预测方法，包括以下步骤：首先，对多个声呐观测数据进行融合；其次，建立预测模型；最后，根据目标水下机器人过去和现在的运行轨迹，进行运行轨迹预测。该方法通过多传感器数据融合，采用多传感器信息融合获取水下环境信息的方式，充分利用数据冗余性和互补性,保证水下环境感知的准确性、快速性、稳定性，本专利根据声呐观测到的水下机器人的数据利用关联算法进行航迹识别，对于不同声呐观测到水下机器人的航迹进行相似性判别,数据融合，最后进行轨迹预测。