SimpleFOC STM32实战：基于F103与HAL库，剖析速度环与电流环的协同控制

1. 从“能转”到“转得好”为什么需要速度环与电流环的协同如果你已经跟着之前的教程成功在STM32F103上让电机通过SimpleFOC库转起来了那恭喜你已经迈出了关键的第一步。但不知道你有没有遇到过这样的情况用手轻轻捏一下电机轴转速就掉下去了或者电机启动时“咯噔”一下响应不够平滑。这时候你可能就会想我的FOC控制是不是还缺点什么没错你遇到的就是动态性能的问题。让电机转起来是开环或者简单闭环就能做到的但要让电机在负载突变、目标速度变化时依然能快速、平稳、有力地响应这就需要更精细的控制策略。这就像开车能开走是基础但要想开得稳、提速快、刹车灵就需要油门、刹车、方向盘的精密配合。在FOC的世界里速度环和电流环就是这套配合的核心。简单来说速度环是“指挥官”它负责制定战略目标“我要求电机现在必须以500 RPM的转速运行”。而电流环是“前线执行官”它负责战术实现“为了达到这个转速我需要给电机绕组通入多大的电流”。如果只有速度环没有电流环就好比指挥官直接去拧电机的电线控制非常粗糙抗干扰能力极差。而如果只有电流环没有速度环电机就失去了速度目标只能固定在一个扭矩输出上无法实现精准调速。所以我们常说的“双闭环控制”指的就是速度环在外电流环在内两者协同工作。速度环根据目标转速和实际转速的误差计算出一个“期望电流”更准确说是期望的扭矩电流Iq。这个期望电流值就是电流环的“目标”。电流环则通过快速的PWM调制精准地控制流入电机三相绕组的电流使其紧紧跟随这个目标。这样无论外界负载怎么变电流环都能迅速调整出力来保证速度环的目标得以实现。在STM32F103这样资源有限的芯片上利用HAL库和SimpleFOC来实现这套协同机制既有挑战也充满了工程实践的乐趣。接下来我就带你一步步拆解看看代码里是怎么让这两个“环”默契配合的。2. 工程基石基于CubeMX与HAL库的硬件层配置在开始写控制算法之前我们必须把硬件的地基打牢。对于STM32F103C8T6这类“蓝核”芯片使用STM32CubeMX进行初始化配置能省去大量查阅手册、配置寄存器的时间。这里我重点讲几个和双闭环控制强相关的关键点这些配置直接影响着电流采样精度和PWM输出质量是性能优化的基础。首先是定时器配置这是PWM输出的心脏。我们通常使用一个高级定时器如TIM1来生成驱动三相全桥的6路互补PWM。在CubeMX中你需要将TIM1的某个通道如CH1, CH2, CH3配置为“PWM Generation CHx”和“PWM Generation CHxN”互补通道。关键参数在于计数模式和预分频。为了获得更高的PWM分辨率我通常将计数模式设置为“中央对齐模式1”Center-aligned mode 1。这种模式下计数器先向上计数再向下计数PWM波形关于中心对称能有效减少电机谐波。将计数周期ARR设置为一个固定值比如1000那么PWM分辨率就是1/1000。预分频PSC则根据你的系统时钟来设置目标是让PWM频率在10kHz到20kHz之间。频率太低电机噪音大频率太高开关损耗会增加对MOSFET驱动要求也高。我实测下来对于F10315kHz左右是个比较平衡的选择。其次是ADC配置这是电流环的“眼睛”。要实现电流闭环你必须能准确测量电机相电流。最常用的方法是采样下桥臂的采样电阻电压。在CubeMX中你需要配置至少两个ADC通道用于采样两相电流第三相可通过计算得出。这里有几个坑我踩过你必须注意第一采样时机。必须在PWM“注入”期间即下桥臂导通、采样电阻上有电流流过时采样。这需要通过定时器的触发输出TRGO来同步触发ADC。在TIM1的配置里找到“Trigger Output”选择“Update Event”或“OC4REF”然后在ADC的“External Trigger Conversion Source”中选择对应的定时器触发信号。第二采样速度。ADC的采样周期不能太长要能跟上PWM频率。建议将ADC时钟配置为12MHz对于72MHz系统时钟分频系数选6采样周期设置为较短的“1.5 Cycles”或“7.5 Cycles”。第三DMA传输。为了不占用CPU资源务必为ADC配置DMA模式设为循环模式Circular这样ADC一旦转换完成数据就自动搬运到指定的内存数组中你的loopFOC函数直接去读这个数组就行。最后别忘了GPIO和外设时钟。检查一下你用于驱动MOSFET的GPIO口是否已经配置为复用推挽输出Alternate Function Push-Pull并且输出速度设置为“High”。UART用于调试打印I2C或SPI如果你的编码器需要用比如AS5600。把这些基础配置在CubeMX里点点鼠标完成生成代码后一个干净、稳定的硬件抽象层HAL框架就准备好了。这为我们后续专注于控制逻辑扫清了障碍。3. 深入电流环dc_current与foc_current模式的选择与实现在SimpleFOC的BLDCMotor类中你会遇到一个关键配置motor.current_control。它有两个选项CurrentControlType::dc_current和CurrentControlType::foc_current。很多朋友一开始会疑惑这俩到底有啥区别我该用哪个这里我结合自己的实测波形和代码给你掰扯清楚。dc_current模式简单直接的扭矩控制。你可以把它理解为“直流电流”控制模式。在这种模式下电流环只闭环控制q轴电流Iq也就是产生扭矩的电流分量。而d轴电流Id即产生磁场的励磁分量则被简单地设置为0或者如果你在motor对象里设置了相电感phase_resistance和phase_inductance库内部会计算一个很小的Id用于抵消磁饱和但本质上不参与闭环PID控制。它的控制框图非常直观目标速度-速度PID-输出目标Iq-电流PID仅Iq-反Park变换-SVPWM。我实测下来在电机转速低于额定转速的绝大部分工况下dc_current模式的表现都非常出色。响应快代码计算量小对于F103这种没有FPU的芯片非常友好。因为此时反电动势不高我们不需要去削弱磁场Field Weakening来提速维持Id0是最优解。foc_current模式全能的磁场定向控制。这才是“真正意义上”的FOC电流环。它同时对q轴电流Iq和d轴电流Id进行闭环控制。这意味着你不仅可以控制扭矩还可以主动控制电机的磁场。什么情况下需要它呢主要就是弱磁控制。当你想让电机运行在超过额定转速反电动势接近母线电压时就必须施加一个负的Id电流来主动削弱电机内部的永磁场从而降低反电动势让电机能继续升速。这时候foc_current模式就必不可少了。在SimpleFOC的loopFOC()函数源码里你能清晰地看到两种模式的分支对于dc_current它只计算和更新Iq的PID对于foc_current它分别计算Iq和Id的PID然后一起进行后续变换。那么如何选择呢我的经验是如果你的应用场景是机器人关节、云台、精密仪器电机工作转速范围在额定转速以下并且追求极致的响应速度和低计算开销优先选择dc_current。它完全够用而且更“轻”。如果你的应用是高速电钻、无人机螺旋桨、高速风机需要电机突破额定转速运行那么必须选择foc_current并配置好Id环的参数实现弱磁算法。对于初学者我建议先从dc_current模式入手调试。把速度环和电流Iq环的PID参数调稳了理解了整个流程再切换到foc_current模式去研究Id环的影响这样学习曲线会更平滑。在代码里配置非常简单// 创建电机对象 BLDCMotor motor BLDCMotor(7); // 7对极电机 // 选择电流控制模式 motor.current_control CurrentControlType::dc_current; // 或 foc_current // 然后配置电流PID参数如果选择foc_current需要分别配置Iq和Id的PID motor.PID_current_q.P 3.0; motor.PID_current_q.I 100.0; motor.PID_current_q.D 0.0; motor.PID_current_d.P 3.0; motor.PID_current_d.I 100.0; motor.PID_current_d.D 0.0; // foc_current时需要 motor.LPF_current_q.Tf 0.005; // Iq电流环低通滤波器时间常数 motor.LPF_current_d.Tf 0.005; // Id电流环低通滤波器时间常数4. 速度环的整定让电机“听话”的关键步骤速度环是外环它感受最直接调得好不好用手一拧电机轴就能试出来。一个调校良好的速度环应该能做到启动无超调、稳态无静差、抗负载扰动时恢复快且平稳。在SimpleFOC中速度环的PID控制器和低通滤波器LPF是调参的核心。第一步先确保电流环已初步工作。在调速度环之前我习惯先把电流环调个大概。你可以将电机设置为扭矩控制模式motor.torque_controller TorqueControlType::voltage暂时绕过电流环或者粗略给电流环一组保守的P值I和D设为0让电机能大致响应你的扭矩指令。这样做的目的是确保内环电流环的响应速度至少比外环速度环快一个数量级这是经典控制理论中双环系统能稳定解耦的前提。第二步关闭速度环的D和I只调P。这是最关键的一步。将motor.PID_velocity.I和motor.PID_velocity.D都设为0motor.LPF_velocity.Tf也设为一个较小的值比如0.01。然后从小到大逐渐增加motor.PID_velocity.P。给电机一个固定的目标速度比如100RPM观察电机的启动过程。P值太小电机加速缓慢甚至达不到目标速度P值逐渐增大电机会开始出现振荡表现为转速在目标值上下波动电机发出“嗡鸣”声。你要找的那个临界点就是电机即将开始振荡但还未振荡时的P值。我们称这个P值为Kp_critical。第三步引入积分I消除静差。找到了临界P值我们可以将其乘以一个系数比如0.6作为速度环P的最终值这样系统有足够的稳定裕度。然后保持目标速度开始慢慢增加motor.PID_velocity.I。积分项的作用是消除稳态误差。你会发现随着I值的增加电机在负载变化后能更快地回到目标转速。但I值太大会引起积分饱和导致系统超调甚至振荡。我的经验是I值调到能让电机在施加一个固定负载后能在1秒内平稳地消除静差就差不多了。第四步谨慎使用微分D。在数字系统中微分项对噪声非常敏感。除非你的编码器分辨率极高、信号非常干净否则我建议在速度环中尽量不要使用微分D。或者只加一个非常小的D值比如P值的0.1倍主要依靠速度环的低通滤波器motor.LPF_velocity来平滑反馈值抑制高频噪声。低通滤波器的时间常数Tf设置很重要太小了滤波效果差太大了会让系统响应变迟钝。我通常从0.05开始试根据实际波形调整。一个我调试云台电机时的参数样例电机额定转速几千转使用1000线编码器motor.PID_velocity.P 0.15; // 经过临界比例法整定得到 motor.PID_velocity.I 2.0; // 用于消除静差 motor.PID_velocity.D 0.0; // 通常不用 motor.PID_velocity.output_ramp 1000; // 输出变化率限制防止冲击 motor.LPF_velocity.Tf 0.03; // 速度反馈滤波 motor.target 50; // 初始目标速度RPM注意PID参数没有银弹和你的电机参数、负载惯量、编码器分辨率强相关。上面参数仅供参考你必须亲手调试。5. 双环协同实战代码剖析与示波器波形解读理论说再多不如一行代码和一张波形图来得实在。让我们打开user_main.cpp或者你的主循环文件看看双环是如何在loop()函数中协同工作的。SimpleFOC的标准架构非常清晰主循环里就干两件核心大事void loop() { // 任务1电流环与FOC算法执行 motor.loopFOC(); // 任务2速度环计算与目标设定 motor.move(); }motor.loopFOC()电流环的舞台。这个函数调用频率必须足够高通常要等于或高于你的PWM频率比如15kHz。它内部依次执行电流采样与Clark/Park变换通过你配置的ADC和DMA读取两相电流Ia, Ib计算出Ialpha, Ibeta再结合来自编码器的电角度electrical_angle变换到旋转的d-q坐标系下得到Id, Iq。电流PID计算根据你选择的dc_current或foc_current模式对Iq和Id进行PID运算。这里用的就是你在motor.PID_current_q和motor.PID_current_d中设置的参数。反Park与SVPWM将PID输出的电压矢量Vd, Vq反变换回静止坐标系Valpha, Vbeta然后通过空间矢量脉宽调制SVPWM算法计算出三相占空比并更新到定时器的比较寄存器CCR中驱动MOSFET。motor.move()速度环的指挥所。这个函数的调用频率可以比loopFOC()低通常设置在1kHz到5kHz之间通过一个定时器中断来调用。它主要做速度测量读取编码器值计算得到实际机械转速。速度PID计算比较目标速度motor.target和实际速度运行速度环PID算法。生成电流指令将速度PID的输出作为电流环q轴的目标值motor.target_current_q。至此速度环的指令就传递给了电流环。示波器怎么看光看代码不够示波器才是验证控制效果的“照妖镜”。你可以用两个通道来观察通道一接电机相线或PWM输出你会看到标准的SVPWM波形——马鞍波。这是正常的。当你用手捏住电机轴施加负载时你会发现马鞍波的“幅值”瞬间变大了。这说明速度环检测到转速下降输出了更大的电流指令电流环迅速响应提高了电压占空比来产生更大扭矩抵抗你的干扰。这就是双环协同抗扰动的直观体现。通道二接电流采样电阻两端需用差分探头或注意共地你可以看到正弦的相电流波形。在负载突变瞬间电流的幅值会有一个阶跃上升然后被电流环的PID快速拉回稳定状态。观察这个电流的响应速度和超调量就是你调试电流环PID参数的依据。关于系统耗时原作者提到了STM32F103一次FOC速度闭环控制即执行一次loopFOC()和move()需要约431us。这个时间非常重要它决定了你的控制频率上限。对于15kHz的PWM频率周期66.7us431us意味着你的CPU负载已经很重了约占6.5个PWM周期。这也是为什么在F103上我们通常把速度环move放在一个更低频率的中断如1kHz中去执行而让loopFOC在高速主循环或PWM中断中执行以平衡实时性和计算负荷。6. 性能优化与常见问题排查在F103这类M3核芯片上跑完整的双环FOC资源是捉襟见肘的。优化得好系统稳定流畅优化不好各种奇怪问题就来了。这里分享几个我踩过的坑和优化技巧。计算速度优化启用编译器优化在Keil或PlatformIO中务必开启优化等级-O2。这能极大提升浮点运算虽然软件模拟的效率。简化数学运算SimpleFOC库中大量使用sinf,cosf,sqrtf。对于F103这些函数非常耗时。可以考虑使用查表法或者使用arm_math库中的优化函数但需注意M3核不支持所有指令。降低控制频率如果对动态性能要求不是极致可以适当降低loopFOC的执行频率。比如PWM用15kHz但loopFOC每两个PWM周期执行一次7.5kHz能节省近一半的CPU时间。使用float而非double确保你的代码和库统一使用单精度浮点数float。F103处理double要慢得多。抗干扰与稳定性优化电流采样噪声这是电流环振荡最常见的元凶。除了在硬件上加RC滤波在软件上一定要用好motor.LPF_current_q和motor.LPF_current_d这两个低通滤波器。Tf值从0.01开始调观察电流波形滤除高频毛刺但不要滤得太狠导致相位滞后。编码器抖动速度反馈的噪声会直接干扰速度环。同样用好motor.LPF_velocity滤波器。也可以尝试在motor.PID_velocity中增加一个很小的输出变化率限制output_ramp防止速度指令突变。启动抖动与启动失败电机启动时转子位置未知如果直接开环启动可能失步。SimpleFOC提供了motor.initFOC()函数它会结合编码器进行对齐。确保对齐过程顺利。对于重负载启动可以尝试在启动瞬间给速度环一个初始的I值积分或者稍微提高启动时的P值。常见问题排查清单电机不转只震动发烫大概率是相序接错或电角度不对。检查motor.zero_electric_offset是否校准正确或者尝试交换任意两条电机线。电机能转但噪音很大PWM频率可能过低或者电流环PID的P值太大导致振荡。用示波器看电流波形是否正弦、平滑。带载后转速掉下去上不来速度环的I值太小无法克服静差。适当增加motor.PID_velocity.I。也可能是母线电压不足无法提供所需电流。控制周期时间波动大检查是否有其他中断打断了FOC计算。确保ADC、定时器中断的优先级配置合理并且中断服务函数里不要做复杂运算。调试是一个需要耐心和观察的过程。多利用SimpleFOC库内置的串口通讯功能通过motor.monitor()输出变量到上位机如SimpleFOC Studio进行可视化观察结合示波器的波形你能更快地定位问题所在。记住每一个参数背后都有其物理意义调参的过程就是你与电机“对话”的过程理解它才能驾驭它。