4. 舵机控制系统设计

舵机是无人飞行器执行机构中最典型的闭环位置伺服单元。它接收飞控输出的PWM或总线指令，驱动舵面偏转到目标角度，其动态品质直接决定姿态回路的相位裕度与操纵响应。本节围绕位置环建模、PID整定、死区与饱和补偿以及阶跃响应实验四个环节展开，目标是让读者能够从物理对象出发，建立可用的控制模型，并完成一次可复现的整定与验证。

一、舵机位置环的物理构成与建模

典型舵机由直流有刷电机、减速齿轮组、电位器或磁编码器、H桥驱动与位置控制器组成。位置环的输入是目标角度指令 θ_cmd，输出是实际舵面角度 θ_out。建模时通常把电机电枢回路与机械转动惯量合并为二阶对象：电枢电压 U 经反电动势常数 K_e 与转矩常数 K_t 转换为电磁转矩，再克服折算到电机轴的等效转动惯量 J_eq 与粘性阻尼 B_eq，得到角速度 ω，积分后成为角度 θ。若忽略电枢电感，可简化为：

θ(s)/U(s) = K / [s(J_eq·s + B_eq + K_e·K_t/R_a)]

其中 R_a 为电枢电阻，K 为综合增益。对于教学示例，可取 J_eq=1.2×10^-5 kg·m²，B_eq=3.5×10^-5 N·m·s/rad，R_a=2.4 Ω，K_t=0.018 N·m/A，K_e=0.018 V·s/rad。代入后可得一个近似一阶惯性加积分的对象，时间常数约 0.08 s。该参数为合理假设，用于说明建模流程，实际应以辨识实验为准。

辨识方法上，最直接的是给舵机施加小幅方波电压，记录角度响应，用一阶加纯延迟模型 θ(s)/U(s)=K·e^-τs/(Ts+1) 拟合。若舵机内部已封装位置环，则外部只能辨识“指令—角度”闭环特性，此时应把舵机视为一个带延迟的二阶或一阶闭环对象，再在其外设计外环控制器。

二、PID参数整定方法

位置环PID整定可采用经验法或Ziegler-Nichols法。对于舵机这类要求快速无超调的执行机构，推荐先采用“临界比例度法”获取基础参数，再根据阶跃响应微调。具体操作：将积分和微分置零，逐渐增大K_p直到系统出现等幅振荡，记录此时临界增益K_u和振荡周期T_u。若K_u=8.5、T_u=0.12 s，则按PID推荐值K_p=0.6K_u=5.1，K_i=2K_p/T_u=85，K_d=K_pT_u/8=0.077。该组参数为示例计算，实际需根据舵机负载和摩擦调整。

整定过程中应重点关注三个现象：一是积分饱和导致的大指令超调，二是微分对编码器噪声的放大，三是死区引起的稳态极限环。若发现稳态时舵面在目标角附近小幅抖动，通常是K_p过大或死区补偿不足；若大角度指令下超调严重，应检查积分限幅和抗饱和逻辑。

三、死区与饱和补偿的实现

死区补偿的常用做法是在控制器输出后叠加一个与误差符号相同的最小启动电压U_dead。例如实测舵机在0.35 V以下不转动，则当|u|<0.35 V且|e|>阈值时，输出u=sign(e)·0.35 V。更平滑的方式是采用死区逆函数：u_comp=sign(u)·(U_dead+(|u|-U_dead)·k)，其中k为补偿斜率，通常取1.0~1.3。

饱和补偿主要针对积分项。当控制器输出达到限幅值U_max时，停止积分累加或按反算方式回退积分量。实现上可在每个控制周期判断：若|u_raw|>U_max且误差方向与饱和方向一致，则i_term保持不变；否则正常累加。这样可避免指令从大角度回小角度时出现明显延迟。

四、基于实际舵机的阶跃响应实验

实验平台由舵机、舵机测试架、角度传感器、数据采集卡和上位机组成。以某型20 kg·cm数字舵机为例，供电6.0 V，指令为PWM 50 Hz，脉宽0.5~2.5 ms对应-90°~+90°。实验步骤：

1. 将舵机固定在测试架上，安装角度传感器并校准零点，确保传感器读数与舵面实际角度一致。
2. 上位机发送阶跃指令：从0°跳变到+30°，保持2 s，再回到0°，记录角度随时间变化曲线。
3. 采样率设为1 kHz，记录至少5个完整阶跃周期，取平均以降低噪声影响。
4. 从响应曲线提取上升时间t_r（10%~90%）、超调量σ%、稳态误差e_ss和调节时间t_s（±2%带）。

一组合理的示例结果如下：未加补偿时，t_r=0.18 s，σ%=12%，e_ss=1.5°，t_s=0.45 s；加入死区补偿和抗饱和后，t_r=0.14 s，σ%=4%，e_ss=0.3°，t_s=0.28 s。该数据为教学示例，用于说明补偿效果，实际数值因舵机型号和负载而异。

最后需要强调，舵机位置环的建模与整定不是一次完成的，而应结合飞行工况中的气动负载变化进行复测。地面测试得到的参数可作为初始值，装机后还需在带载条件下验证大舵面偏转时的饱和与回中性能，确保执行机构在整个包线内都能稳定跟随指令。