基于欧拉法的MATLAB仿真程序：船舶无人艇的线性Nomoto响应型操纵运动回转与Z型实验研究

船舶/无人艇/无人船，线性nomoto响应型操纵运动，回转实验和Z型实验MATLAB仿真程序（欧拉法）

最近在研究无人艇的运动控制仿真，发现Nomoto模型在船舶操纵性仿真中真的挺实用。今天就拿Matlab做个玩具级仿真程序，带大家感受下如何用一阶Nomoto模型实现回转实验和Z型实验的模拟。

先看Nomoto模型的灵魂方程：

function dr = nomoto_model(t, r, delta, K, T) dr = (K*delta - r)/T; % 转首角速度微分方程 end

这个一阶方程把船舶的操纵响应简化为舵角δ与转首角速度r之间的关系。K代表船舶的转向能力，T是响应时间常数。比如某型无人船参数可能是K=0.8，T=2.5，这表示它每秒钟转首角速度能变化0.32 rad/s。

做仿真当然少不了欧拉法，咱们直接上硬核循环：

% 初始化参数 dt = 0.1; % 时间步长 t = 0:dt:100; r = zeros(size(t)); psi = zeros(size(t)); % 航向角 delta = zeros(size(t)); % 舵角 % 仿真主循环 for k = 1:length(t)-1 % 舵令生成逻辑放在这里 r(k+1) = r(k) + nomoto_model(t(k), r(k), delta(k), K, T)*dt; psi(k+1) = psi(k) + r(k)*dt; % 航向角积分 end

这段代码的精髓在于航向角的积分过程。注意这里用了前向欧拉法，虽然精度不算高，但对于教学演示完全够用。实际工程中可以考虑四阶龙格库塔法，但咱们今天主打一个简单粗暴。

船舶/无人艇/无人船，线性nomoto响应型操纵运动，回转实验和Z型实验MATLAB仿真程序（欧拉法）

回转实验最刺激的就是满舵打到底。设置舵角时加点小技巧：

% 回转实验舵令设置 delta(t>=10 & t<=100) = 35*pi/180; % 第10秒打满右舵35度

跑完仿真会看到航向角像脱缰野马一样线性增长，转首角速度则呈现典型的一阶系统阶跃响应。用极坐标画个轨迹图，那优美的圆形轨迹瞬间让人成就感爆棚。

Z型实验才是真正的骚操作，需要自动舵控制逻辑：

% Z型实验自动舵逻辑 target_psi = 20*pi/180; % 目标航向改变量 for k = 1:length(t)-1 if mod(floor(t(k)/20),2) == 0 target = target_psi; else target = -target_psi; end % 简单PD控制器 error = target - psi(k); delta(k) = 0.5*error + 0.2*(error - prev_error)/dt; prev_error = error; end

这个控制逻辑会让船舶像醉汉一样走出之字形轨迹。参数整定是门艺术，试着把0.5和0.2改成其他值，立马能看到船舶从优雅的S型变成抽搐的锯齿状——这就是控制参数对系统动态特性的直观影响。

最后来个三维轨迹可视化彩蛋：

% 三维轨迹计算 U = 5; % 航速5m/s x = cumsum(U*cos(psi)*dt); y = cumsum(U*sin(psi)*dt); plot3(x,y,t); xlabel('东向位置'); ylabel('北向位置'); zlabel('时间')

看着时空坐标系中螺旋上升的轨迹曲线，突然理解为什么航海家喜欢说"船在时空中编织航迹"。代码虽简单，但把物理模型、数值计算和可视化有机结合，这就是仿真工程的魅力所在吧。