1. 项目缘起从“能动”到“控好”的必经之路搞电机应用开发的朋友尤其是从玩具小车、机械臂或者一些DIY项目入门的最开始接触的往往是“让电机转起来”。用个L298N、TB6612或者A4950这类驱动模块给个PWM信号电机就欢快地转起来了这感觉确实不错。但当你真正想把电机用在一个对性能有要求的场合比如需要稳定转速的云台、需要精准力矩的机械手关节或者需要快速响应的竞速小车时你就会发现仅仅控制电压PWM占空比是远远不够的。电机负载一变转速就飘想让它快速停在一个位置它却来回振荡。这时候你就遇到了从“开环控制”到“闭环控制”的门槛。而电流环往往是构建高性能电机控制系统的第一块也是最核心的基石。为什么是电流环你可以把电机系统想象成一辆车。PWM电压控制相当于你直接踩油门踏板踩多深给多少油但车跑多快、爬坡费不费劲你并不直接知道。速度环就像你看车速表发现慢了就多踩点油门快了就松一点。而电流环则是更底层、更直接的控制——它控制的是发动机的扭矩输出。对于直流有刷电机而言其输出扭矩与电枢电流成正比T Kt * Ia其中Kt是转矩常数。因此直接、快速地控制住电流就等于直接、快速地控制住了电机的输出力矩。有了稳定且响应快速的力矩你再去构建外层的速度环、位置环整个系统才会稳如磐石。所以实现电流环控制是迈向精准电机控制无法绕开的一步。本次分享我就以一个典型的基于微控制器如STM32和H桥驱动如TB6612的直流有刷电机平台为例抛开复杂的理论公式聚焦于如何从零开始一步步地搭建、调试并理解一个可用的电流环。我们会用到ADC采样电流、PID算法进行闭环计算最终通过PWM输出控制电机。过程中遇到的坑比如采样噪声、PID参数整定、驱动死区时间等我都会结合自己的实操经验详细说明。2. 系统框架与核心硬件选型解析在动手写代码之前我们必须先把系统的物理框架和关键硬件的作用搞清楚。一个典型的直流有刷电机电流环控制系统可以分解为以下几个核心部分2.1 动力执行单元电机与驱动桥直流有刷电机是我们的控制对象。驱动部分TB6612、A4950、L293D等都是常见的选择。它们本质都是一个H桥电路允许我们通过微控制器的信号控制电机的方向、启停并通过PWM输入来调节平均电压。选型时需重点关注几个参数驱动电流能力必须大于电机堵转电流、供电电压范围、以及是否集成衰减模式与死区时间保护。例如TB6612它内部集成了MOSFET和必要的保护电路支持双路电机控制逻辑电平兼容3.3V/5V对于中小型直流电机是非常方便的选择。注意驱动芯片的“使能”引脚和“输入逻辑”引脚要区分开。使能引脚是总开关通常需要拉高输入逻辑引脚如AIN1/AIN2则决定方向和PWM输入。接线错误会导致电机不转或控制异常。2.2 信息感知单元电流采样电路这是电流环的“眼睛”。我们需要测量流经电机的电流。常见方法有三种低侧采样在H桥的下桥臂与地之间串联一个采样电阻Shunt Resistor。这种方法电路简单共地容易。但缺点是当PWM在下桥臂关闭时电流会通过续流二极管流通此时采样电阻上无电流无法测量会存在采样盲区。对于需要连续电流信息的系统这会影响性能。高侧采样在电源与H桥之间串联采样电阻。可以测量所有情况下的电流但电路设计复杂需要专门的差分放大器或高侧电流检测芯片来处理共模电压问题。霍尔效应电流传感器如ACS712。这类传感器基于霍尔效应电气隔离性好精度高但成本也较高且存在一定的响应延迟。对于成本敏感且性能要求不是极端高的场合低侧采样配合适当的PWM调制策略是一个务实的选择。我们选择一颗阻值小如0.1欧姆、功率大如1W以上、精度高1%的金属膜电阻作为采样电阻。电阻值的选择是个权衡阻值太大损耗大压降也大阻值太小采样信号微弱容易被噪声淹没。通常使电机在最大工作电流时采样电阻上的压降在几十到一百毫伏量级比较合适。2.3 信号调理与数字化运算放大器与ADC采样电阻上的电压信号是微弱的mV级且是双极性的电流可正可负对应电机正反转。而微控制器的ADC通常只能测量0到正参考电压的单极性信号。因此我们需要一个信号调理电路。放大使用运算放大器如LMV358搭建一个同相放大电路将采样电压放大到适合ADC采样的范围比如0-3.3V。抬升偏置为了测量双极性电流我们需要将放大后的信号“抬升”一个中间电压如1.65V。这样当电流为0时ADC输入为1.65V电流为正时电压高于1.65V电流为负时电压低于1.65V。这可以通过在运放电路中加入一个参考电压来实现。调理后的模拟信号送入微控制器的ADC输入引脚。ADC的分辨率如12位、采样速率和采样时机至关重要。STM32的ADC功能强大支持定时器触发采样这对于与PWM周期同步采样、避免噪声至关重要。2.4 大脑微控制器与算法微控制器MCU负责执行整个闭环算法。它需要产生驱动电机所需的PWM信号通常使用高级定时器的互补输出通道以方便插入死区时间。在精确的时刻通常是PWM周期中的特定点触发ADC对调理后的电流信号进行采样。运行PID控制算法读取ADC值换算成实际电流与目标电流比较通过PID运算计算出新的PWM占空比。更新PWM输出完成一次控制循环。整个系统的信息流是这样的目标电流 - PID控制器 - PWM占空比 - H桥驱动 - 电机电流 - 采样电阻 - 信号调理 - ADC - 实际电流值 - PID控制器形成一个完整的闭环。3. 关键软件实现从ADC采样到PID输出硬件搭好后软件才是让系统“活”起来的关键。这里我们分步拆解。3.1 ADC采样策略与软件触发时机ADC采样的准确性直接决定了电流环的感知精度。噪声是最大的敌人。除了硬件上做好滤波如在运放输出端加一个小电容软件策略同样重要。同步采样绝不能随意在循环里用ADC_SoftwareStartConv软件触发来采样。电流信号与PWM强相关。最理想的做法是利用定时器触发ADC。例如配置产生PWM的定时器如TIM1在某个特定事件如CNT0时产生一个TRGO信号用这个信号去触发ADC开始转换。这保证了每次采样都在PWM周期的同一相位点进行避免了因PWM开关噪声造成的采样值跳动。采样点选择对于低侧采样采样时机更有讲究。为了避免采样到续流阶段的电流此时采样电阻无电流我们通常选择在PWM“开”的阶段中后期进行采样此时电流已经趋于稳定。这可以通过调整定时器触发延迟或使用ADC的采样保持时间来微调。过采样与滤波在单个控制周期内可以进行多次ADC采样过采样然后在软件中进行平均滤波或滑动平均滤波以抑制随机噪声。一个简单有效的函数如下#define FILTER_LEN 8 uint16_t current_adc_filter_buf[FILTER_LEN] {0}; uint8_t filter_index 0; uint16_t get_filtered_adc_value(uint16_t new_sample) { current_adc_filter_buf[filter_index] new_sample; filter_index (filter_index 1) % FILTER_LEN; uint32_t sum 0; for(int i0; iFILTER_LEN; i) { sum current_adc_filter_buf[i]; } return (uint16_t)(sum / FILTER_LEN); }提示滤波会引入相位滞后。滤波窗口FILTER_LEN越大平滑效果越好但延迟也越大可能影响环路响应速度。需要根据控制频率比如10kHz和信号噪声情况折中选取。3.2 电流值的标定与换算ADC读回来的是一个数字量比如0-409512位ADC。我们需要把它换算成有物理意义的电流值单位安培。建立转换模型假设我们的信号调理电路设计为电流I0A时运放输出V_mid1.65V对应ADC值AdcZero2048假设3.3V参考电压。电流I1A时运放输出V_mid0.1V1.75V对应ADC值AdcPos。电流I-1A时运放输出V_mid-0.1V1.55V对应ADC值AdcNeg。标定实际焊接的电阻、运放放大倍数都有误差。最可靠的方法是实际标定。给电机施加一个已知的稳定负载或使用精密可调电源和电流表不接电机直接给采样电阻供电测量不同电流下的ADC值用最小二乘法拟合出ADC值与实际电流的线性关系I_actual K * (AdcRaw - AdcZero)。其中K是换算系数单位A/ADC LSB。软件实现// 标定得到的参数 #define ADC_ZERO_OFFSET 2048.0f // 零电流对应ADC值 #define CURRENT_SCALE 0.001f // 换算系数例如 0.001 A/LSB (即1mA/LSB) float get_actual_current(uint16_t adc_raw) { // 减去零点偏移并换算成电流安培 float i_actual (float)((int32_t)adc_raw - ADC_ZERO_OFFSET) * CURRENT_SCALE; return i_actual; }注意将adc_raw转换为有符号数运算以得到正负电流。3.3 离散PID控制器的实现与优化PID算法是电流环的“大脑”。其连续形式公式为u(t) Kp * e(t) Ki * ∫e(t)dt Kd * de(t)/dt。在数字系统中我们需要离散化实现。位置式PID虽然直观但每次输出都与过去所有误差有关计算量大且容易积分饱和。在嵌入式系统中更常用的是增量式PID。 增量式PID只计算控制量的增量Δu(k)公式为 Δu(k) Kp * [e(k)-e(k-1)] Ki * e(k) Kd * [e(k)-2e(k-1)e(k-2)] 其中e(k)是本次误差目标电流-实际电流。然后本次输出 u(k) u(k-1) Δu(k)。增量式的优点计算量小只需保存最近两次误差值输出的是增量对系统冲击小且积分项和微分项的处理更自然易于实现抗积分饱和和微分先行等优化。一个基础的C语言实现如下typedef struct { float target; // 目标值 float actual; // 实际值 float err; // 当前误差 float err_last; // 上一次误差 float err_prev; // 上上次误差 float Kp, Ki, Kd; // PID参数 float integral; // 积分项增量式中可不用单独积分但为抗饱和可保留 float output; // 输出值 float output_max; // 输出限幅 float output_min; } PID_IncTypeDef; float PID_Inc_Calculate(PID_IncTypeDef *pid) { pid-err pid-target - pid-actual; // 计算增量 float delta_out pid-Kp * (pid-err - pid-err_last) pid-Ki * pid-err pid-Kd * (pid-err - 2*pid-err_last pid-err_prev); // 更新历史误差 pid-err_prev pid-err_last; pid-err_last pid-err; // 计算本次输出 pid-output delta_out; // 输出限幅 if(pid-output pid-output_max) pid-output pid-output_max; if(pid-output pid-output_min) pid-output pid-output_min; return pid-output; }注意这里的output对应的是PWM的占空比设定值例如0-1000对应0%-100%。output_max/min需要根据你的PWM计数范围和系统安全限制来设定。3.4 PWM生成与死区时间插入控制器的输出最终要落实到PWM占空比上。对于直流有刷电机的H桥控制我们通常使用互补输出带死区的PWM模式。互补输出微控制器的一个通道如TIM1_CH1产生主PWM其互补通道TIM1_CH1N自动产生反相PWM。这样可以直接控制H桥的同一侧上下两个开关管一个打开时另一个关闭逻辑清晰。死区时间这是防止H桥上下管直通短路的生命线。由于开关管MOSFET的开启和关闭需要时间如果控制信号同时要求上下管切换可能在瞬间出现上下管都导通的情况造成电源短路烧毁驱动芯片和MOSFET。死区时间就是在互补的PWM信号中插入一个两者都为低电平关闭的小延时。 在STM32的定时器配置中我们可以直接设置BDTR寄存器中的死区时间Dead Time值硬件会自动插入这段延时无需软件干预。死区时间需要根据你使用的驱动芯片或MOSFET的开关速度来设定通常从几十纳秒到几百纳秒不等具体查数据手册。4. 电流环PID参数整定从理论到手感参数整定是PID控制的灵魂也是新手最头疼的部分。对于电流环这种内环目标通常是追求快速、无超调的电流跟踪。这里分享一个我常用的“先比例后积分微分看情况”的实操调试法。4.1 调试前的准备工作安全第一将电机的机械负载卸掉或者让电机空载悬空运行。防止参数不当导致电机剧烈抖动损坏设备。设定合理的期望电流环的响应速度可以非常快目标带宽通常希望达到几百Hz甚至上千Hz远高于外环的速度环。但我们先从保守开始。准备观测工具最好能有示波器通过DAC将目标电流和实际电流可以用ADC值经过简单缩放后输出输出到示波器观察波形。如果没有可以通过串口打印数据在电脑上用串口绘图工具如Serial Plotter观察。4.2 分步调试法第一步纯比例控制P将Ki和Kd设为0。给一个较小的目标电流阶跃比如从0到0.2A对应空载下较小的PWM占空比。从非常小的Kp开始比如0.1逐步增大Kp。观察现象随着Kp增大系统响应会变快实际电流会更快地趋向目标值。但会出现稳态误差静差即最终稳定值达不到目标值。这是因为纯比例无法消除负载扰动等带来的误差。目标找到系统开始出现轻微振荡的临界Kp值记为Kp_critical。然后将工作Kp设定为临界值的50%-70%。此时系统响应较快且没有振荡。第二步加入积分控制I保持上一步得到的Kp不变。引入一个很小的Ki值。观察现象积分项的作用是消除稳态误差。你会看到之前存在的静差被慢慢修正实际电流最终能精确达到目标值。问题与调整Ki过大会带来两个问题一是“积分饱和”在目标值突变时累积的积分项过大导致输出超调严重并产生振荡二是使系统响应变“钝”抗干扰能力下降。需要缓慢增加Ki直到静差在可接受的时间内被消除同时阶跃响应只有轻微的超调或没有超调。技巧可以采用“积分分离”或“抗积分饱和”算法。积分分离即在误差较大时如启动阶段取消积分作用防止饱和抗饱和则是在输出达到限幅时停止积分项的累积。第三步考虑微分控制D对于电流环由于其本身惯性相对较小且被控对象电机电气时间常数通常不大微分环节D并非必须。引入微分可以预测误差变化趋势抑制超调但也会放大高频噪声因为ADC采样的噪声会被微分。如果经过P和I调节后系统响应仍有难以接受的超调或振荡可以尝试加入很小的Kd。务必注意必须先对实际电流信号进行充分的低通滤波才能使用微分项否则噪声会被严重放大导致系统不稳定。4.3 调试中的典型波形与对策响应迟钝上升慢增大Kp。稳态存在静差增大Ki。响应有超调并振荡减小Kp或Ki或尝试加入小的Kd。高频抖动或噪声大检查ADC采样和布线加强软件滤波如果使用了Kd首先减小或取消Kd。电机发出“滋滋”高频声可能是PWM频率处于人耳可听范围如低于20kHz尝试提高PWM频率如提高到20kHz以上也可能是电流环带宽过高与控制频率不匹配产生了谐振。记住没有一套“万能参数”。不同的电机、不同的驱动电路、不同的采样电阻、不同的控制频率都需要重新调试。调试的本质是理解P、I、D三个参数对系统动态特性的物理影响然后通过观察-调整-再观察的迭代过程让系统达到满意的性能。5. 进阶话题与常见问题排查当基本的电流环跑通后你会遇到一些更深入的问题和优化点。5.1 控制频率与系统延迟控制频率即PID计算的执行频率并非越高越好。它受到ADC采样转换时间、算法计算时间、PWM更新速度的限制。通常电流环的控制频率设置在5kHz到20kHz之间。更高的频率意味着更小的控制延迟能实现更高的带宽但对MCU算力和ADC性能要求也更高。你需要评估从ADC采样到PWM更新完成的整个环路延迟。这个延迟是限制电流环性能的关键因素之一。使用定时器触发ADCDMA传输并在DMA传输完成中断中进行PID计算和PWM更新可以最大限度地减少软件引入的随机延迟。5.2 采样噪声与接地问题电流采样信号极其微弱非常容易受到干扰。如果你的电流读数跳动很大除了软件滤波一定要检查硬件星型接地模拟地运放、ADC参考地和功率地电机驱动、电源地应在一点连接避免功率地的大电流在模拟地路径上产生压降。采样电阻的布线采样电阻两端的走线应尽可能短、粗且对称开尔文连接直接连接到运放输入端。走线要远离高频的PWM线和电机线。电源去耦在运放和MCU的电源引脚附近紧贴芯片放置0.1uF和10uF的电容为高频噪声提供低阻抗回路。信号调理电路的布局运放电路应紧凑反馈电阻和电容尽量靠近运放引脚。5.3 从电流环到速度位置环串级PID当你拥有了一个响应良好的电流环作为内环构建外层的速度环或位置环就相对容易了这就是串级PID。外环速度环控制器的输出直接作为内环电流环控制器的目标值。调试时必须先调好内环确保其响应速度远快于外环通常要求内环带宽是外环的5-10倍以上。然后将内环视为一个快速的“执行单元”再去调试外环的PID参数。如果内环没调好外环的参数怎么调都会不稳定。5.4 驱动保护与故障处理一个健壮的系统必须有保护机制过流保护在ADC采样后立即判断电流是否超过安全阈值如电机最大允许电流的1.2倍。如果超过立即将PWM输出强制置为0关闭所有MOSFET或进入刹车模式并置位错误标志。堵转检测电机堵转时电流会持续很大。可以结合电流值和速度如果有时进行判断。一旦检测到堵转应进入保护状态。硬件保护充分利用驱动芯片自带的保护功能如TB6612的STBY待机引脚在故障时拉低可以快速关断输出。实现直流有刷电机的电流环控制是一个将模拟电路、数字采样、控制理论和嵌入式编程紧密结合的典型项目。它没有太多黑魔法需要的是一步一个脚印的扎实工作理解每个硬件模块的作用精心设计PCB布局和走线稳健地编写底层驱动最后耐心地、有方法地调试PID参数。这个过程充满挑战但当你看到电机电流能够精准、快速地跟随你的指令变化时那种对系统获得深入掌控感的成就感是无与伦比的。这不仅仅是让电机转起来而是真正意义上“驯服”了它为后续实现更复杂的运动控制打下了最坚实的基础。
1. 项目缘起从“能动”到“控好”的必经之路搞电机应用开发的朋友尤其是从玩具小车、机械臂或者一些DIY项目入门的最开始接触的往往是“让电机转起来”。用个L298N、TB6612或者A4950这类驱动模块给个PWM信号电机就欢快地转起来了这感觉确实不错。但当你真正想把电机用在一个对性能有要求的场合比如需要稳定转速的云台、需要精准力矩的机械手关节或者需要快速响应的竞速小车时你就会发现仅仅控制电压PWM占空比是远远不够的。电机负载一变转速就飘想让它快速停在一个位置它却来回振荡。这时候你就遇到了从“开环控制”到“闭环控制”的门槛。而电流环往往是构建高性能电机控制系统的第一块也是最核心的基石。为什么是电流环你可以把电机系统想象成一辆车。PWM电压控制相当于你直接踩油门踏板踩多深给多少油但车跑多快、爬坡费不费劲你并不直接知道。速度环就像你看车速表发现慢了就多踩点油门快了就松一点。而电流环则是更底层、更直接的控制——它控制的是发动机的扭矩输出。对于直流有刷电机而言其输出扭矩与电枢电流成正比T Kt * Ia其中Kt是转矩常数。因此直接、快速地控制住电流就等于直接、快速地控制住了电机的输出力矩。有了稳定且响应快速的力矩你再去构建外层的速度环、位置环整个系统才会稳如磐石。所以实现电流环控制是迈向精准电机控制无法绕开的一步。本次分享我就以一个典型的基于微控制器如STM32和H桥驱动如TB6612的直流有刷电机平台为例抛开复杂的理论公式聚焦于如何从零开始一步步地搭建、调试并理解一个可用的电流环。我们会用到ADC采样电流、PID算法进行闭环计算最终通过PWM输出控制电机。过程中遇到的坑比如采样噪声、PID参数整定、驱动死区时间等我都会结合自己的实操经验详细说明。2. 系统框架与核心硬件选型解析在动手写代码之前我们必须先把系统的物理框架和关键硬件的作用搞清楚。一个典型的直流有刷电机电流环控制系统可以分解为以下几个核心部分2.1 动力执行单元电机与驱动桥直流有刷电机是我们的控制对象。驱动部分TB6612、A4950、L293D等都是常见的选择。它们本质都是一个H桥电路允许我们通过微控制器的信号控制电机的方向、启停并通过PWM输入来调节平均电压。选型时需重点关注几个参数驱动电流能力必须大于电机堵转电流、供电电压范围、以及是否集成衰减模式与死区时间保护。例如TB6612它内部集成了MOSFET和必要的保护电路支持双路电机控制逻辑电平兼容3.3V/5V对于中小型直流电机是非常方便的选择。注意驱动芯片的“使能”引脚和“输入逻辑”引脚要区分开。使能引脚是总开关通常需要拉高输入逻辑引脚如AIN1/AIN2则决定方向和PWM输入。接线错误会导致电机不转或控制异常。2.2 信息感知单元电流采样电路这是电流环的“眼睛”。我们需要测量流经电机的电流。常见方法有三种低侧采样在H桥的下桥臂与地之间串联一个采样电阻Shunt Resistor。这种方法电路简单共地容易。但缺点是当PWM在下桥臂关闭时电流会通过续流二极管流通此时采样电阻上无电流无法测量会存在采样盲区。对于需要连续电流信息的系统这会影响性能。高侧采样在电源与H桥之间串联采样电阻。可以测量所有情况下的电流但电路设计复杂需要专门的差分放大器或高侧电流检测芯片来处理共模电压问题。霍尔效应电流传感器如ACS712。这类传感器基于霍尔效应电气隔离性好精度高但成本也较高且存在一定的响应延迟。对于成本敏感且性能要求不是极端高的场合低侧采样配合适当的PWM调制策略是一个务实的选择。我们选择一颗阻值小如0.1欧姆、功率大如1W以上、精度高1%的金属膜电阻作为采样电阻。电阻值的选择是个权衡阻值太大损耗大压降也大阻值太小采样信号微弱容易被噪声淹没。通常使电机在最大工作电流时采样电阻上的压降在几十到一百毫伏量级比较合适。2.3 信号调理与数字化运算放大器与ADC采样电阻上的电压信号是微弱的mV级且是双极性的电流可正可负对应电机正反转。而微控制器的ADC通常只能测量0到正参考电压的单极性信号。因此我们需要一个信号调理电路。放大使用运算放大器如LMV358搭建一个同相放大电路将采样电压放大到适合ADC采样的范围比如0-3.3V。抬升偏置为了测量双极性电流我们需要将放大后的信号“抬升”一个中间电压如1.65V。这样当电流为0时ADC输入为1.65V电流为正时电压高于1.65V电流为负时电压低于1.65V。这可以通过在运放电路中加入一个参考电压来实现。调理后的模拟信号送入微控制器的ADC输入引脚。ADC的分辨率如12位、采样速率和采样时机至关重要。STM32的ADC功能强大支持定时器触发采样这对于与PWM周期同步采样、避免噪声至关重要。2.4 大脑微控制器与算法微控制器MCU负责执行整个闭环算法。它需要产生驱动电机所需的PWM信号通常使用高级定时器的互补输出通道以方便插入死区时间。在精确的时刻通常是PWM周期中的特定点触发ADC对调理后的电流信号进行采样。运行PID控制算法读取ADC值换算成实际电流与目标电流比较通过PID运算计算出新的PWM占空比。更新PWM输出完成一次控制循环。整个系统的信息流是这样的目标电流 - PID控制器 - PWM占空比 - H桥驱动 - 电机电流 - 采样电阻 - 信号调理 - ADC - 实际电流值 - PID控制器形成一个完整的闭环。3. 关键软件实现从ADC采样到PID输出硬件搭好后软件才是让系统“活”起来的关键。这里我们分步拆解。3.1 ADC采样策略与软件触发时机ADC采样的准确性直接决定了电流环的感知精度。噪声是最大的敌人。除了硬件上做好滤波如在运放输出端加一个小电容软件策略同样重要。同步采样绝不能随意在循环里用ADC_SoftwareStartConv软件触发来采样。电流信号与PWM强相关。最理想的做法是利用定时器触发ADC。例如配置产生PWM的定时器如TIM1在某个特定事件如CNT0时产生一个TRGO信号用这个信号去触发ADC开始转换。这保证了每次采样都在PWM周期的同一相位点进行避免了因PWM开关噪声造成的采样值跳动。采样点选择对于低侧采样采样时机更有讲究。为了避免采样到续流阶段的电流此时采样电阻无电流我们通常选择在PWM“开”的阶段中后期进行采样此时电流已经趋于稳定。这可以通过调整定时器触发延迟或使用ADC的采样保持时间来微调。过采样与滤波在单个控制周期内可以进行多次ADC采样过采样然后在软件中进行平均滤波或滑动平均滤波以抑制随机噪声。一个简单有效的函数如下#define FILTER_LEN 8 uint16_t current_adc_filter_buf[FILTER_LEN] {0}; uint8_t filter_index 0; uint16_t get_filtered_adc_value(uint16_t new_sample) { current_adc_filter_buf[filter_index] new_sample; filter_index (filter_index 1) % FILTER_LEN; uint32_t sum 0; for(int i0; iFILTER_LEN; i) { sum current_adc_filter_buf[i]; } return (uint16_t)(sum / FILTER_LEN); }提示滤波会引入相位滞后。滤波窗口FILTER_LEN越大平滑效果越好但延迟也越大可能影响环路响应速度。需要根据控制频率比如10kHz和信号噪声情况折中选取。3.2 电流值的标定与换算ADC读回来的是一个数字量比如0-409512位ADC。我们需要把它换算成有物理意义的电流值单位安培。建立转换模型假设我们的信号调理电路设计为电流I0A时运放输出V_mid1.65V对应ADC值AdcZero2048假设3.3V参考电压。电流I1A时运放输出V_mid0.1V1.75V对应ADC值AdcPos。电流I-1A时运放输出V_mid-0.1V1.55V对应ADC值AdcNeg。标定实际焊接的电阻、运放放大倍数都有误差。最可靠的方法是实际标定。给电机施加一个已知的稳定负载或使用精密可调电源和电流表不接电机直接给采样电阻供电测量不同电流下的ADC值用最小二乘法拟合出ADC值与实际电流的线性关系I_actual K * (AdcRaw - AdcZero)。其中K是换算系数单位A/ADC LSB。软件实现// 标定得到的参数 #define ADC_ZERO_OFFSET 2048.0f // 零电流对应ADC值 #define CURRENT_SCALE 0.001f // 换算系数例如 0.001 A/LSB (即1mA/LSB) float get_actual_current(uint16_t adc_raw) { // 减去零点偏移并换算成电流安培 float i_actual (float)((int32_t)adc_raw - ADC_ZERO_OFFSET) * CURRENT_SCALE; return i_actual; }注意将adc_raw转换为有符号数运算以得到正负电流。3.3 离散PID控制器的实现与优化PID算法是电流环的“大脑”。其连续形式公式为u(t) Kp * e(t) Ki * ∫e(t)dt Kd * de(t)/dt。在数字系统中我们需要离散化实现。位置式PID虽然直观但每次输出都与过去所有误差有关计算量大且容易积分饱和。在嵌入式系统中更常用的是增量式PID。 增量式PID只计算控制量的增量Δu(k)公式为 Δu(k) Kp * [e(k)-e(k-1)] Ki * e(k) Kd * [e(k)-2e(k-1)e(k-2)] 其中e(k)是本次误差目标电流-实际电流。然后本次输出 u(k) u(k-1) Δu(k)。增量式的优点计算量小只需保存最近两次误差值输出的是增量对系统冲击小且积分项和微分项的处理更自然易于实现抗积分饱和和微分先行等优化。一个基础的C语言实现如下typedef struct { float target; // 目标值 float actual; // 实际值 float err; // 当前误差 float err_last; // 上一次误差 float err_prev; // 上上次误差 float Kp, Ki, Kd; // PID参数 float integral; // 积分项增量式中可不用单独积分但为抗饱和可保留 float output; // 输出值 float output_max; // 输出限幅 float output_min; } PID_IncTypeDef; float PID_Inc_Calculate(PID_IncTypeDef *pid) { pid-err pid-target - pid-actual; // 计算增量 float delta_out pid-Kp * (pid-err - pid-err_last) pid-Ki * pid-err pid-Kd * (pid-err - 2*pid-err_last pid-err_prev); // 更新历史误差 pid-err_prev pid-err_last; pid-err_last pid-err; // 计算本次输出 pid-output delta_out; // 输出限幅 if(pid-output pid-output_max) pid-output pid-output_max; if(pid-output pid-output_min) pid-output pid-output_min; return pid-output; }注意这里的output对应的是PWM的占空比设定值例如0-1000对应0%-100%。output_max/min需要根据你的PWM计数范围和系统安全限制来设定。3.4 PWM生成与死区时间插入控制器的输出最终要落实到PWM占空比上。对于直流有刷电机的H桥控制我们通常使用互补输出带死区的PWM模式。互补输出微控制器的一个通道如TIM1_CH1产生主PWM其互补通道TIM1_CH1N自动产生反相PWM。这样可以直接控制H桥的同一侧上下两个开关管一个打开时另一个关闭逻辑清晰。死区时间这是防止H桥上下管直通短路的生命线。由于开关管MOSFET的开启和关闭需要时间如果控制信号同时要求上下管切换可能在瞬间出现上下管都导通的情况造成电源短路烧毁驱动芯片和MOSFET。死区时间就是在互补的PWM信号中插入一个两者都为低电平关闭的小延时。 在STM32的定时器配置中我们可以直接设置BDTR寄存器中的死区时间Dead Time值硬件会自动插入这段延时无需软件干预。死区时间需要根据你使用的驱动芯片或MOSFET的开关速度来设定通常从几十纳秒到几百纳秒不等具体查数据手册。4. 电流环PID参数整定从理论到手感参数整定是PID控制的灵魂也是新手最头疼的部分。对于电流环这种内环目标通常是追求快速、无超调的电流跟踪。这里分享一个我常用的“先比例后积分微分看情况”的实操调试法。4.1 调试前的准备工作安全第一将电机的机械负载卸掉或者让电机空载悬空运行。防止参数不当导致电机剧烈抖动损坏设备。设定合理的期望电流环的响应速度可以非常快目标带宽通常希望达到几百Hz甚至上千Hz远高于外环的速度环。但我们先从保守开始。准备观测工具最好能有示波器通过DAC将目标电流和实际电流可以用ADC值经过简单缩放后输出输出到示波器观察波形。如果没有可以通过串口打印数据在电脑上用串口绘图工具如Serial Plotter观察。4.2 分步调试法第一步纯比例控制P将Ki和Kd设为0。给一个较小的目标电流阶跃比如从0到0.2A对应空载下较小的PWM占空比。从非常小的Kp开始比如0.1逐步增大Kp。观察现象随着Kp增大系统响应会变快实际电流会更快地趋向目标值。但会出现稳态误差静差即最终稳定值达不到目标值。这是因为纯比例无法消除负载扰动等带来的误差。目标找到系统开始出现轻微振荡的临界Kp值记为Kp_critical。然后将工作Kp设定为临界值的50%-70%。此时系统响应较快且没有振荡。第二步加入积分控制I保持上一步得到的Kp不变。引入一个很小的Ki值。观察现象积分项的作用是消除稳态误差。你会看到之前存在的静差被慢慢修正实际电流最终能精确达到目标值。问题与调整Ki过大会带来两个问题一是“积分饱和”在目标值突变时累积的积分项过大导致输出超调严重并产生振荡二是使系统响应变“钝”抗干扰能力下降。需要缓慢增加Ki直到静差在可接受的时间内被消除同时阶跃响应只有轻微的超调或没有超调。技巧可以采用“积分分离”或“抗积分饱和”算法。积分分离即在误差较大时如启动阶段取消积分作用防止饱和抗饱和则是在输出达到限幅时停止积分项的累积。第三步考虑微分控制D对于电流环由于其本身惯性相对较小且被控对象电机电气时间常数通常不大微分环节D并非必须。引入微分可以预测误差变化趋势抑制超调但也会放大高频噪声因为ADC采样的噪声会被微分。如果经过P和I调节后系统响应仍有难以接受的超调或振荡可以尝试加入很小的Kd。务必注意必须先对实际电流信号进行充分的低通滤波才能使用微分项否则噪声会被严重放大导致系统不稳定。4.3 调试中的典型波形与对策响应迟钝上升慢增大Kp。稳态存在静差增大Ki。响应有超调并振荡减小Kp或Ki或尝试加入小的Kd。高频抖动或噪声大检查ADC采样和布线加强软件滤波如果使用了Kd首先减小或取消Kd。电机发出“滋滋”高频声可能是PWM频率处于人耳可听范围如低于20kHz尝试提高PWM频率如提高到20kHz以上也可能是电流环带宽过高与控制频率不匹配产生了谐振。记住没有一套“万能参数”。不同的电机、不同的驱动电路、不同的采样电阻、不同的控制频率都需要重新调试。调试的本质是理解P、I、D三个参数对系统动态特性的物理影响然后通过观察-调整-再观察的迭代过程让系统达到满意的性能。5. 进阶话题与常见问题排查当基本的电流环跑通后你会遇到一些更深入的问题和优化点。5.1 控制频率与系统延迟控制频率即PID计算的执行频率并非越高越好。它受到ADC采样转换时间、算法计算时间、PWM更新速度的限制。通常电流环的控制频率设置在5kHz到20kHz之间。更高的频率意味着更小的控制延迟能实现更高的带宽但对MCU算力和ADC性能要求也更高。你需要评估从ADC采样到PWM更新完成的整个环路延迟。这个延迟是限制电流环性能的关键因素之一。使用定时器触发ADCDMA传输并在DMA传输完成中断中进行PID计算和PWM更新可以最大限度地减少软件引入的随机延迟。5.2 采样噪声与接地问题电流采样信号极其微弱非常容易受到干扰。如果你的电流读数跳动很大除了软件滤波一定要检查硬件星型接地模拟地运放、ADC参考地和功率地电机驱动、电源地应在一点连接避免功率地的大电流在模拟地路径上产生压降。采样电阻的布线采样电阻两端的走线应尽可能短、粗且对称开尔文连接直接连接到运放输入端。走线要远离高频的PWM线和电机线。电源去耦在运放和MCU的电源引脚附近紧贴芯片放置0.1uF和10uF的电容为高频噪声提供低阻抗回路。信号调理电路的布局运放电路应紧凑反馈电阻和电容尽量靠近运放引脚。5.3 从电流环到速度位置环串级PID当你拥有了一个响应良好的电流环作为内环构建外层的速度环或位置环就相对容易了这就是串级PID。外环速度环控制器的输出直接作为内环电流环控制器的目标值。调试时必须先调好内环确保其响应速度远快于外环通常要求内环带宽是外环的5-10倍以上。然后将内环视为一个快速的“执行单元”再去调试外环的PID参数。如果内环没调好外环的参数怎么调都会不稳定。5.4 驱动保护与故障处理一个健壮的系统必须有保护机制过流保护在ADC采样后立即判断电流是否超过安全阈值如电机最大允许电流的1.2倍。如果超过立即将PWM输出强制置为0关闭所有MOSFET或进入刹车模式并置位错误标志。堵转检测电机堵转时电流会持续很大。可以结合电流值和速度如果有时进行判断。一旦检测到堵转应进入保护状态。硬件保护充分利用驱动芯片自带的保护功能如TB6612的STBY待机引脚在故障时拉低可以快速关断输出。实现直流有刷电机的电流环控制是一个将模拟电路、数字采样、控制理论和嵌入式编程紧密结合的典型项目。它没有太多黑魔法需要的是一步一个脚印的扎实工作理解每个硬件模块的作用精心设计PCB布局和走线稳健地编写底层驱动最后耐心地、有方法地调试PID参数。这个过程充满挑战但当你看到电机电流能够精准、快速地跟随你的指令变化时那种对系统获得深入掌控感的成就感是无与伦比的。这不仅仅是让电机转起来而是真正意义上“驯服”了它为后续实现更复杂的运动控制打下了最坚实的基础。
)
