3、运动控制核心概念：伺服电机、编码器反馈、PID控制环、位置/速度/扭矩模式

好，咱们进入正题。这一章，我打算把运动控制里最核心的几个概念掰开揉碎了讲清楚。你想想看，不管你是做机器人、数控机床，还是做自动化产线，最终执行动作的，无非就是这些东西：伺服电机、编码器、PID控制环，以及那三种最常见的控制模式。

我个人习惯，在讲任何系统之前，先搞清楚“谁在干活”、“谁在看”、“怎么调”。这三个问题搞明白了，后面的中断设计才有根。

3.1 伺服电机：运动系统的“肌肉”

伺服电机，说白了就是能精确控制位置、速度、扭矩的电机。它跟普通电机最大的区别在于——它知道自己转到了哪里。

为什么它能知道？因为它屁股后面跟着一个编码器。我见过不少新手，把步进电机当伺服用，结果丢步了都不知道。嗯，这里要注意：伺服电机是闭环控制，步进电机是开环控制。这是本质区别。

我在项目中遇到过一件事：有一次调试一个高速贴片机，电机选型时只算了扭矩，没算转动惯量匹配。结果一跑高速，电机抖得像筛糠。后来换了更大惯量的电机，才稳下来。所以，选伺服电机，不光要看功率，还要看惯量比，一般建议控制在 5:1 以内。

3.2 编码器反馈：系统的“眼睛”

编码器就是伺服电机的眼睛。它告诉控制器：“我现在转到哪个角度了”。没有它，闭环控制就是瞎搞。

编码器分两大类：

• 增量式编码器：只输出脉冲，告诉你“我动了多少”，但不知道绝对位置。断电后位置丢失。
• 绝对式编码器：输出绝对位置值，一上电就知道自己在哪。多圈绝对式还能记录转了多少圈。

我个人建议，如果做硬实时系统，尤其是安全相关的（比如医疗设备、协作机器人），优先选绝对式编码器。为什么？因为上电不需要回零，省掉一个危险动作。我曾经在一个项目中，因为增量式编码器断电后位置丢失，导致机器人上电瞬间撞了夹具，那叫一个心疼。

类型	优点	缺点	典型应用
增量式	成本低、响应快	断电丢位置、需回零	普通自动化设备
绝对式	上电即知位置、抗干扰	成本高、通信延迟略大	机器人、医疗、数控

3.3 PID控制环：系统的“大脑”

PID，比例-积分-微分。这是运动控制里最经典、最实用的控制算法。你想想看，一个电机要转到目标位置，怎么转？直接给最大电压？那肯定冲过头，然后来回震荡。

PID就是干这个的：

• P（比例）：当前误差越大，输出越大。但光有P，会有稳态误差。
• I（积分）：把过去的误差累积起来，消除稳态误差。但I太强，系统会震荡。
• D（微分）：预测未来的误差趋势，提前刹车。D能提高响应速度，但对噪声敏感。

我调PID有个习惯：先调P，再调I，最后调D。具体步骤：

1. 把I和D设成0，P从小到大加，直到系统开始震荡。记下这个P值。
2. 取P的一半作为工作值，然后加I，消除静差。
3. 最后加一点点D，抑制超调。D不要太大，否则高频噪声会让你崩溃。

// 一个简单的位置环PID，运行在定时器中断里
float pid_position(float target_pos, float current_pos) {
    float error = target_pos - current_pos;
    static float integral = 0;
    static float last_error = 0;
    
    float P = 1.5;  // 比例系数
    float I = 0.01; // 积分系数
    float D = 0.1;  // 微分系数
    
    integral += error;
    float derivative = error - last_error;
    last_error = error;
    
    float output = P * error + I * integral + D * derivative;
    
    // 输出限幅，防止积分饱和
    if (output > 100.0) output = 100.0;
    if (output < -100.0) output = -100.0;
    
    return output;
}

3.4 位置/速度/扭矩模式：三种控制视角

伺服驱动器通常支持三种控制模式。说白了，就是你想控制什么量：

• 位置模式：你给目标位置，驱动器自己算怎么转过去。适合点位运动、插补运动。
• 速度模式：你给目标速度，驱动器保持这个速度。适合恒速传送带、主轴。
• 扭矩模式：你给目标扭矩（电流），驱动器输出恒定力矩。适合压紧、张力控制。

我建议，如果你做的是硬实时系统，尽量用位置模式或速度模式。为什么？因为扭矩模式对负载变化太敏感，实时性要求极高，一旦中断响应慢了，力矩就失控了。

举个例子：我曾经做一个张力控制项目，用了扭矩模式。结果编码器反馈中断偶尔被高优先级任务抢占，导致张力波动。后来改成速度模式加前馈补偿，问题解决。所以，模式选择要结合你的实时性能力来定。

3.5 本章知识体系图

下面这张图，是我自己画的，把这一章的核心逻辑串起来了。你一看就明白：

这张图你看懂了吗？说白了，伺服电机是执行者，编码器是观察者，PID是决策者。而位置/速度/扭矩模式，就是告诉PID：“你这次要盯住哪个量”。

好了，这一章的核心概念就这些。你把这些搞清楚了，后面讲中断系统设计时，你才知道中断里到底要处理什么数据、多快处理一次、处理不好会出什么事。嗯，下一章我们直接进入中断系统的硬件架构，到时候见。