一种水产养殖作业船自动导航路径跟踪方法

摘要

本发明公开了一种水产养殖作业船自动导航路径跟踪方法。该方法包括以下步骤：第一步：采集反映作业区轮廓的角点的位置信息，经轨迹规划，得到作业船的目标航线和航速；第二步：采集作业船实时的位置、航向和航速等数据，设定作业船的航行速度并判断是否需要切换目标路径；第三步：采用实时插点的方法计算出作业船的跟踪目标点；第四步：将作业船的位姿和运动状态数据与跟踪目标点及目标路径进行对比分析，得到航向与航速偏差，通过PD、PI算法得出航向与航速控制量，最终得到左右明轮控制量；第五步：根据最终的控制量对作业船进行实时导航控制。本发明能显著提高自动导航路径跟踪的效果，为水草清理和均匀投饵作业的高效完成提供了保障。