当前位置：首页 > news >正文

基于立创·天猛星MSPM0G3507开发板的电机PID控制实战：编码器测速、定距与曲线显示

news 2026/3/26 21:19:41

基于立创·天猛星MSPM0G3507开发板的电机PID控制实战：编码器测速、定距与曲线显示

最近有不少参加电赛或者刚开始学电机控制的朋友问我，PID算法听起来挺复杂，到底怎么在单片机上跑起来，又怎么调参呢？正好，我手头有块立创·天猛星MSPM0G3507开发板，用它配合一个带编码器的直流电机和一块小屏幕，做了一个完整的PID控制小项目。这个项目麻雀虽小，五脏俱全，涵盖了编码器测速、PID算法实现、速度与距离双闭环控制，还能实时显示曲线和参数，非常适合用来入门实战。

通过这篇教程，我会手把手带你走一遍整个流程。你不需要有深厚的控制理论背景，只要跟着做，就能理解PID是怎么在嵌入式系统里“活”起来的，并掌握关键的调试技巧。咱们的目标很明确：让电机乖乖听话，让它转多快就转多快，让它走多远就走多远，并且一切变化都能在屏幕上看得清清楚楚。

1. 项目总览与硬件连接

在动手写代码之前，咱们先搞清楚要做什么，以及手头的“家伙事儿”怎么连起来。

这个项目要实现两个核心功能：定速控制和定距控制。定速就是让电机稳定在某个转速（比如每分钟100转）运行；定距则是让电机精确转动一定的圈数（比如正好转10圈停下）。为了实现这两个目标，我们需要三个关键部分协同工作：

感知（反馈）：靠电机上的编码器来“看”电机实际转得多快、转了多少。
思考（控制）：由MSPM0G3507单片机运行PID算法，计算出发给电机的控制指令。
执行（输出）：通过单片机的PWM信号驱动电机驱动模块（比如TB6612、DRV8833等），从而控制电机转动。

此外，我们还需要一块屏幕（比如OLED或TFT LCD）来显示PID参数、目标值、实际值以及它们的变化曲线，这样调试起来就直观多了。

硬件连接其实很简单，思路清晰就行：

编码器：通常有A、B两相输出，将它们分别连接到MSPM0G3507的任意两个支持编码器接口（QEI）或外部中断（EINT）的GPIO引脚上。编码器供电接3.3V或5V，地线接GND。
电机驱动模块：模块的PWM输入引脚接单片机的一个定时器通道（用于产生PWM），方向控制引脚接另一个GPIO。电机驱动模块的电源（VM）接电机所需的电压（比如12V），逻辑电源（VCC）接3.3V或5V。务必确保电机电源与单片机电源共地！
屏幕：根据屏幕类型（I2C或SPI），将对应的SCL/SDA或SCK/MOSI等引脚连接到单片机的相应外设引脚上。

注意：在连接电机驱动模块和大功率电机时，强烈建议使用独立的电源为电机供电，并使用逻辑电平隔离或确保共地良好，以避免电机启动和停止时产生的电流冲击和噪声干扰单片机正常工作，甚至导致复位或损坏。

2. 基础模块驱动：编码器与PWM

地基打牢，房子才稳。在实现高级的PID控制之前，我们必须先让两个最基础的模块可靠工作：读取编码器获取速度/位置，以及输出PWM驱动电机。

2.1 编码器测速与位置读取

带编码器的电机，其编码器就像一个高精度的“眼睛”，电机每转动一个微小角度，就会输出一组脉冲。通过测量一定时间内的脉冲数，就能算出速度；通过累计脉冲总数，就能知道位置（转过的角度或圈数）。

MSPM0G3507的Timer模块支持正交编码器接口（QEI）模式，这是读取编码器最准确、最省CPU资源的方式。它会自动根据A、B两相的相位关系判断正反转，并递增或递减计数器的值。

配置QEI的步骤通常如下（以TI的DriverLib库为例）：

