基于Fossen模型的无人艇轨迹跟踪文献复现与仿真研究：MATLAB与Simulink仿真实践

无人车辆 轨迹跟踪 LOS制导无人艇无人船 Fossen模型 文献复现 大量出图 路径跟随 MATLAB仿真 simulink仿真

最近在搞无人船轨迹跟踪的仿真，发现LOS制导和Fossen模型这俩兄弟真是绝配。先说说LOS（Line of Sight）制导这玩意儿，本质上就是个几何导航法——想象你在开车，眼睛盯着前方某个点打方向盘，差不多就是这个道理。不过要让船乖乖跟着预定路径走，光有几何关系可不够，得把动力学特性揉进去。

先看段LOS核心代码：

function [desired_heading] = LOS_guidance(eta, path, Delta) x = eta(1); y = eta(2); % 找最近路径点 [~, idx] = min(sum((path - [x,y]).^2,2)); % 前视点计算 lookahead_point = path(idx,:) + Delta*(path(idx+1,:)-path(idx,:)); % 期望航向角 desired_heading = atan2(lookahead_point(2)-y, lookahead_point(1)-x); end

这里的Delta控制着"前视距离"，就像开车时看多远的路面。Delta越大，船的反应越"佛系"，但太小容易震荡。我试过把Delta从0.5调到2.0，跟踪轨迹从抽搐的折线变成优雅的弧线，特别有意思。

接下来是重头戏Fossen模型，这玩意儿把船舶运动拆解成动力学和运动学两部分。复现文献时发现个小坑——很多人容易忽略阻尼矩阵的非对称性。看这个简化版动力学方程：

function dnu = FossenDynamics(nu, tau) M = [17.11 0; 0 30.11]; % 惯性矩阵 D = [4.22 0.56; -0.32 5.31]; % 阻尼矩阵 dnu = M \ (tau - D*nu); % 加速度计算 end

注意D矩阵的非对角项符号不同，这反映了横荡和艏摇运动的耦合特性。之前用对称矩阵仿真时，船总像喝醉似的画8字，修正后立马老实了。

无人车辆 轨迹跟踪 LOS制导无人艇无人船 Fossen模型 文献复现 大量出图 路径跟随 MATLAB仿真 simulink仿真

仿真架构建议用Simulink分层搭建：

1. 顶层用Signal Builder生成锯齿形路径
2. Guidance层嵌LOS算法
3. Control层放PID控制器
4. Plant层实现Fossen模型

调试时发现采样时间不能大于0.1秒，否则艏摇角会像过山车一样刺激。

出图技巧方面，推荐这个画图模板：

figure('Position',[200 200 800 600]) subplot(211) plot(path(:,1),path(:,2),'--k','LineWidth',1.5); hold on; plot(eta_history(:,1),eta_history(:,2),'b'); legend('预定路径','实际轨迹','Location','best'); subplot(212) plot(time, heading_error*180/pi); xlabel('时间(s)'); ylabel('航向误差(°)'); title('跟踪误差变化');

重点说说出图经验：用子图对比能直观显示控制效果，误差曲线记得转成角度制。调试时发现前视距离Delta=1.2时，误差能稳定在±3°以内，超过这个值虽然更平滑，但入弯时会有点"外抛"现象。

最后给个实用建议：仿真时先把路径跟踪调通，再上复杂环境干扰。有次手贱先加了海流模型，结果根本分不清是算法问题还是物理效应，debug到怀疑人生。现在我的仿真流程是：直线路径→折线路径→圆周转弯→最后才加干扰项，像打游戏升级一样循序渐进。