1. 为什么你的机器人关节需要电流环控制?
如果你正在为机器人关节、机械臂或者任何需要精确力矩控制的装置选型电机,你大概率会考虑直流有刷电机。它价格实惠、驱动简单,是很多嵌入式开发者的老朋友。但不知道你有没有遇到过这样的尴尬:想让你的机器人稳稳地提起一个重物,结果电机要么“有气无力”转不动,要么“猛地一冲”电流飙升,甚至冒烟罢工。这背后的核心问题,往往就是缺少对电机电流的直接控制。
我刚开始做机器人项目时,也踩过这个坑。当时只用了速度环控制,电机空载转得飞快,一加上负载,要么速度掉得厉害,要么直接堵转,电路板上的MOS管都烧了好几个。后来才明白,对于需要力矩控制的场景——比如机器人抓取物体时要保持恒定的握力,或者无人机抗风时要保持稳定的推力——电流环才是真正的“幕后大佬”。你可以把电流想象成电机的“力气”。电流环控制,就是直接管理电机“力气”大小的闭环系统。它能让电机在负载变化时,依然输出你设定的精确力矩,既能防止电机过载损坏,又能充分利用其性能,甚至实现“柔顺”的力控交互。
这篇文章,我就以一个过来人的身份,带你从零搭建一套直流有刷电机的电流环PID控制系统。我们不谈空泛的理论,就聚焦在“硬件感知(ADC采样)- 控制决策(PID运算)- 执行输出(PWM)”这条核心链路上,把每个环节的配置要点、代码实现和调试中那些“坑”都掰开揉碎了讲清楚。无论你是学生做毕设,还是工程师做产品,这套方法都能直接拿去用。
2. 硬件配置:搭建你的电流感知与驱动舞台
在写第一行代码之前,硬件平台的搭建是地基。电流环控制对硬件有三个核心要求:精确的电流采样、快速的PWM驱动以及可靠的保护电路。如果硬件没选对,软件调得再漂亮也是白费功夫。
2.1 电流采样方案选型与电路设计
要控制电流,首先得“看见”电流。最常用、成本最低的方案是使用采样电阻+运算放大器。具体来说,就是在电机驱动的H桥下桥臂到地之间,串联一个毫欧级别的小阻值精密电阻(比如0.01Ω,也就是10毫欧)。电机电流流经这个电阻会产生一个微小的电压差,这个电压信号太弱,需要经过运放放大后才能被微控制器的ADC(模数转换器)读取。
这里有个关键细节:采样电阻的功率和位置。假设你的电机最大持续电流是3A,采样电阻是0.01Ω,那么电阻上的功耗是 P = I²R = 3² * 0.01 = 0.09W。看起来不大,但你必须选用额定功率至少0.25W以上的电阻,并保证良好的散热。位置一定要放在下桥臂MOS管的源极到地之间,这样无论电机正转还是反转,电流都流经同一个采样电阻,简化了采样电路和软件处理。我早期试过把电阻放在电源正极,结果方向一变,采样电压的参考地就变了,处理起来非常麻烦。
运放电路我推荐使用差分放大电路。它能抑制共模噪声,只放大采样电阻两端的压差。放大倍数需要仔细计算:假设采样电阻0.01Ω,电机最大电流3A,则最大采样电压为30mV。如果你的ADC参考电压是3.3V,为了充分利用ADC的量程,可以将放大倍数设为100倍,这样最大信号就是3V,留有一定余量。电路中的电阻要选用1%精度的,运放要选择低失调电压、低漂移的型号,比如TI的INA系列专用电流检测放大器,或者常见的LMV358。
2.2 微控制器外设配置要点(ADC与定时器)
硬件电路搭好了,接下来就是让微控制器(MCU)的“感官”和“手脚”动起来。这里以STM32系列MCU为例,你需要配置三个核心外设。
首先是ADC。电流信号是连续变化的,我们需要定时、连续地采样。最优雅的方式是使用 ADC的DMA(直接存储器访问)模式配合定时器触发。这样ADC可以按照固定频率(比如10kHz)自动采样,并通过DMA把数据搬运到内存数组中,完全不需要CPU干预。配置时要注意:采样频率要远高于你的控制频率(后面会提到的PID运算频率),通常遵循奈奎斯特采样定理,至少是控制频率的2倍以上,一般取5-10倍。我通常设置控制频率为1kHz(1ms周期),那么ADC采样率就设为10kHz。ADC的精度建议选择12位,如果对精度要求极高且MCU支持,可以考虑16位分辨率或过采样技术。
其次是用于产生PWM的定时器。你需要一个高级定时器(如STM32的TIM1/TIM8)来生成驱动H桥的互补PWM信号。为什么是互补PWM?因为我们要控制一个H桥,需要两路互补(一高一低)的PWM来驱动同一桥臂的上下两个MOS管,防止同时导通导致短路。配置时,PWM频率是关键。频率太低,电机会有可闻的啸叫声,且电流纹波大;频率太高,MOS管的开关损耗会急剧增加。对于中小型直流有刷电机,16kHz到20kHz是一个比较甜点的区间,这个频率超过了人耳听觉范围,同时开关损耗也在可接受范围内。你需要根据定时器的时钟频率,计算预分频器(PSC)和自动重载值(ARR)来得到这个频率。
最后是一个基本定时器,比如TIM6/TIM7。它的作用就像一个精准的“心跳”,每隔一个固定的时间(比如1ms)产生一次中断,在这个中断服务函数里,你去读取DMA搬运过来的最新电流采样值,然后执行PID计算,最后更新PWM的占空比。这个定时器的中断频率,就是你的整个电流环的控制频率。
3. 软件基石:从ADC数据到真实电流值
硬件配置妥当,数据源源不断地进来了,但ADC读到的只是一个0到4095(12位ADC)的数字。如何把它变成有物理意义的电流值(单位:毫安或安培)?这个过程叫标定,是保证控制精度的第一步,也是最容易出错的一步。
3.1 ADC采样与数据处理中的“坑”
很多新手会直接使用单次ADC转换的值,这在实际系统中噪声会非常大。必须做软件滤波。我强烈推荐使用 DMA+循环缓冲区+均值滤波 的组合拳。就像前面代码里展示的,配置ADC在DMA循环模式下连续采样1024个点,然后在DMA传输完成中断里,对这1024个点(或者你只取其中稳定的一部分)求平均值。这种方法能有效抑制随机噪声,而且由于DMA是后台操作,对CPU占用率极低。
但这里有个大坑:偏置电压。即使电机没有电流,由于运放本身的失调、PCB布局的干扰,ADC采样值也可能不是零。这个非零值就是偏置。如果你不消除它,你的电流测量永远有一个固定的误差。我的做法是在系统上电后、电机使能前,连续采样几十次电流通道的ADC值,计算其平均值作为偏置电压存储起来。之后所有正式的采样值都要减去这个偏置。代码中的 get_curr_val 函数里,flag < 17 && is_motor_en == 0 这个判断就是在做这个事。
另一个细节是数值溢出。ADC采样和累加计算要用 uint32_t 类型,防止累加1024个12位数据时发生溢出。滤波后的值,再通过一个简单的公式转换:实际电压 = (ADC平均值 / 4095) * ADC参考电压(如3.3V)。得到采样电阻两端的电压后,根据欧姆定律:电流 = 电压 / 采样电阻阻值。如果你的运放有放大倍数,别忘了除以放大倍数。
3.2 编写健壮的电流读取函数
把上面的步骤封装成一个函数,比如 float ReadMotorCurrent(void)。这个函数应该放在定时器中断里被周期性地调用。它内部需要完成:
- 检查DMA缓冲区数据是否就绪(可以通过标志位或双缓冲区切换)。
- 对有效数据进行均值滤波。
- 减去预存的偏置电压。
- 将ADC值转换为电压,再根据采样电阻和运放增益转换为电流值(安培或毫安)。
- 返回这个电流值。
为了调试方便,我强烈建议在这个函数里加入一些保护性判断。比如,如果计算出的电流值超过硬件设定的安全范围(例如,大于电机最大电流的1.5倍),就触发一个软件标志,并在主循环中执行故障处理(如关闭PWM输出)。这能防止因传感器故障或程序跑飞导致的灾难性后果。
4. 核心算法:位置式PID与增量式PID的抉择
PID控制器是电流环的大脑。它根据“目标电流”和“实际采样电流”的偏差,计算出一个控制量(通常是PWM的占空比)来驱动电机,使实际电流紧紧跟随目标电流。PID算法主要有两种形式:位置式和增量式,它们没有绝对的优劣,只有适合的场景。
4.1 位置式PID:直观但需防“积分饱和”
位置式PID的公式是:输出 = Kp * 当前误差 + Ki * 误差积分 + Kd * 误差微分。它的输出直接对应执行机构的绝对位置,在我们这里就是PWM的占空比设定值。代码实现就像前面给出的结构体 _pid 和函数 PID_realize 那样,需要维护一个误差积分项 integral。
位置式PID非常直观,参数物理意义明确。但它有个著名的“天敌”:积分饱和。想象一下,电机因为机械卡住而堵转,实际电流始终达不到目标值,误差一直为正,积分项就会不断地累加、累加,变得非常大。当卡阻消失时,这个巨大的积分值不会立刻消失,会导致输出PWM长时间维持在最大值,电机猛冲一下,非常危险。所以,在位置式PID中,积分抗饱和处理是必须的。常用的方法有:
- 积分分离:当误差很大时,去掉积分项,只用PD控制。
- 积分限幅:给积分项
integral设置一个最大值和最小值,不让它无限增长。 - 遇限削弱积分:当输出已经达到限幅值时,如果误差方向仍在导致积分增加,则停止积分。
在之前的位置式PID示例代码中,通过限制 pid.target_val 和 pid.actual_val 来间接限制,这是一种输出限幅,但对于积分饱和的针对性稍弱。在实际项目中,我通常会同时实现输出限幅和积分限幅。
4.2 增量式PID:更适用于执行机构带积分特性的场景
增量式PID的公式关注的是控制量的增量:本次输出增量 = Kp * (本次误差-上次误差) + Ki * 本次误差 + Kd * (本次误差 - 2*上次误差 + 上上次误差)。然后,本次实际输出 = 上次实际输出 + 本次输出增量。
增量式PID有几个天然优势:首先,它不需要累加误差积分,算法本身对积分饱和不敏感。其次,它输出的是增量,在手动/自动切换时冲击小。最重要的是,当执行机构本身具有积分特性时(比如步进电机、阀门开度),增量式PID非常合适。对于我们的PWM驱动电机,PWM占空比本身控制的是电压,电机转速/电流是电压的积分,所以也有一定的适用性。
但它也有缺点:积分作用体现在Ki*本次误差上,对静态误差的消除能力可能不如位置式直观,且参数整定上需要转换思路。在提供的增量式PID代码中,pid.actual_val 代表的是PWM占空比,它通过累加增量来实现。同样需要对 pid.actual_val 进行限幅,防止超出PWM寄存器允许的范围。
我该怎么选? 对于电机电流环这种需要快速响应、且被控对象(电流)惯性不大的系统,两种都可以。我的经验是:新手可以从位置式PID入手,因为它更直观,调试参数时你能清楚地看到每个环节的影响。当你对系统特性熟悉后,可以尝试增量式PID,并对比控制效果。在很多高性能的伺服驱动器中,会使用更复杂的变种,比如带前馈的PID,或者模糊PID,但那都是后话了。
5. 闭环实现:将PID输出转化为电机力矩
算法计算出了控制量,现在需要把它作用到电机上,形成一个完整的闭环。这一步的关键在于PWM占空比与电机电流的映射关系,以及方向处理。
5.1 PWM占空比与电流的映射及方向控制
PID计算出的输出值 cont_val 是一个浮点数,我们需要把它映射到定时器的比较寄存器(CCR) 值,这个值决定了PWM的占空比。假设你的PWM定时器自动重载值(ARR)设置为5600(对应前文代码),那么 cont_val 的范围就应该限制在0到5600之间。这个映射关系不一定是线性的,但对于大多数应用,线性映射足够用了:CCR_Value = (cont_val / PID_Output_Max) * ARR。你需要根据你期望的最大控制输出,来定义 PID_Output_Max。
对于直流有刷电机的H桥驱动,方向控制是通过两路PWM的占空比组合来实现的。一种常见的模式是:
- 正转:PWM_CH1 输出
cont_val的占空比,PWM_CH2 输出 0% 占空比(低电平)。 - 反转:PWM_CH1 输出 0% 占空比,PWM_CH2 输出
cont_val的占空比。 - 刹车/滑行:两者都输出高电平或低电平。
在电流环中,我们通常只控制力矩的大小,方向则由更外层的速度环或位置环来决定。因此,在 motor_pid_control 函数中,我们可能只需要根据外环给出的方向指令,来选择对哪个PWM通道写入计算出的占空比。示例代码中通过判断 cont_val 正负来决定方向,这是一种简化处理。更常见的做法是,cont_val 始终为正,代表力矩大小,方向由一个单独的变量控制。
5.2 编写完整的控制函数与中断服务程序
现在,我们把所有碎片拼装起来。整个系统的运行脉络应该是这样的:
- 系统初始化:配置ADC、DMA、PWM定时器、控制定时器(TIM6)、GPIO等。
- 启动采样:启动ADC的DMA传输,开始循环采集电流。
- 定时中断触发:基本定时器TIM6每1ms产生一次中断。
- 中断服务程序:
a. 调用
ReadMotorCurrent()获取最新的平均电流值。 b. 调用PID_realize(actual_current),传入目标电流和实际电流,得到控制量。 c. 调用TIM1_SetPWM_pulse(channel, compare),将控制量写入PWM比较寄存器。 - 循环往复:回到第3步,形成一个严格的1kHz控制闭环。
这个1ms的中断服务程序是整个系统的“心脏”,它必须尽可能高效。因此,要避免在中断里进行浮点除法、复杂的数学运算或打印调试信息。像ADC均值滤波这种耗时操作,应该在DMA完成中断或主循环中提前算好。中断服务程序里只做最核心的“读-算-写”三步。
6. 调试实战:让电流环“听话”的关键技巧
代码写完了,烧录进去,电机可能一动不动,或者疯狂振荡。别慌,调试PID是整个过程中最考验耐心和经验的环节。没有上位机可视化工具,调PID就像蒙着眼睛走路。
6.1 PID参数整定:从零到稳的步骤
我习惯的“手动整定”步骤如下,这需要你有一个能实时绘制电流波形(目标值、实际值)的上位机:
- 归零:先将Ki和Kd设为0。目标电流设一个很小的值,比如50mA(空载时能让电机微微转动的电流)。
- 调Kp(比例):逐渐增大Kp。你会看到实际电流开始响应。目标是让电流能快速上升,但又不会产生大幅度的超调和振荡。如果出现等幅振荡,说明Kp太大了,适当减小。找到一个响应较快、稍有超调的Kp值。
- 调Ki(积分):保持Kp不变,逐渐增加Ki。积分的作用是消除静态误差。观察当目标电流是一个固定值时,实际电流是否最终能稳定在目标值上。如果系统开始出现低频振荡或反应变慢,说明Ki太大了。
- 调Kd(微分):微分项能预测变化趋势,抑制超调。但在电流环中,由于噪声的存在,微分项很容易放大噪声,导致系统不稳定。对于电流环,我建议大部分情况下Kd可以设为0。如果你确实需要加微分,一定要先对采样电流进行低通滤波,然后从非常小的Kd值开始尝试,观察系统稳定性。
一个非常重要的技巧:给目标电流加“斜坡”。不要突然给电机一个很大的目标电流(比如从0到2A),这会让积分项瞬间饱和。应该编写一个函数,让目标电流缓慢地、线性地增加到设定值。这能极大改善启动特性,也是工业驱动器里的标准做法。
6.2 利用上位机观测与数据分析
“工欲善其事,必先利其器”。没有图形化的数据,调试效率会极低。你需要通过串口、CAN或者USB,将关键数据实时发送到电脑上位机。至少要发送目标电流和实际电流这两个数据。像匿名科创、VOFA+、SerialPlot这类免费的上位机软件都很好用。
在观测曲线上,你要关注这些:
- 阶跃响应:给一个电流阶跃信号,看实际电流能否快速、平稳地跟上。理想的响应是快速上升,超调量小(比如<10%),在1-2个控制周期内稳定下来。
- 稳态误差:稳定后,实际值与目标值的偏差。一个调好的电流环,稳态误差应该小于1%-5%。
- 抗负载扰动:在电机稳定运行时,突然用手捏住电机轴增加负载,观察电流曲线。一个好的电流环应该能迅速增加电流以维持转速(如果外环是速度环),或者至少能快速响应电流的波动。
调试过程中,把每次参数调整后的曲线截图保存下来,写上参数,对比分析。这是理解PID每个参数物理意义的最好方法。我花了大概一周时间,记录了上百张曲线图,才对我手头那个电机模型的电流环特性有了感觉。
7. 进阶优化与常见问题排查
当基本的电流环能工作后,我们可以考虑让它工作得更好、更可靠。同时,也要知道如何应对那些常见的问题。
7.1 从电流环到力矩控制:标定的重要性
我们控制电流的最终目的,往往是控制电机的输出力矩。对于直流有刷电机,其输出力矩与电枢电流成正比(T = Kt * I),这个Kt是电机的转矩常数。但这里存在一个转换:我们采样的是母线电流或相电流,它并不完全等于产生转矩的有效电流。电机在低速、堵转时,电流基本都用来产生转矩;但在高速时,一部分电流用于克服反电动势。因此,一个精确的力矩控制,需要对电机进行标定:在电机轴上连接一个扭矩传感器,测量在不同电流下实际输出的扭矩,从而拟合出电流-扭矩曲线。对于精度要求不高的场合,可以近似认为力矩与电流成正比。
7.2 常见故障与解决方案
问题一:电机不转,电流读数一直为零或很小。
- 检查:ADC采样电路是否正常?运放供电了吗?采样电阻两端电压用万用表量一下是否有变化?DMA配置是否正确,数据缓冲区是否有更新?偏置电压扣除是否正确?可能偏置电压扣多了导致结果始终为0。
- 解决:用万用表或示波器从硬件前端开始,一级一级往后查信号。在软件里,把ADC原始值、滤波后的值、减去偏置后的值、计算出的电流值都通过串口打印出来,看是哪个环节出了问题。
问题二:电机剧烈振荡,发出啸叫声。
- 检查:这是典型的控制频率过低或PID参数过冲的表现。首先确认你的控制定时器中断频率是否足够高(建议不低于500Hz,1kHz更好)。然后检查Kp是否太大。另外,PWM频率是否过低(低于10kHz)也会产生音频噪声。
- 解决:确保控制频率和PWM频率设置在合理范围。大幅降低Kp和Ki,从非常小的值开始重新整定。
问题三:电流能跟上,但响应很慢,感觉很“肉”。
- 检查:PID参数,尤其是Kp太小,或者积分项Ki占主导但值太小。也可能是ADC采样滤波过度(比如均值窗口太大),引入了太大的延迟。
- 解决:适当增加Kp。检查并减少软件滤波的窗口长度,在抗噪声和响应速度之间取得平衡。可以考虑使用更高效的滤波器,如一阶低通滤波。
问题四:轻载时正常,重载或突然加载时系统失控。
- 检查:电源功率是否足够?重载时电源电压是否被拉低?采样电路的运放输出是否饱和(达到电源电压)?PID输出是否达到了硬件允许的限幅值(积分饱和)?
- 解决:检查电源容量。确保运放的供电电压和输出范围能满足最大采样电压。在PID代码中加入完善的抗积分饱和逻辑。可以考虑加入前馈控制,在预期负载变化时提前加大输出。
调试电流环是一个系统工程,硬件、软件、参数环环相扣。我的经验是,保持耐心,一次只改变一个变量,并善用测量工具。当你第一次看到电流曲线完美地跟随你设定的目标曲线时,那种成就感会让你觉得所有的折腾都是值得的。这套从硬件到软件的框架,不仅适用于直流有刷电机,其思想也同样可以迁移到无刷电机(FOC控制)或其他需要闭环控制的执行器上,希望这份指南能帮你少走些弯路。



被折叠的 条评论
为什么被折叠?