初始化GPIO：将连接编码器A、B相的引脚配置为外设功能模式，映射到对应的Timer单元。
配置Timer为QEI模式：选择一个16位或32位定时器，将其工作模式设置为编码器模式。
设置计数模式与预分频：根据编码器线数（每转脉冲数）和期望的计数范围，设置计数模式（例如，在A、B相每个边沿都计数，分辨率最高）和预分频。
使能定时器：启动编码器计数。

// 示例：使用Timer_A0作为编码器接口 (伪代码，具体函数名参考TI DriverLib) #include “ti_msp_dl_config.h” void Encoder_Init(void) { // 1. 配置GPIO为Timer外设功能 DL_GPIO_setPeriphMode(ENCODER_A_PORT, ENCODER_A_PIN, DL_GPIO_PERIPH_MODE_SECONDARY); DL_GPIO_setPeriphMode(ENCODER_B_PORT, ENCODER_B_PIN, DL_GPIO_PERIPH_MODE_SECONDARY); DL_GPIO_setPinConfig(ENCODER_A_PORT, ENCODER_A_PIN, PIN_CONFIG_MUX_FUNC); DL_GPIO_setPinConfig(ENCODER_B_PORT, ENCODER_B_PIN, PIN_CONFIG_MUX_FUNC); // 2. & 3. 配置Timer_A0为QEI模式 DL_TimerA_setQeiMode(TIMER_A0_INST, DL_TIMER_A_QEI_MODE_X4, // 4倍频模式，A/B相每个边沿都计数 DL_TIMER_A_QEI_INVERT_NONE); // 不反转输入极性 DL_TimerA_setPrescaler(TIMER_A0_INST, DL_TIMER_A_PRESCALER_DIVIDE_1); // 预分频1 // 4. 启动定时器（开始计数） DL_TimerA_startCounter(TIMER_A0_INST); } // 读取当前编码器计数值（用于计算位置） int32_t Encoder_GetCount(void) { return (int32_t)DL_TimerA_getCount(TIMER_A0_INST); }

有了位置计数，速度怎么算呢？一个经典的方法是M法测速：在固定的时间间隔T（比如10ms）内，读取编码器计数值的变化量ΔCount。那么，速度Speed（单位：转/分钟，RPM）的计算公式为：

Speed (RPM) = (ΔCount / (编码器线数 * 4)) / T * 60

这里“编码器线数*4”是因为我们使用了4倍频模式。ΔCount就是本次采样时刻的计数值减去上一次采样时刻的计数值。这个计算过程可以放在一个定时中断里完成，确保速度更新的周期是固定的。

2.2 PWM输出配置

PWM（脉冲宽度调制）是控制电机转速和转向的“缰绳”。通过改变PWM波形的占空比（高电平时间占整个周期的比例），可以等效地改变输出到电机的平均电压，从而控制转速。

在MSPM0G3507上，我们通常使用一个Timer模块的PWM输出通道来控制电机速度，再用一个普通的GPIO来控制方向（高电平正转，低电平反转）。

配置PWM输出的关键步骤：

初始化GPIO：将PWM输出引脚配置为对应的Timer外设功能。
配置Timer为PWM模式：设置定时器的计数模式（通常为上/下计数或边沿对齐）、周期值（决定PWM频率）和比较值（决定占空比）。
设置PWM频率和初始占空比：PWM频率不宜过高（开关损耗大）或过低（电机噪音大、转速不稳），对于普通直流有刷电机，1kHz到20kHz都是常见范围。初始占空比设为0，让电机处于停止状态。

