一种水面无人艇路径跟踪控制方法

摘要

本发明公开了一种水面无人艇路径跟踪控制方法，通过当前无人艇运动的状态信息、位置坐标信息，进行路径点的离散并根据点更新机制进行目标点的更新；通过状态信息进行航向规划，计算当前目标点的视线角视线余角横侧偏差SE、视线补偿量并求得当前航向误差根据航向规划信息，进行航向控制，计算控制器输出力矩Np，根据规划航速和海况估算推进器推力Xp；对输出推力Xp、输出力矩Np进行推力分配，求得各推进器的执行信号，并控制推进器执行指令动作。本发明使得无人艇可以跟踪曲线路径，保证了路径跟踪的快速性以及稳定性，在风浪存在的条件下大大避免了侧漂的发生，实现了对航速较为准确的控制，对于无人艇的路径跟踪控制有重要的作用。