如何构建一个紧凑且实用的电机调速控制器
你是否尝试过仅通过固定PWM信号来保持直流电机的恒定转速?起初效果良好,但一旦接触轴体、负载变化或电机发热,转速就会突然漂移,而系统中却没有任何机制能将其恢复。
这正是闭环控制所解决的问题。接下来,我们将从零开始展示如何构建一个紧凑且实用的电机调速控制器。
该系统由三个主要模块组成:
- XENSIV™ TLE5012B角度传感器2GO套件:通过安装在电机轴上的小型环向磁铁,测量电机轴的绝对角度。系统持续更新角度数据,由内置MCU计算出实际转速(RPM),并实时传输至控制器。
- XMC4700 Relax套件:作为主控制器,通过UART接收速度测量值,运行PID算法,并输出电机驱动指令。
- DC-SHIELD_BTN9970LV:直接连接在XMC4700的Arduino接口上,驱动12V有刷直流电机。
结果是一个能够主动响应干扰并保持电机在所需转速的调速控制器,即使轴上施加了外部负载也是如此。
为了演示控制器的工作原理,我们将对运行中的系统施加机械制动,并观察PID控制器如何响应和恢复。
开始吧!
闭环速度控制与PID(快速背景)
在连接任何电路之前,让我们先快速了解一下我们正在控制的内容。
用一句话概括闭环速度控制:
我们持续测量电机转速,将其与目标值进行比较,并调整驱动信号,直到两者一致。
在我们的系统中,控制回路如下所示:
•使用TLE5012B测量轴角
•根据时间内的角度变化计算转速
•运行控制器并更新电机指令
•以固定频率重复执行
在XMC4700上,我们以固定的50 Hz频率(每20毫秒一次)运行控制回路。这使得控制器的行为具有可预测性和可重复性。
控制误差
控制器始终基于误差工作:
•如果电机转得太慢,误差为正 → 需要增加驱动信号;
•如果电机转得太快,误差为负 → 需要减少驱动信号。
P、I 和 D 的作用(实际视角)
P = 比例
•对误差立即做出反应
•误差越大,校正越强
•如果 Kp 值过小,电机响应会变慢;
•如果 Kp 值过大,电机可能产生超调并围绕设定值发生振荡。
I = 积分
•消除最后残留的偏移量(例如当摩擦或负载导致电机始终略低于设定值时)。
•如果 Ki 值过小,通常会导致持续存在的误差(例如始终偏离 1–2 转/分钟);
•如果 Ki 值过大,控制器可能会“过度推力”,造成在设定值周围缓慢来回波动。
D = 微分
•增加阻尼:有助于防止超调,使控制器更加稳定平缓。
•如果 Kd 值过大,微小的测量噪声可能导致输出出现明显波动。
对于直流电机速度控制,许多情况下 PI 控制已经表现良好。我们仍然在此加入 D,因为它是一个非常有效的调节参数,可在不产生超调的情况下实现快速响应,前提是转速信号相对干净。
前馈
除了PID控制外,我们还使用了一个简单的前馈项:
这本质上是一个“基准驱动值”,大致对应电机在给定目标转速下所需的PWM占空比。PID控制器只需修正两者之间的差异即可。
其优势:
- 对设定值变化的响应更快
- 积分项的工作量更少
- 通常可减少超调现象
硬件设置
为了便于重现实验(并保持磁铁对准的一致性),我们搭建了一个小型测试装置:一个简单的支架,使电机和TLE5012B传感器板相对放置。电机轴朝向传感器,轴上装有一个小轮子,用于固定磁铁。
这个小轮子有两个作用:
- 保持磁铁沿直径方向固定并居中
- 作为简易的手刹,以便施加负载并观察控制器的反应
当机械对准问题解决后,电气接线也变得简单明了。
机械组装(电机、轮子、磁铁、传感器)
•将电机插入支架中,使电机轴指向传感器位置。(虽然有螺钉固定孔,但并非必需)
•将磁铁沿直径方向插入轮子中。
•将轮子安装到电机轴上。
•将TLE5012B角度传感器2GO安装到支架中,使传感器位于磁铁后方的正中央。
•用手旋转轴,确认轮子能自由转动且不接触传感器板。
如果之后发现转速读数不稳定,最常见的原因仍然是机械问题:磁铁未居中、距离不当或磁铁类型错误(必须为同向磁化)。
电机+电源接线(DC-SHIELD_BTN9970LV)
将电机控制屏蔽板安装到XMC4700 Relax套件(Arduino接口)上。
然后将电机连接到屏蔽板的输出端子:
•电机线A → OUT1
•电机线B → OUT2
如果之后电机转速方向错误,只需交换两根电机线即可。对于速度控制,方向本身并不重要,只要软件中的符号约定一致即可。
电源:
•VBAT → +12 V
•GND → 0 V(地)
请确保您的12V电源能够为启动和负载变化提供足够的电流。
传感器至控制器的接线(UART)
Angle Sensor 2GO板内部读取TLE5012B,并通过UART将速度数据传输至XMC4700。
连接方式如下:
- TLE5012B角度传感器2GO → XMC4700
- 2GO UART:TX(引脚6 / P2.0)→ XMC4700 RX(引脚0 / P2.15)
- 2GO GND → XMC4700 GND
以上即为数据通信所需全部配置。
开发阶段的供电
在开发过程中,我们建议通过USB同时为两个板供电:
- XMC4700通过USB供电(用于闪存和串口监视器)
- Angle Sensor 2GO通过USB供电(用于闪存和调试)
这样可避免启动时出现混淆。当所有功能正常运行后,若希望减少布线,也可从XMC4700为传感器板供电。
快速硬件检查(PID 之前)
在继续之前,建议进行以下两项快速检查:
•电机驱动器检查(开环):上传一个简单的测试程序,设置固定转速(例如 motor.set_speed(100)),并确认电机能够正常旋转。
•传感器数据检查:在 XMC4700 上运行 UART 接收程序,确认当电机转速变化或施加制动负载时,看到 rpm_raw=... 的值发生变化。
如果这两项检查均正常,则完整的 PID 演示程序也能正常运行。
软件与代码
本项目使用两个微控制器,每个都运行独立的代码:
•角度传感器 2GO(XMC1100)作为传感器前端,读取 TLE5012B 的轴角,计算出电机转速(RPM),并通过 UART 将结果传输到 XMC4700。
•XMC4700 Relax Kit 接收 RPM 数据,运行 PID 控制器,并通过 DC-SHIELD_BTN9970LV 驱动电机。
这种分层设计使整个系统结构清晰、易于复现:传感器板负责所有角度测量相关的工作,而 XMC4700 完全专注于控制任务。
设置 Arduino IDE
我们使用 Arduino IDE 开发了这两个程序。
步骤 1:安装板卡支持
•打开 Arduino IDE → 板卡管理器
•搜索并安装英飞凌XMC板
•对于每个程序,请选择正确的板子:
•PID控制器使用:KIT_XMC47_RELAX
•传感器前端使用:KIT_XMC_2GO_XMC1100_V1
步骤2:安装所需库
打开“程序” → “包含库” → “管理库”,并安装以下内容:
- XENSIV 角度传感器 TLx5012B
- motix-btn99x0
- 发送程序:传感器前端(角度传感器 2GO / XMC1100)
此程序运行在角度传感器2GO板上。它从TLx5012B读取绝对轴角度,根据时间内的角度差计算电机速度,应用一个小型低通滤波器,并以约100 Hz的频率通过UART将结果发送至XMC4700。
重要提示:在上传前,请在Arduino IDE中设置“工具” → “串口输出选择” → “板载串口”,以便将串口数据路由到UART引脚(P2.0 / TX),而非USB调试器。
它是如何工作的
该程序在每次循环迭代时,从TLE5012B中读取一个新的角度值。转速(RPM)通过计算角度随时间的变化得出,并正确处理了0°/360°的循环边界情况。结果经过一个小的低通滤波器去噪后,打包成紧凑的二进制帧并通过UART发送。
UART帧格式
为确保数据传输的可靠性,我们采用一种简单的帧结构:包含两个固定的起始字节和结尾的CRC8校验和:
•0xAA, 0xBB:同步用的起始字节
•angle:轴绝对角度,以16位值编码,范围从0–360°缩放到0–65535
•rpm:过滤后的电机转速,单位为0.1 rpm步长(有符号16位)
•status:旋转方向(0x01 = 顺时针,0x02 = 逆时针)
•crc8:前四个有效载荷字节的CRC8校验和
•接收端程序:PID速度控制器(XMC4700)
此程序运行于XMC4700上。它接收来自传感器板的转速值,在50 Hz频率下运行PID控制器,并将生成的驱动指令发送至电机扩展板。
UART接收器
接收器使用简单的状态机解析传入的帧。首先等待两个起始字节,然后读取精确的六个有效载荷字节,并验证CRC校验和,最后更新测得的转速值。出现CRC错误的帧将被静默丢弃,从而使通信对线路中的偶发噪声具有较强的鲁棒性。接收到的转速(RPM)随后会通过一个小型低通滤波器再次平滑处理,然后进入PID控制回路。
低通滤波器
在转速值到达控制器之前,一个小型低通滤波器可消除残留的测量噪声:
PID控制器
控制器以固定的50 Hz频率运行(每20毫秒一次)。输出计算如下:
地点:
前馈控制(u_ff = Kff × 设定值)提供了一个基准驱动电平,因此PID控制器只需修正微小的偏差。Kff的良好初始值可参考电机数据表中的255 /rpm_no_load。通过逐步调整,直到在稳态时I项保持接近零。
•P项对当前误差立即响应
•I项消除任何残留的稳态偏移(通过限制来防止过调)
•D项应用于测得的速度而非误差,避免设定值变化时输出出现突然的峰值
电机输出
最终输出被限制在有效的PWM范围内,并直接传送到电机扩展板:
串口绘图器
我们使用Arduino IDE中的串口绘图器,而不仅仅是打印数字,以实时可视化控制器的运行情况。这使得我们更容易观察系统在改变电机轴负载时的反应。
该程序每10 Hz输出三个值:
转速、驱动信号、设定值
•转速为经过滤波后的实际测量电机速度
•设定值是我们希望电机保持的恒定目标速度
•驱动信号代表电机驱动信号(源自PID输出)。
关于驱动信号值的说明:由于转速(RPM)和PWM处于不同的量级,我们对驱动信号进行了放大处理以便在图表中同时显示两条曲线。这意味着所显示的绝对数值并不代表实际测量结果,不应解读为“当前电机获得X伏特等”。其作用纯粹是展示趋势:当增加轴上的负载时,控制器会向电机施加更多驱动信号以维持转速在设定值,此时该数值会上升;而当负载移除后,数值又会回落。
关于PID参数说明:
本项目所使用的增益参数(Kp = 0.06,Ki = 0.02,Kd = 0.002,Kff = 0.2098)是针对此处特定电机进行调校的。如果使用其他电机,则可能需要相应调整这些参数。下一步中的调校指南将详细介绍如何系统性地进行调整。
演示:动态负载扰动
启动系统,使电机稳定在恒定转速(例如500 RPM,具体取决于您的电机)。
使用毛毡或橡胶等柔软材料,在轮子上施加一个较小且可控的摩擦负载。不要用手指作为刹车,尤其是在高速时,因为车轮会变热,且接触力更难控制。
观察串行绘图仪的输出,你应该看到:
•施加压力时,测得的转速(RPM)下降。
•控制器输出上升,以补偿增加的负载。
•一旦达到新的平衡状态,转速将保持在500 RPM。
•减少摩擦。当负载消失时,控制器会迅速降低输出,防止电机加速过快。
这个简单的测试清楚地说明了闭环控制的优势:开环系统在负载下只会失速或显著减速,而我们的PID控制器能主动抵消干扰,维持所需速度。
以下是完整的实际设置过程:电机以稳定速度运行,我们施加一个较小的机械负载,控制器会自动补偿,使速度接近目标值。
如何调整您的PID参数
找到合适的Kp、Ki和Kd值可能需要反复尝试。以下是一个实用的逐步方法,适用于直流电机速度控制:
1. 从仅使用 P 型(Ki = 0,Kd = 0)开始。
将 Kp 设置为较小的值(例如 2.0)。
缓慢增加 Kp,直到电机对负载变化反应迅速。
一旦发现转速开始围绕设定值摆动,立即停止。
略微降低 Kp(例如减少 10% 至 20%),以消除振荡。
结果:电机响应迅速,但仍可能存在较小的稳态误差(例如最终稳定在 580 转/分钟,而非 600 转/分钟)。
2. 添加积分作用(Ki)
将Ki设置为一个非常小的值(例如0.1)。
缓慢增加Ki,直到稳态误差消失,电机达到精确的设定值。
如果Ki过高,系统会开始缓慢地来回振荡。若出现这种情况,请降低Ki。
结果:即使在恒定负载下,电机也能保持精确的设定值。
3. 添加导数项(Kd)
如果电机在负载突然变化时仍然出现轻微的超调,可以增加一个较小的Kd值(例如0.1到0.5)。
Kd能增加阻尼,有助于防止超调。
如果Kd过高,电机输出会出现噪声,因为Kd会放大测量噪声。对于许多直流电机而言,PI控制(步骤1+2)已经足够。
提示:如果你使用了前馈项(Kff),请先调整Kff,以确保基础驱动值正确。这样调整Kp和Ki将变得容易得多,因为PID回路只需修正微小误差即可。
替代方法:Ziegler Nichols法
如果上述手动方法对你来说感觉过于试错,那么有一种更系统的方法:Ziegler Nichols法。
这种经典调谐方法仅需两个测量值,就能快速计算出Kp、Ki和Kd,而无需凭感觉逐一调整各个参数。
步骤1:找出临界增益
将Ki设为0,Kd设为0,逐渐增大Kp,直到系统开始持续振荡,振幅保持不变(既不增大也不减小)。这个值称为临界增益Ku。然后测量振荡周期Tu,即两个峰值之间的间隔时间。
步骤2:计算参数
根据您想要的控制器类型,可采用以下规则之一:
Ziegler-Nichols 控制器通常会产生较大的增益,容易导致一定程度的超调。它能快速将系统带入合适的范围,但为了实现像我们这样的平滑电机控制,仍建议后续使用上述手动方法进行微调,特别是略微降低 Kp 值,并根据个人喜好调整 Ki 和 Kd。
此外,请注意,将电机推至持续振荡状态以寻找 Ku 会施加一定的机械应力。如果在测试时使用的是精密硬件,手动调校方式更为温和。
本文编译自hackster.io