// 示例：配置Timer_A1的某个通道输出PWM (伪代码) void PWM_Init(void) { // 1. 配置PWM引脚 DL_GPIO_setPeriphMode(PWM_PORT, PWM_PIN, DL_GPIO_PERIPH_MODE_PRIMARY); DL_GPIO_setPinConfig(PWM_PORT, PWM_PIN, PIN_CONFIG_MUX_FUNC); // 2. 配置Timer_A1为PWM模式 DL_TimerA_setMode(TIMER_A1_INST, DL_TIMER_A_MODE_PWM_UP_DOWN); // 上下计数模式，中心对齐PWM DL_TimerA_setPeriod(TIMER_A1_INST, PWM_PERIOD); // 设置周期值，PWM频率 = 系统时钟 / (PWM_PERIOD * 预分频) DL_TimerA_enableCaptureComparePwmOutput(TIMER_A1_INST, PWM_CHANNEL); // 使能指定通道的PWM输出 // 3. 设置初始占空比为0% DL_TimerA_setCompareValue(TIMER_A1_INST, PWM_CHANNEL, 0); // 启动定时器 DL_TimerA_startCounter(TIMER_A1_INST); } // 函数：设置PWM占空比 (范围: 0.0 ~ 1.0) void PWM_SetDuty(float duty) { uint32_t compareValue; if(duty < 0.0f) duty = 0.0f; if(duty > 1.0f) duty = 1.0f; compareValue = (uint32_t)(duty * (float)PWM_PERIOD); DL_TimerA_setCompareValue(TIMER_A1_INST, PWM_CHANNEL, compareValue); }

3. PID控制算法的实现与整定

核心部分来了！PID控制器就像一个有经验的“老司机”，它根据“目标速度”（期望值）和“实际速度”（测量值）之间的偏差，来调整PWM这个“油门”，让偏差尽可能小。

3.1 PID算法原理与离散化

PID是比例（P）、积分（I）、微分（D）三个环节的缩写。咱们用开车来类比：

比例P：当前偏差有多大，就按比例给多大的控制量。偏差大了就多踩点油门，偏差小了就少踩点。反应快，但容易刹不住车（超调）或者在目标值附近来回晃（静差）。
积分I：把过去一段时间的偏差累积起来。主要用于消除静差。比如车一直比目标速度慢一点，积分项就会慢慢增加油门，直到完全消除这个微小偏差。
微分D：预测偏差未来的变化趋势。如果偏差正在快速减小（比如快达到目标速度了），就提前松点油门，防止冲过头。它能增加系统稳定性，抑制超调。

在单片机里，我们处理的是离散的数字信号，所以要用离散化的PID公式。最常用的是位置式PID：

u(k) = Kp * e(k) + Ki * Σe(j) + Kd * [e(k) - e(k-1)]

其中：

u(k)是当前时刻（第k次采样）的输出控制量（比如PWM占空比）。
e(k)是当前时刻的偏差，e(k) = 目标值 - 测量值。
Kp,Ki,Kd就是我们需要整定的三个参数。
Σe(j)是从开始到当前时刻所有偏差的累加（积分项）。
[e(k) - e(k-1)]是本次偏差与上次偏差的差值（微分项）。

在实际编程中，我们通常会把积分项Ki * Σe(j)写成Ki * integral，并设置一个积分限幅，防止积分饱和（误差一直累积导致输出巨大）。微分项也可以采用不完全微分等形式来抑制高频噪声。

3.2 代码实现：一个实用的PID结构体

下面是一个在嵌入式系统中非常实用的PID控制器结构体和初始化函数。我习惯把PID相关的所有变量打包在一起，这样管理多个控制器（比如速度环和位置环）会很方便。

