3. 转向执行机构数学模型建立

转向执行机构是自动导航农机从“决策”走向“动作”的最后一环，其数学模型的质量直接决定横向控制精度。工程上常见的两类执行机构是电动推杆（含直流电机、减速器与丝杠）和液压转向系统（比例阀控液压缸）。本节按“机理建模—参数辨识—模型验证”的主线展开，重点说明如何从物理结构写出可用的传递关系，以及如何用实验把未知参数辨识出来并检验模型是否可信。

一、先约定符号与正方向

建模前必须统一参照系，否则后续辨识与控制器设计会因符号混乱而失效。本节约定：以车辆直线行驶时前轮中位为转角零点，前轮左转为正、右转为负；电动推杆伸出使前轮左转时，推杆位移 x 取正；液压缸活塞杆同向运动时位移 y 取正；比例阀控制电压 u 取正时对应左转方向流量。所有公式与图示均遵循这一约定，若实际样机方向相反，只需在最终增益前乘 −1，而不改动模型结构。

二、电动推杆/电机的机理模型

电动推杆可拆为“直流电机—减速器—丝杠—推杆”四段。直流电机电枢回路满足 u = R_ai + L_adi/dt + K_eω，电磁转矩 T_e = K_ti；机械侧 Jdω/dt = T_e − Bω − T_L。经减速比 i_g 与丝杠导程 p_h 折算，推杆线速度 v = ωp_h/(2πi_g)，推力 F = 2πi_gηT_e/p_h。忽略电感与摩擦非线性时，输入电压到推杆位移可得二阶形式：

X(s)/U(s) = K_p / [ s ( T_m s + 1 ) ]
K_p = p_h / (2π i_g K_e)，T_m = R_a J_eq / (K_t K_e)

其中 J_eq 为折算到电机轴的等效惯量。该式表明推杆是“积分+一阶惯性”环节：稳态时位移与电压呈积分关系，动态上存在一个时间常数 T_m。实际推杆还存在死区、丝杠间隙与限位，建模时可在积分环节前串入死区宽度 d，并在输出端加饱和限幅 [x_min, x_max]。

三、比例阀控液压缸的机理模型

阀控缸的核心是“阀口流量—缸两腔压力—负载运动”三者耦合。以四通滑阀为例，阀口流量 Q_L = K_qx_v√(Δp) − K_cp_L，其中 x_v 为阀芯位移（近似正比于控制电压 u），p_L 为负载压差。缸的连续性方程 Q_L = A_pdy/dt + C_tp_L + V_t/(4β_e)·dp_L/dt，力平衡 A_pp_L = md²y/dt² + B_pdy/dt + Ky + F_L。在阀芯位移小、负载压力变化不大的工作点线性化后，可得阀芯位移到活塞位移的三阶传递函数：

Y(s)/X_v(s) = (K_q/A_p) / [ s( s²/ω_h² + 2ζ_h s/ω_h + 1 ) ]
ω_h = √(4β_e A_p² / (V_t m))，ζ_h ∝ C_t 与 B_p

液压固有频率 ω_h 与液压弹簧刚度、负载质量相关，阻尼比 ζ_h 通常很小（0.1～0.3），这是液压转向容易出现振荡的根源。比例阀本身还有一阶或二阶动态 G_v(s)，工程上常近似为 K_v/(T_vs+1)，T_v 约几十毫秒。因此完整模型为阀动态串接阀控缸三阶环节，再串入转向梯形到前轮转角的几何传动比 i_s。

四、参数辨识实验设计

机理模型给出结构，参数仍需实验确定。辨识前先明确可测信号：控制电压 u 可直接采集，推杆位移可用拉线位移传感器或电机编码器换算，前轮转角可用角度传感器或视觉标定获得；液压系统还需在阀进口与缸两腔加装压力传感器。采样率建议不低于系统最高关注频率的 10 倍，电动推杆取 100 Hz、液压系统取 200 Hz 以上，并同步记录时间戳。

对电动推杆，采用多幅值阶跃实验：在空载与模拟转向阻力两种工况下，分别施加 20%、40%、60% 占空比阶跃，记录位移响应。由稳态速度斜率求 K_p，由 63.2% 稳态速度对应时刻估 T_m，由启动延迟估死区 d。对液压系统，采用扫频实验更有效：以 0.1～10 Hz 的正弦电压激励，记录 u 与 y，用互功率谱求幅频与相频，由谐振峰频率读 ω_h，由峰值高度估 ζ_h，由低频斜率与相位滞后估 K_q/A_p 与 T_v。扫频时幅值应小（如 ±0.5 V），避免阀饱和与缸到限位。

辨识算法上，可先用最小二乘拟合离散 ARX 模型得到初步参数，再以机理模型的物理参数为待估量做非线性最小二乘，把初值约束在合理范围（如 ζ_h∈[0.05,0.5]），避免陷入无物理意义的解。

五、模型验证与结果判读

验证必须使用与辨识不同的数据。常用三项指标：一是时域阶跃拟合度，用 fit = 1 − ‖y_实测−y_模型‖/‖y_实测−mean(y_实测)‖ 计算，工程上大于 80% 可认为模型可用于控制器设计；二是频域幅相误差，在 0.1～5 Hz 内幅值误差小于 3 dB、相位误差小于 15°；三是残差检验，若残差仍含明显周期性成分，说明模型漏掉了间隙、摩擦或阀死区等非线性环节，应补充相应模块后重新辨识。

需要强调的是，模型不是越复杂越好。若控制目标是 1 Hz 以下的路径跟踪，把推杆简化为“积分+死区”、把液压系统简化为“二阶+纯延迟”往往已足够；只有当出现明显谐振或高频抖动时，才有必要保留三阶液压环节与阀动态。建模的终点是服务于控制器设计与故障判断，而非追求形式上的完备。