步进电机PID与编码器

电机PID闭环控制完整总结（扩充版）

一、系统需要什么？（硬件层面）

选型结论：精确定位 → 编码器（每圈脉冲数 ≥ 400）；简单调速 → 霍尔传感器。

二、编码器模式详解（重点扩充）

2.1 编码器如何工作？

• 增量式编码器输出A相和B相两路脉冲，相位差90°

• 正转：A相领先B相 90°

• 反转：A相滞后B相 90°

2.2 编码器模式做了什么？

MCU将定时器配置为编码器模式后，硬件自动完成：

2.3 硬件计数器的真实状态

关键认识：硬件计数器本身是无符号的，范围固定：

2.4 有符号读取技巧（核心）

硬件不存储符号，符号是你解读的方式。

c

// 假设16位计数器，当前硬件值为 65535 uint16_t raw = TIM2->CNT; // raw = 65535 // 不同的解读方式，得到不同的"意义" uint32_t pos_u = raw; // 65535（无符号） int32_t pos_s = (int32_t)raw; // -1 （有符号）

为什么这很重要？

因为当你从0开始反转电机时：

• 硬件：0 → 65535 → 65534 → 65533 ...

• 有符号解读：0 → -1 → -2 → -3 ...

你获得了一个可以无限延伸的、带方向的线性位置空间，尽管硬件在循环。

这就是编码器读取的"魔法"：用有符号的眼光看无符号的硬件。

2.5 标准读取代码

c

// 16位定时器 -> 扩展到32位有符号 int32_t get_encoder_position(void) { return (int32_t)TIM2->CNT; } // 32位定时器 -> 直接读取（范围 ±21亿，足够大多数应用） int32_t get_encoder_position(void) { return (int32_t)TIM2->CNT; // TIM2是32位定时器 } // 如果需要无限精度（超长行程）-> 扩展为64位 int64_t get_encoder_position_64bit(void) { return (int64_t)(int32_t)TIM2->CNT + high_bits; }

编码器模式的“正反转”不需要你手动设置，也不能通过一个开关来直接改变。它的核心逻辑是由硬件自动完成的：根据A、B两相输入信号的相位关系（谁领先谁90°），硬件会自动决定计数器是递增（正转）还是递减（反转）。

如果你发现读取到的计数值变化方向和电机的实际转动方向相反（例如电机正转时读数在减小），有两种常用的方法可以修正：

🛠️ 方法一：交换A、B相信号线（硬件调整）

这是最直接、最可靠的方法。将连接到MCU定时器输入引脚的两根线A相和B相对调即可。这样，原来A相领先B相90°变成了B相领先A相90°，硬件判断的方向逻辑就会完全反转。

⚙️ 方法二：配置寄存器反转输入极性（软件调整）

如果硬件接线不便，可以通过软件来修正。配置与编码器相连的定时器的CCER寄存器，对输入通道的极性进行“反相”设置。

例如，在STM32中，通过设置TIM_CCER寄存器的CC1P位，可以将TI1输入信号反相。这样，硬件看到的相位关系就等同于A、B线被交换了，从而在不改变接线的情况下，实现对方向逻辑的翻转。一些集成的驱动器和MCU库也提供了类似的“编码器反向”参数选项。

💡 代码中如何判断正反转？

在编码器模式下，你不需要自己写代码去判断正反转，因为硬件已经把这个信息直接体现在了计数器的值里。你只需要在代码中读取计数器的值，它就会告诉你方向和位置：

• 计数值增加：表示电机在一个方向（通常视为正转）上旋转。

• 计数值减少：表示电机在相反方向（反转）上旋转。

三、如何得到当前转速？

位置差分法（在定时中断中计算）：

c

static int32_t last_position = 0; void speed_update(void) { // 每 10ms 调用一次 int32_t pos = get_encoder_position(); int32_t delta = pos - last_position; // 10ms 内的脉冲变化 float speed_rpm = (float)delta * 60000.0 / (PULSE_PER_REV * INTERVAL_MS); // 例：10ms变化40脉冲，400线电机，则转速 = 40*60000/(400*10)=600 rpm last_position = pos; }

四、如何实现精确定位？（软件逻辑）

4.1 核心架构

text

┌────────────────────────────────────────────┐ │ 主循环 while(1) │ │ • 接收目标位置（如 target = 10000脉冲） │ │ • 串口/显示/其他任务 │ └────────────────────────────────────────────┘ ↓ ┌────────────────────────────────────────────┐ │ 定时器中断（固定周期，如 1~10ms） │ │ ① current = get_encoder_position() │ │ ② error = target - current │ │ ③ output = PID_Update(error) │ │ ④ set_pwm(output) │ │ ⑤ if (abs(error) < DEADBAND) stop_motor() │ └────────────────────────────────────────────┘

4.2 位置PID简化实现

c

// PID参数 float Kp = 2.5; // 比例系数 float Ki = 0.05; // 积分系数（可选） float integral = 0; float integral_limit = 100; // 积分限幅 // 死区 #define DEADBAND 5 #define PWM_MAX 1000 int32_t position_pid(int32_t error) { // 死区判断 if (abs(error) <= DEADBAND) { integral = 0; return 0; } // P项 float p_term = Kp * error; // I项（可选） integral += error; if (integral > integral_limit) integral = integral_limit; if (integral < -integral_limit) integral = -integral_limit; float i_term = Ki * integral; // 总输出 int32_t output = (int32_t)(p_term + i_term); // 限幅 if (output > PWM_MAX) output = PWM_MAX; if (output < -PWM_MAX) output = -PWM_MAX; return output; }

4.3 电机控制接口

c

void set_motor_output(int32_t output) { if (output > 0) { GPIO_WriteBit(MOTOR_DIR_PORT, MOTOR_DIR_PIN, Bit_SET); // 正转 TIM_SetCompare1(PWM_TIM, output); // 设置PWM } else if (output < 0) { GPIO_WriteBit(MOTOR_DIR_PORT, MOTOR_DIR_PIN, Bit_RESET); // 反转 TIM_SetCompare1(PWM_TIM, -output); } else { TIM_SetCompare1(PWM_TIM, 0); // 停止 } }

五、溢出处理（当行程很长时）

5.1 问题说明

• 16位定时器：范围-32768 ~ 32767，400线电机约转±41圈就溢出了

• 32位定时器：范围-21亿 ~ 21亿，400线电机可转 ±137万圈，通常够用

5.2 如果需要无限行程（64位扩展）

c

volatile int64_t high_bits = 0; static int32_t last_value = 0; void TIMx_IRQHandler(void) { // Update中断 int32_t now = (int32_t)TIMx->CNT; int32_t delta = now - last_value; // 检测跳变 > 半圈即为溢出 if (delta > 32768) high_bits -= 65536; if (delta < -32768) high_bits += 65536; last_value = now; } int64_t get_64bit_position(void) { return high_bits + (int32_t)TIMx->CNT; }

六、常见问题排查

七、一句话速记

硬件自动数脉冲并分辨方向，用int32_t读取即可获得带符号的线性位置；在固定周期的定时中断里，用PID比较目标与当前位置的误差，误差小于死区时停止——这就是编码器电机精确定位的全部秘密。

八、实战检查清单

如果这些都能做到，你的电机就能实现“我要走N个脉冲，就走N个脉冲”的精确位置控制了。