typedef struct { float target; // 目标值 float measure; // 测量值 float err; // 当前误差 float err_last; // 上一次误差 float integral; // 积分项累加值 float output; // PID输出值 float Kp; float Ki; Kd; float integral_limit; // 积分限幅 float output_limit; // 输出限幅 } PID_Controller; void PID_Init(PID_Controller *pid, float kp, float ki, float kd, float i_limit, float o_limit) { pid->Kp = kp; pid->Ki = ki; pid->Kd = kd; pid->integral_limit = i_limit; pid->output_limit = o_limit; pid->target = 0.0f; pid->measure = 0.0f; pid->err = 0.0f; pid->err_last = 0.0f; pid->integral = 0.0f; pid->output = 0.0f; } float PID_Calculate(PID_Controller *pid, float target, float measure) { float differential; pid->target = target; pid->measure = measure; pid->err = pid->target - pid->measure; // 积分项计算，并限幅防止饱和 pid->integral += pid->err; if(pid->integral > pid->integral_limit) pid->integral = pid->integral_limit; if(pid->integral < -pid->integral_limit) pid->integral = -pid->integral_limit; // 微分项计算（不完全微分可在此处实现） differential = pid->err - pid->err_last; pid->err_last = pid->err; // PID输出计算 pid->output = pid->Kp * pid->err + pid->Ki * pid->integral + pid->Kd * differential; // 输出限幅 if(pid->output > pid->output_limit) pid->output = pid->output_limit; if(pid->output < -pid->output_limit) pid->output = -pid->output_limit; return pid->output; }

3.3 参数整定：让电机“听话”的秘诀

PID参数整定是个经验活，但也是有章可循的。对于电机速度控制，我推荐先P、再I、最后D的试凑法，并且一定要在闭环（即编码器反馈正常）的情况下进行。

初始化：将Ki和Kd设为0，输出限幅设为安全值（比如对应最大占空比0.8），积分限幅设一个中等值。
调比例P：
- 给一个较小的目标速度（比如50 RPM）。
- 从小到大慢慢增加Kp。你会看到电机开始转动，并且实际速度向目标值靠近。
- 当Kp增大到出现明显抖动或持续振荡时，说明P太大了。将Kp回调到振荡消失，此时系统响应较快且稳定。记下这个Kp值。
调积分I：
- 保持Kp为刚才的值，引入一个很小的Ki。
- 观察电机速度。如果存在静差（稳定后速度略低于目标值），就缓慢增大Ki，直到静差被消除。
- Ki太大会引起低频振荡或超调。如果出现振荡，就减小Ki。合适的Ki能消除静差且不影响动态响应。
调微分D（可选）：
- 速度环对微分项不太敏感，且编码器噪声容易被微分放大。如果系统超调严重，可以尝试加入很小的Kd来抑制。
- 注意：微分项对噪声非常敏感！如果使用，一定要确保编码器信号干净，或者使用不完全微分、对测量值进行低通滤波。

提示：定距控制（位置环）的参数整定思路类似，但通常需要更小的比例增益和更谨慎的积分、微分，因为位置环更容易振荡。可以先让速度内环稳定工作，再在外层套上位置环进行调试。

4. 系统整合与功能实现

现在，我们把各个模块像拼图一样组合起来，实现定速和定距功能，并把数据送到屏幕上显示。

4.1 定速控制实现

定速控制是单环系统：速度PID环。它的输入是目标速度，反馈是编码器计算出的实际速度，输出是PWM占空比。

程序逻辑可以放在一个固定的定时中断（比如1ms或5ms）中执行，这个周期就是PID的控制周期。

PID_Controller speed_pid; // 声明一个速度PID控制器 float target_speed_rpm = 100.0f; // 目标速度：100 RPM float current_speed_rpm; // 当前速度 float pwm_duty; // PWM占空比 // 在定时中断服务函数中： void Timer_ISR(void) { // 1. 读取编码器值，计算当前速度 (假设有函数Get_Speed_RPM()) current_speed_rpm = Get_Speed_RPM(); // 2. 进行PID计算 pwm_duty = PID_Calculate(&speed_pid, target_speed_rpm, current_speed_rpm); // 注意：PID输出可能是-1.0~1.0，需要根据你的电机驱动逻辑映射到0~1.0的占空比和方向 // 例如：if(pwm_duty >= 0) { 方向=正转; PWM_SetDuty(pwm_duty); } // else { 方向=反转; PWM_SetDuty(-pwm_duty); } // 3. 更新PWM输出 PWM_SetDuty(fabsf(pwm_duty)); // 取绝对值作为占空比 Set_Motor_Direction(pwm_duty >= 0 ? FORWARD : REVERSE); // 设置方向 // 4. (可选) 将目标值、实际值、PID输出等数据存入缓冲区，供显示线程使用 Update_Display_Data(target_speed_rpm, current_speed_rpm, speed_pid.output); }

4.2 定距控制实现

定距控制是双环系统：外环是位置环，内环是速度环。外环PID根据“目标位置”（总脉冲数）和“当前位置”（编码器累计值）计算出“目标速度”，然后将这个目标速度交给内环的速度PID去跟踪执行。这种结构也叫串级PID，抗干扰能力更强。

PID_Controller position_pid; // 声明一个位置PID控制器 PID_Controller speed_pid; // 速度PID控制器（复用） int32_t target_position_count = 10000; // 目标位置：10000个计数 int32_t current_position_count; // 当前位置 float inner_target_speed; // 内环（速度环）的目标速度 // 在定时中断服务函数中： void Timer_ISR(void) { // 1. 读取编码器当前位置 current_position_count = Encoder_GetCount(); // 2. 外环（位置环）PID计算：输入是位置偏差，输出是期望速度 inner_target_speed = PID_Calculate(&position_pid, (float)target_position_count, (float)current_position_count); // 对inner_target_speed进行限幅，避免内环无法跟踪 // 3. 读取当前速度 current_speed_rpm = Get_Speed_RPM(); // 4. 内环（速度环）PID计算：跟踪外环给出的期望速度 pwm_duty = PID_Calculate(&speed_pid, inner_target_speed, current_speed_rpm); // 5. 更新PWM输出 PWM_SetDuty(fabsf(pwm_duty)); Set_Motor_Direction(pwm_duty >= 0 ? FORWARD : REVERSE); // 6. 更新显示数据 Update_Display_Data(target_position_count, current_position_count, inner_target_speed, current_speed_rpm); }

4.3 曲线与参数显示

图形化显示是调试的“眼睛”。我们可以利用屏幕的绘图功能，绘制两条曲线：一条是目标值（水平线或斜坡），另一条是实际测量值。看着实际值曲线如何追赶并稳定在目标值线上，PID参数的效果一目了然。

显示逻辑可以放在主循环中，以较低的频率（比如10Hz）刷新，避免占用过多CPU。

显示内容可以包括：

实时曲线：目标值 vs. 实际值（速度或位置）。
数值显示：当前目标值、实际值、PID输出值。
参数显示与调节：当前的Kp, Ki, Kd值。如果屏幕支持触摸或外接了按键，甚至可以实时修改这些参数，观察系统响应变化，这是最有效的学习方式。

5. 调试心得与常见问题

做完以上所有步骤，你的电机应该已经能受控运行了。但在实际调试中，你可能会遇到下面这些“坑”，这里分享一些我的处理经验：

电机不转或抖动严重：
- 检查硬件：首先确认电机驱动模块供电是否正常，PWM和方向信号是否到达驱动模块。用万用表测量电机两端电压。
- 检查编码器：编码器接线是否正确？A、B相有没有接反？在转动电机时，用逻辑分析仪或单片机读取GPIO状态，看是否有脉冲变化。
- 参数问题：PID参数，尤其是Kp，是否太小？先尝试给一个固定的、较小的PWM占空比，看电机能否正常转动，排除软件算法问题。
速度控制存在静差：
- 增大Ki：这是消除静差的主要手段。但要注意积分限幅，防止积分饱和。
- 检查测量：编码器测速计算是否正确？M法测速的时间窗口T是否准确？可以在屏幕上打印出原始的脉冲计数变化量来验证。
系统振荡（来回晃动）：
- P太大：这是最常见的原因。减小Kp。
- I太大：积分作用过强也会引起振荡，尤其是低频振荡。减小Ki。
- 控制周期不合适：PID计算和执行的周期太快或太慢都可能引发不稳定。对于电机速度控制，1ms到10ms是比较常见的范围。
定距控制到终点时过冲或抖动：
- 切换控制模式：当位置接近目标时（比如最后10%的路程），可以将位置环的输出（目标速度）进行限幅，逐渐降低允许的最大速度，实现“软着陆”。
- 加入死区：当位置误差小于某个很小值时，直接停止PWM输出，避免在终点附近因微小误差而持续抖动。

这个项目虽然不大，但完整地走通了嵌入式运动控制的经典流程：传感器反馈、控制器计算、执行器输出、人机交互。希望你能通过动手实践，真正理解PID不再是书本上的公式，而是能让物理世界中的电机精准运行的强大工具。调试过程可能会有些曲折，但当你看到电机最终平稳、准确地按照你的指令运行时，那种成就感就是学习嵌入式最大的乐趣。

查看全文

http://www.jsqmd.com/news/476495/