一、前言
船舶航迹跟踪是船舶运动控制领域的核心问题之一,视线法(Line of Sight, LOS)因原理简洁、鲁棒性强,被广泛应用于欠驱动船舶的航迹跟踪控制中。本文基于 Matlab 实现了一套完整的船舶航迹跟踪仿真系统,结合经典 PID 控制算法完成船舶艏向角的闭环控制,最终实现船舶对预设多段折线航迹的精准跟踪。
本文配套完整 Matlab 代码,适用于船舶运动控制入门学习、课程设计或科研仿真验证,代码可直接运行(Matlab R2018b 及以上版本)。
二、核心原理概述
2.1 船舶运动数学模型
本文采用简化的 3 自由度船舶平面运动模型(仅考虑纵荡、横荡、艏摇),状态量包括:
- 位置:x,y(大地坐标系下的坐标)
- 姿态:ψ(艏向角,与 x 轴正方向夹角)
- 速度:u(纵向速度)、v(横向速度)、r(艏摇角速度)
运动学方程:

动力学方程(考虑惯性项、阻尼项、控制输入):

其中:
- m11,m22,m33:船舶惯性参数
- d11,d22,d33:船舶阻尼参数
- τu:纵向推力(本文设为恒定值)
- τr:转艏力矩(PID控制输出)
2.2 视线法(LOS)航迹跟踪原理
视线法的核心思想是通过构造“虚拟目标点”,使船舶始终朝向目标航迹的切线方向,核心步骤:




![P11246 [GESP202409 六级] 小杨和整数拆分-171主机测评](https://www.171host.com/wp-content/uploads/2026/11/20261108100631-6af049a75855c-220x150.png)

