欠驱动AUV水下动态目标跟踪中的期望路径构造方法
Abstract:
本发明提供的是一种欠驱动AUV水下动态目标跟踪中的期望路径构造方法。首先根据交互多模型方法得到当前时刻目标位置的估计值,通过超短基线与双目视觉定位系统得到当前时刻目标位置的观测值,然后通过卡尔曼滤波得到当前时刻目标位置的最优估计值;选择AUV位置、所选历史目标点序列、当前时刻目标的最优估计值作为期望目标点序列;引入几何约束条件,根据期望目标点序列构造三次样条曲线,选择该样条曲线作为AUV跟踪的期望路径曲线。该方法可以实时更新期望路径曲线,提高AUV应对目标不确定性以及瞬时干扰的影响,提高跟踪快速性和精度。
Patent Agency Ranking
0/0