一种基于航向平滑技术的自主水下机器人路径跟踪方法

摘要

一种基于航向平滑技术的自主水下机器人路径跟踪方法，本发明涉及自主水下机器人路径跟踪方法。本发明的目的是为了解决现有AUV路径跟踪控制中艏向穿越‑π/π不连续点的情况时，路径跟踪准确率低的问题。过程为：一、测量初始时刻AUV的状态测量值，设置AUV的期望路径；二、得到AUV的路径跟踪误差；三、得到优化后的路径跟踪误差；四、使优化后的路径跟踪误差收敛，得到AUV的控制输入，AUV的控制输入包括控制AUV的力矩和力；五、判断AUV是否走完跟踪路径，若走完跟踪路径，得到AUV的控制输入；若没有走完跟踪路径，重新执行二到五，直至AUV走完跟踪路径。本发明用于自主水下机器人路径跟踪领域。