第1章 PID控制基础

1. PID控制基础：从火箭姿态控制问题引出PID，比例、积分、微分的物理意义

各位同学，大家好。我是你们的老朋友，一个在飞控领域摸爬滚打了十几年的工程师。今天咱们开始聊火箭姿态控制，这玩意儿听着挺玄乎，但说白了，核心就是怎么让一个几十吨重的“大炮仗”在天上稳稳当当地飞。

你想想看，火箭一飞冲天，发动机推力稍微偏一点，或者遇到一阵横风，箭体就会开始偏转。如果不纠正，几秒钟后它就翻跟头了。那怎么纠正呢？这就引出了我们今天的主角——PID控制器。

我们先想象一个最简单的场景。你手里拿着一根长长的竹竿，想让它竖直立在手掌心上。你会怎么做？

火箭的姿态控制，本质上就是这件事。只不过，火箭的“眼睛”是陀螺仪和加速度计，它的“大脑”是飞控计算机，而它的“手”是发动机的摆动喷管或者姿控推力器。

火箭的目标姿态是给定的，比如“保持垂直向上”。实际姿态由传感器测出来。两者的差值，我们叫它“偏差”。控制器的任务，就是根据这个偏差，算出需要多大的控制力，把这个偏差消除掉。

核心思想： 闭环反馈控制。测量输出，与目标比较，根据误差产生控制信号。

PID控制器就是那个“大脑”里运行的算法。它有三个部分：比例（P）、积分（I）、微分（D）。我习惯把它们比作三个性格各异的“参谋”。

比例控制最简单直接。偏差越大，控制力就越大。

物理意义： 如果火箭偏了5度，我就给一个能产生5度纠正效果的力。如果偏了10度，力就加倍。

用公式表示就是：u(t) = Kp * e(t)，其中 e(t) 是当前偏差，Kp 是比例系数。

我在项目中遇到过一个问题：只用比例控制，火箭永远回不到绝对零度。为什么？因为当偏差变得很小的时候，控制力也变小了。如果这个力刚好被摩擦力或者发动机的“死区”抵消掉，火箭就停在那个小偏差上，回不来了。这就是所谓的“稳态误差”。

我的经验： 调P参数时，先给一个不大的值，看系统响应。如果震荡得厉害，说明P太大了。如果响应太慢，说明P太小了。我一般从0.1开始试。

积分控制就是为了解决比例控制那个“稳态误差”而生的。它把过去所有的偏差都累加起来。只要偏差一直存在，积分项就会一直增长，直到输出足够大的控制力，把那个小偏差彻底抹掉。

物理意义： 你欠我的账，我记着呢。只要没还清，利息就一直涨。

公式：u(t) = Ki * ∫e(t)dt。这个 ∫e(t)dt 就是偏差对时间的累积。

嗯，这里要注意。积分项虽然能消除稳态误差，但它有个坏毛病——容易“积分饱和”。

避坑指南： 我曾经在一个项目中，积分系数设得太大。火箭刚起飞时偏差很大，积分项迅速累积到一个巨大的值。等偏差反转时，这个巨大的积分值需要很长时间才能“吐”出来，导致火箭超调严重，差点失控。后来我加了抗积分饱和（Anti-windup）逻辑，才解决了这个问题。

微分控制看的是偏差的变化趋势。偏差是在变大还是在变小？变快的速度是多少？

物理意义： 你看到球滚过来了，不是等它撞到你才躲，而是看到它滚动的趋势就提前让开。这就是“预见性”。

公式：u(t) = Kd * de(t)/dt。这个 de(t)/dt 就是偏差的变化率。

微分项能抑制震荡，增加系统的阻尼。它让系统更“稳”，不那么容易“激动”。

但是，微分项对噪声极其敏感。传感器信号稍微有点毛刺，微分项就会剧烈跳动，导致执行机构乱动。

我的建议： 实际工程中，很少直接使用纯微分。我一般会在微分项前面加一个低通滤波器，把高频噪声滤掉。或者干脆用“微分先行”的结构，只对输出量求导，不对偏差求导。

把三个部分加起来，就是完整的PID控制器：

u(t) = Kp * e(t) + Ki * ∫e(t)dt + Kd * de(t)/dt

这个公式，就是飞控算法的基石。它简单，但极其有效。

为了让你更直观地理解，我画了一张图，展示了PID控制器的核心逻辑：

说白了，PID控制就是三个“参谋”一起开会，根据火箭的“过去、现在、未来”三个维度的信息，共同决策出一个最合适的控制指令。比例是主力，积分是纠偏，微分是维稳。

我个人习惯在调参时，先调P让系统动起来，再加D让系统稳下来，最后加I消除静差。这个顺序，是我在无数次炸机（当然，是仿真里炸）之后总结出来的血泪经验。

好了，这一节的内容就到这里。PID的基础概念，你心里应该有个谱了。记住，它没那么神秘，就是三个数的加减乘除。但就是这三个数，决定了火箭能不能稳稳地飞向太空。