4、PID控制器原理回顾：比例、积分、微分项的作用，PID在姿态控制中的典型形式与离散化实现
在火箭姿态控制系统中，PID控制器是最基础也是应用最广泛的控制算法。无论是单级探空火箭的简易稳定，还是运载火箭主动段的姿态控制，PID控制器都承担着将姿态角偏差转化为执行机构（如燃气舵、矢量发动机或姿控喷管）指令的核心任务。理解PID各项的物理意义、在姿态控制中的典型形式以及离散化实现方法，是进行参数调优的前提。本章将从控制原理出发，结合火箭姿态控制的工程实际，深入剖析PID的三大环节，并给出可直接用于飞控代码的离散化公式。
4.1 核心原理：PID各项在姿态控制中的物理意义
PID控制器通过线性组合误差的比例、积分和微分来生成控制指令。在火箭姿态控制中，被控对象通常是刚体动力学模型，误差信号为期望姿态角与实际姿态角的差值。比例项（P）直接对当前误差做出响应，相当于一个“弹性恢复力”，其大小决定了系统对姿态偏差的响应速度。积分项（I）对历史误差进行累积，用于消除稳态误差——例如火箭在持续侧风干扰下产生的常值姿态偏差。微分项（D）则根据误差的变化趋势提前施加阻尼，抑制超调和振荡。
从频域角度看，比例项提供增益，积分项在低频段增加开环增益以提升型别，微分项在高频段引入相位超前以增加相位裕度。在火箭姿态控制中，由于箭体本身是弱阻尼或负阻尼对象（尤其是液体推进剂晃动或柔性模态耦合时），微分项的阻尼作用尤为关键。但微分项对噪声敏感，实际工程中常采用不完全微分或对测量信号进行低通滤波。
4.2 判断方法与操作流程：从连续域到离散域的转换
火箭飞控计算机以固定周期（通常为100Hz~1000Hz）运行控制律，因此必须将连续PID转换为离散形式。常用的离散化方法包括前向欧拉法、后向欧拉法和双线性变换法。对于姿态控制这种采样频率远高于系统带宽的场景，前向欧拉法已足够精确，且实现简单。
离散化实现的具体操作流程如下：
- 确定采样周期Ts：根据传感器更新率（如IMU输出频率）和控制周期要求，选择Ts。一般取系统闭环带宽的10~20倍以上。
- 选择PID结构：位置式或增量式。位置式输出值，适合直接驱动舵机；增量式输出控制增量，适合带积分执行机构（如步进电机）或需要抗积分饱和的场景。
- 离散化公式映射：将连续域的积分项用累加近似，微分项用差分近似。
- 加入滤波与限幅：对微分项进行一阶低通滤波，对积分项设置上下限，对输出进行饱和限幅。
- 代码实现与验证：在飞控代码中实现，并通过仿真或半实物测试验证。
| PID形式 | 连续域表达式 | 离散化方法 | 离散域表达式 | 适用场景 |
|---|---|---|---|---|
| 位置式 | u(t)=Kp·e(t)+Ki·∫e(t)dt+Kd·de/dt | 前向欧拉 | u(k)=Kp·e(k)+Ki·Ts·Σe(j)+Kd/Ts·[e(k)-e(k-1)] | 直接输出舵面指令 |
| 增量式 | 同上 | 差分 | Δu(k)=Kp·[e(k)-e(k-1)]+Ki·Ts·e(k)+Kd/Ts·[e(k)-2e(k-1)+e(k-2)] | 带积分执行机构、抗饱和 |
| 不完全微分 | D环节串联一阶惯性 | 后向欧拉 | uD(k)=α·uD(k-1)+(1-α)·Kd/Ts·[e(k)-e(k-1)] | 测量噪声较大的工程环境 |
4.3 案例拆解：某探空火箭俯仰通道PID调优实战
某单级探空火箭在主动段飞行中，俯仰通道采用PID控制器，执行机构为燃气舵。初始参数为Kp=0.8，Ki=0.05，Kd=0.2，采样周期Ts=0.01s（100Hz）。飞行试验中，火箭在起飞后2秒出现持续约3°的俯仰静差，且伴随小幅振荡（频率约2Hz）。
分析过程：静差的存在表明积分项作用不足或存在常值干扰（如推力偏心）。振荡频率2Hz接近箭体一阶弯曲模态，微分项可能放大了结构振动信号。通过遥测数据回放，发现舵机指令中叠加了明显的高频噪声，确认微分项对噪声的放大是振荡诱因之一。
调优步骤：
- 将Ki从0.05提升至0.12，以消除静差。同时设置积分限幅为±5°，防止积分饱和。
- 对微分项增加一阶低通滤波，截止频率设为10Hz，滤除结构模态噪声。
- 将Kd从0.2降至0.15，降低对高频噪声的敏感度。
- 在仿真中验证调整后的参数，确认相位裕度从35°提升至52°，幅值裕度从6dB提升至12dB。
结果对比：第二次飞行试验中，俯仰静差降至0.3°以内，振荡幅值衰减70%，姿态稳定精度满足设计要求。代价是响应速度略有降低（上升时间从0.8s增至1.1s），但仍在指标范围内。
4.4 常见误区与总结复盘
误区一：认为PID参数是固定不变的。实际上，火箭在飞行过程中动压、质量、转动惯量变化剧烈，固定参数难以在全弹道保持最优性能。工程上常采用增益调度（Gain Scheduling）或自适应控制。
误区二：忽略采样周期的影响。采样周期过大，离散化误差显著，可能导致系统失稳；采样周期过小，则增加计算负担且微分项噪声放大严重。
误区三：将积分项视为“万能补丁”。积分项只能消除常值或缓慢变化的干扰，对于高频扰动或大阶跃指令，积分作用反而会引入超调。
误区四：直接使用连续域整定参数而不做离散化修正。离散化后，等效的Kp、Ki、Kd会随Ts变化，必须重新验证。