2. 运动控制基础：系统架构与控制回路

大家好，我是老张。今天咱们聊聊运动控制的基础框架。说实话，很多新手一上来就盯着算法和代码，反而忽略了整个系统是怎么搭起来的。我个人习惯，先看架构，再看细节。这样出了问题，你才知道该查哪一环。

2.1 运动控制系统架构

一个典型的运动控制系统，说白了就是三大部分：控制器、驱动器、执行器与传感器。它们之间通过信号线连起来，形成一个闭环。

我画了一张图，帮你理清它们的关系：

你看，控制器发出位置或速度指令，驱动器把它转成电流，电机就转起来了。编码器把实际位置和速度反馈回来，控制器再调整指令。这就是一个完整的闭环。

2.2 三环控制：位置环、速度环、电流环

大多数伺服系统都采用「三环」结构。从外到内分别是：位置环 → 速度环 → 电流环。每个环都有自己的任务。

2.2.1 电流环（最内环）

电流环是响应最快的环，通常由驱动器内部的硬件或固件完成。它的任务很简单：让电机绕组里的电流精确跟随给定值。说白了，就是控制力矩。

我记得有一次调试一个高速主轴，电流环参数没调好，电机嗡嗡响，发热严重。后来把电流环的PI参数重新整定，问题就解决了。嗯，这里要注意：电流环的采样频率一般要10kHz以上，否则跟不上。

2.2.2 速度环（中间环）

速度环在电流环外面。它根据目标速度和实际速度的差值，计算出需要的电流指令，然后交给电流环去执行。速度环的响应比电流环慢一些，但比位置环快。

我建议速度环的带宽设置为电流环的1/5到1/10。为什么？你想想看，内环必须比外环快，否则整个系统会震荡。我曾经见过一个项目，工程师把速度环带宽设得和电流环一样高，结果电机一启动就尖叫，差点把联轴器扭断。

2.2.3 位置环（最外环）

位置环是最外层的环，也是最慢的。它负责让电机轴精确停在目标位置。位置环的输出就是速度环的给定值。

位置环通常只用P控制（比例），很少加I。为什么？因为位置环本身就有积分作用——只要位置误差存在，速度环就会一直调整，直到误差为零。加I反而容易引起超调和震荡。

2.3 常用执行器与传感器

执行器就是让东西动起来的部件，传感器就是告诉你动得怎么样的部件。两者缺一不可。

2.3.1 常用执行器

类型	特点	典型应用
直流有刷电机	控制简单，成本低，但电刷磨损	低成本泵、风扇
直流无刷电机 (BLDC)	效率高，寿命长，需要电子换向	无人机、电动车
步进电机	开环位置控制，低速扭矩大，但高速易丢步	3D打印机、小型机械臂
伺服电机	闭环控制，精度高，响应快，价格贵	数控机床、工业机器人
直线电机	直接产生直线运动，无传动间隙	高精度定位平台

我个人最常用的是伺服电机。虽然贵，但省心。步进电机在低速场合挺好用，但一跑高速就容易丢步。我曾经在一个贴片机项目里用步进电机，结果贴片位置总偏，换成伺服后一次搞定。

2.3.2 常用传感器

传感器类型	测量量	精度等级
增量式编码器	位置、速度	中等 (几百到几千线)
绝对式编码器	绝对位置	高 (单圈/多圈)
旋转变压器	位置、速度	高 (抗振动、耐高温)
霍尔传感器	转子位置 (换向用)	低 (仅用于换向)
光栅尺	直线位置	极高 (微米级)

2.4 控制回路的基本实现

下面是一个简单的速度环PID控制器的伪代码。实际项目中，你还要考虑限幅、积分分离、抗积分饱和等细节。

// 速度环PID控制器 (伪代码)
float speed_pid(float target_speed, float actual_speed) {
    float error = target_speed - actual_speed;
    
    // 比例项
    float p_out = Kp * error;
    
    // 积分项 (带限幅)
    integral += Ki * error * dt;
    if (integral > INTEGRAL_MAX) integral = INTEGRAL_MAX;
    if (integral < -INTEGRAL_MAX) integral = -INTEGRAL_MAX;
    
    // 微分项
    float derivative = (error - last_error) / dt;
    float d_out = Kd * derivative;
    
    last_error = error;
    
    // 输出电流指令
    float current_cmd = p_out + integral + d_out;
    
    // 输出限幅
    if (current_cmd > CURRENT_MAX) current_cmd = CURRENT_MAX;
    if (current_cmd < -CURRENT_MAX) current_cmd = -CURRENT_MAX;
    
    return current_cmd;
}

你看，代码本身并不复杂。但真正难的是参数整定。Kp、Ki、Kd怎么调？我个人的经验是：先调Kp，让系统不震荡；再加一点点Ki，消除稳态误差；最后看情况加Kd，抑制超调。别一上来就三个参数一起调，那会把自己搞晕。

---

公众号:蓝海资料掘金营，微信deep3321