STM32电机双闭环控制：位置环+速度环串级PID的工程实现与调参实战-平芜编程栈

简介：一套基于STM32-F4平台的位置环速度双闭环串级控制方案，采用位置式PID算法，配套下位机HAL库源代码，面向电机控制方向的嵌入式学习者与开发者，解决无刷电机位置与速度精确调节及PID参数在线整定问题。代码支持按键和上位机两种方式控制PID运行与参数调整，便于观察现象或远程调试。资源包共550个文件，其中h/c为HAL库与用户源码，o、axf、hex等为编译中间产物与固件，icf、uvprojx等为工程配置，整体约20.13MB，可直接导入Keil或IAR使用。已有1213人学习下载。借助上位机可快速实现位置速度双闭环控制，宏定义引脚映射方式也便于移植到自定义硬件。注意目标值未做幅值限制时出现积分饱和属正常现象，重新启动电机时因惯性可能造成脉冲误捕获，理解这些边界条件有助于提升调试效率。做一个电机双闭环控制项目，最怕的就是代码写完了，一上电电机乱震，然后开始怀疑人生。这个项目的标题看起来很简单，但“位置环+速度环串级控制+位置式PID+HAL库”这串关键词组合在一起，其实就是一个非常典型的工业运动控制教学样板，也是很多做智能车、云台、机器人关节的工程师绕不开的坎。我这次把这套东西完整跑通了一遍，把源码、调参思路和一些踩坑的点都记录下来，希望能给正在搞STM32F4直流无刷电机控制的朋友一些参考。

这套方案最终实现的效果是：给定一个目标位置，电机能够平滑地加速、减速、精确停稳，整个过程没有超调、没有振荡，稳态精度控制在编码器单圈计数误差以内。如果你也在做类似的闭环控制项目，这篇文章应该能帮你省下不少折腾时间。

1. 控制架构解析：为什么非要用双环串级

1.1 位置环和速度环各自的职责边界

先想明白一个核心问题：只用位置环行不行？理论上可以，实际做出来你会发现两个问题。第一，位置环直接输出PWM占空比给电机，电机从静止到高速、再从高速到静止，整个过程的加速度是不可控的，机械冲击非常大，齿轮箱和联轴器容易受损。第二，位置环的带宽一般做得比较低，如果系统出现负载扰动，位置环的响应速度不够快，会导致明显的抖动甚至失步。

所以串级控制的思路就是把控制任务拆成两层：速度环（内环）负责“跑得快且稳”，位置环（外环）负责“走到位且准”。内环的响应速度至少要快于外环3到5倍，这样才能保证外环给出的速度指令被快速跟踪。这个频率匹配关系是双闭环能不能调出来的根本前提。

1.2 为什么选择位置式PID而不是增量式

这个项目选的是位置式PID，这是由被控对象和应用场景决定的。位置式PID的输出量是绝对值，直接对应PWM占空比或者电压指令，适用于执行机构本身需要绝对控制量的场景，比如电机电压调速。增量式PID输出的是控制量的增量，天然带积分作用，适合带自锁或者积分记忆的执行机构。

另外，位置式PID在调试时物理意义特别清晰：Kp对应“当前位置偏差”对控制量的贡献，Ki对应“累计误差”的消除能力，Kd对应“误差变化趋势”的抑制。调试过程中你很容易根据实际响应去调整具体某个系数，这对新手友好。增量式PID的系数整定更需要经验，没有位置式那么直观。

1.3 采样周期的分配策略

速度环：1kHz（定时器中断周期1ms），因为内环需要快速响应电流变化和速度波动。
位置环：200Hz（5ms），外环不需要太高频率，太高反而容易引入噪声，且会给内环施加过大的调节压力。
PWM输出频率：20kHz，超出人耳可听范围，同时让电流纹波更小，电机运行噪声显著降低。

这三个时间基准一定要分开处理，不要共用一个中断源，否则后期调参时的时间耦合问题会让人崩溃。

2. 核心代码实现：HAL库下的双环控制逻辑

2.1 编码器读取与速度计算的工程实现

用的是STM32F407的TIM3编码器模式，4倍频之后每圈产生4000个脉冲。速度计算用的是M法（测频法），在1ms中断里读取当前计数值与上一次的差值，换算成RPM。关键点是要处理计数值的反转和溢出问题，用int16_t类型的差值计算，利用C语言整型回绕特性，不需要额外判断方向。

int16_t delta = (int16_t)(encoder_count - last_count); last_count = encoder_count; int16_t speed_rpm = delta * 60 / 4000 * 1000; // 每1ms采样，换算为rpm

这个计算方式看着简单，实际用下来比那种分方向加减的写法可靠得多。速度计算出来之后我做了个一阶低通滤波，系数大概0.3，可以滤掉编码器量化噪声引起的高频毛刺。速度环对噪声非常敏感，如果不滤波，调试的时候你会发现D项怎么调都不对，电机高频嗡嗡响。

2.2 位置式PID的C语言实现

位置式PID的标准写法每个人都有自己的版本，我把它写成结构体的形式，方便参数整定和移植。关键点在于区分了PID计算和限幅逻辑，限幅是在PID计算之前完成的，避免输出饱和。

typedef struct { float target; // 目标值 float feedback; // 反馈值 float kp; float ki; float kd; float integral; float last_error; float output; float max_output; float max_integral; } PID_TypeDef; void PID_Calculate(PID_TypeDef *pid) { float error = pid->target - pid->feedback; pid->integral += error; // 抗积分饱和：限制积分项幅度 if (pid->integral > pid->max_integral) pid->integral = pid->max_integral; if (pid->integral < -pid->max_integral) pid->integral = -pid->max_integral; pid->output = pid->kp * error + pid->ki * pid->integral + pid->kd * (error - pid->last_error); if (pid->output > pid->max_output) pid->output = pid->max_output; if (pid->output < -pid->max_output) pid->output = -pid->max_output; pid->last_error = error; }

2.3 双环串级的调用框架

双环控制的灵魂在于嵌套调用的执行顺序。每一层中断里只做自己该做的事：定时器6负责1ms时基，在这个中断里执行速度环计算并更新PWM输出；定时器7负责5ms时基，在这个中断里执行位置环计算，并更新速度环的目标值。

// 定时器6中断（1ms）：速度环 void HAL_TIM_PeriodElapsedCallback(TIM_HandleTypeDef *htim) { if (htim == &htim6) { read_encoder_speed(); speed_pid.feedback = current_speed_rpm; PID_Calculate(&speed_pid); set_motor_pwm(speed_pid.output); } } // 定时器7中断（5ms）：位置环 void HAL_TIM_PeriodElapsedCallback(TIM_HandleTypeDef *htim) { if (htim == &htim7) { position_pid.feedback = current_position; PID_Calculate(&position_pid); speed_pid.target = position_pid.output; } }

这个结构确保内环始终优先执行，外环的输出只作为内环的输入目标。你不需要在速度环里判断位置是否到位，位置环自然会管这件事。代码逻辑清晰，后期维护也方便。

2.4 PWM极性匹配与刹车逻辑

速度环输出有正有负，但电机驱动板一般只能单向输出，所以直接用一个方向的PWM是不行的。我这里用的方案是：速度环输出为正时，IN1给PWM、IN2拉低；为负时反过来。方向切换时需要加死区延时，一般5到10微秒，防止上下桥臂直通。

void set_motor_pwm(float output) { uint32_t pwm_value = (uint32_t)(fabs(output) * PWM_PERIOD / 100.0f); if (output >= 0) { __HAL_TIM_SET_COMPARE(&htim1, TIM_CHANNEL_1, pwm_value); __HAL_TIM_SET_COMPARE(&htim1, TIM_CHANNEL_2, 0); } else { __HAL_TIM_SET_COMPARE(&htim1, TIM_CHANNEL_1, 0); __HAL_TIM_SET_COMPARE(&htim1, TIM_CHANNEL_2, pwm_value); } }

还有一点很关键，电机在使能前一定要保证输出为0，并且要在主循环里加一个急停逻辑，当位置跟踪误差超过某个阈值时直接封锁PWM输出，让电机自由停车或刹车。这个保护逻辑平时用不上，但一旦编码器线松了、或者位置环参数写错了，它能帮你省下一块驱动板和一台电机。

3. 硬件选型与HAL库工程配置实战

3.1 STM32F407最小系统板的外设资源分配

TIM1：输出两路PWM（互补通道），驱动电机H桥，20kHz频率。
TIM3：编码器接口模式，读取AB相。
TIM6：1ms中断，速度环时基。
TIM7：5ms中断，位置环时基。
USART2：调试数据输出，接VOFA+上位机，1kHz发送（数据量约每秒1KB，115200波特率足够）。

3.2 HAL库工程初始化常见隐藏问题

HAL库上手简单，但坑也不少，尤其是定时器这部分。编码器接口模式必须设置为TIM_ENCODERMODE_TI12，并且极性设置为上升沿和下降沿都计数，否则编码器的4倍频就出不来。另外，编码器模式下设置ARR要特别小心，我一般把它设为65535，让计数器自由跑，靠int16_t截断来处理溢出。

还有一个容易被忽略的坑：HAL_TIM_IC_Start_IT和HAL_TIM_Encoder_Start这两个函数不能搞混。编码器模式只需要调用HAL_TIM_Encoder_Start，不需要开启捕获中断，否则会疯狂进入中断回调。我第一次写的时候就是把这两个搞混了，导致系统卡死。

HAL库的PWM初始化需要调用HAL_TIM_PWM_Start，同时要注意配置死区时间。对于电机驱动用的H桥，死区时间一般设置在1微秒左右，STM32F407的TIM1死区寄存器配置公式需要对照参考手册去计算，而不是直接填数值。

// 死区时间配置，以ns为单位换算 // DTG[7:0] = 死区时间(us) / (1/fpclk1) - 1，具体公式见参考手册 htim1.Init.DeadTime = 72; // 约1us，fPCLK1=72MHz

3.3 电机和驱动板的选型经验

直流无刷电机在有感模式下调试双环会容易得多，推荐先用带霍尔传感器的电机或带增量式编码器的直流减速电机来跑通框架。我用的是带500线编码器的直流有刷减速电机，减速比1比30，这样速度和位置反馈信号非常干净，适合验证算法，等算法调明白了再换无刷电机也不迟。驱动板选型要看最大电流，我是用一个10A的MOS驱动模块，留足了余量。

4. 调参实战：从内环到外环的黄金顺序

4.1 速度环的整定方法与关键指标

双环调试的顺序是铁律：先整定内环，再整定外环。速度环拿到手上，首先给速度目标值（比如500RPM），然后把I和D都设为0，只加P，从小到大慢慢加，直到电机出现轻微的“嗡嗡”声但还没有持续振荡，这个P值就是临界值，最终取临界值的60%左右。

然后加I，让稳态误差降下来。I从0开始慢慢加，你会看到速度响应曲线逐渐贴近目标值，但I太大会引起低频振荡，速度曲线呈S形往复。最后加D，D主要是抑制超调，但不能加太多，不然高频噪声会被放大，电机像卡带一样抖动。调试中我习惯用VOFA+上位机看波形，速度和目标值直接画在一个图里，超调量和收敛时间一目了然。

注意：速度环的响应时间一般在50ms到200ms之间，如果响应太慢，检查是不是限幅值设太小了；如果响应太快但超调大，优先检查速度反馈滤波是否过度，而不是一味调低P。

4.2 位置环的整定难点：尽量避免超调

位置环整定和速度环有个本质区别：位置环天然不允许超调，因为没有谁会希望云台或机械臂冲过头再折返回来。所以位置环的P参数不能像速度环那样放得很激进，I参数尤其要小心，积分项很容易让位置冲过头然后反复修正，看起来就像振荡。

位置环我的经验是：先把速度环调好后，给位置环一个较小的目标（例如转动90度），从P开始试，看曲线接近目标的方式是平滑逼近还是快速冲过去再回头。前者说明P合适，后者说明P要减半。I参数只在有稳态误差时加，但实际上用位置式PID加I之后，位置稳态误差本来就不大，所以我的位置环实际上I系数非常小。

D参数在位置环里意义不大，因为位置环的输入是位置误差的变化率，而这个变化率本身已经包含了速度信息，再加D容易造成系统刚度的过度增加。我最终的位置环是PD控制，I设的很小，实测效果比PID要好，尤其是在低速停车阶段更平稳。

4.3 常见调参误区与自检清单

误区一：上来就双环一起调。出现振荡你根本分不清是哪个环的问题。正确做法是把位置环的目标值设成常数，单独给速度环阶跃信号调试。
误区二：速度环响应不够快就强行加大位置环P。位置环再大也没用，因为内环跟踪不上，外环的输出会被饱和限制住。
误区三：忽视限幅值的影响。位置环输出的限幅值决定了电机的最大速度，这个值设太小，电机运动会很慢且迟钝，设太大，位置环就失去了精细控制能力。

5. 调试工具与上位机联调经验

5.1 VOFA+配置与数据上报策略

我调试电机控制项目的标配是VOFA+这个上位机，免费、跨平台、协议简单。下位机通过串口把数据用CSV格式发出去，VOFA+的浮动协议直接解析。1kHz的数据量非常大，窗口会刷得飞快，我的策略是：速度环数据通过串口DMA发送，每10ms发送一次（100Hz刷新率），这样既保留波形细节又不会阻塞控制中断。

uint8_t tx_buffer[64]; sprintf((char*)tx_buffer, "%.2f,%.2f\n", target_speed, actual_speed); HAL_UART_Transmit_DMA(&huart2, tx_buffer, strlen((char*)tx_buffer));

用DMA发送而不是阻塞式发送，这一点在控制中断里尤其重要。阻塞式发送会导致PWM更新延迟，进而引发控制抖动。实测下来，HAL_UART_Transmit_DMA在115200波特率下，一个100字节的包大约占0.9ms的DMA时间，但不会阻塞CPU，控制中断完全不受影响。

5.2 上位机下发指令与状态监控

调试位置环时，需要一个能灵活改变目标位置的通道。我用串口接收中断加简单的命令解析：上位机发送P+角度值\r\n，下位机解析后把角度换算成编码器目标脉冲数，然后写入位置环的目标变量。这样在VOFA+里就可以直接通过发送指令来控制位置，省去了每次都要重新编译烧录的麻烦。

命令解析要放在主循环里做，不要在串口中断里做数学运算和浮点计算。串口中断只负责把数据塞进环形缓冲区，由主循环去解析，这样可以避免长命令解析过程中其他中断被阻塞。

5.3 实测效果与数据波形分析

我把整个系统调好之后做了一组阶跃测试：目标位置从0度到180度，再回到0度。从VOFA+的波形上可以明显看到三个阶段的运动过程：加速段、匀速段、减速段。整个运动过程平滑，没有过冲。速度环的响应曲线基本跟着位置环的输出走，最大速度被限幅在800RPM，加速度保持较低水平，机械冲击很小。

位置稳态误差在正负1个脉冲以内，也就是不到0.1度。这个精度已经能够满足大多数非超高精度的应用了。如果还想进一步提高精度，可以考虑上电流环，把位置环和速度环串联到电流环上，形成三闭环，但这对于直流电机来说意义不大，对无刷电机才需要。

6. 工程迁移与扩展的几点心得

这套HAL库源代码迁移到其他STM32系列时，改动量主要在初始化部分，比如时钟配置、引脚映射以及定时器外设的实例定义。只要底层接口对上，PID控制逻辑和双环框架可以直接复用。如果你用的是STM32G4系列，它还内置了运放和比较器，做无刷电机的FOC控制会更顺手。

另一个扩展方向是加电流环。对于真正的无刷电机，电流环是最内层，速度环给电流环下指令，电流环控制力矩。位置环、速度环、电流环三环串级，理论上位置环控制的是最终位置，速度环控制的是运动速度，电流环控制的是力矩输出。这套框架在STM32F3或者G4上跑FOC很实用，只是需要额外加ADC采集和Clarke/Park变换的代码。

代码工程我建议按模块拆分文件：pid.c、encoder.c、motor.c、protocol.c，每个模块固定接口，方便以后在别的项目里复用。尤其是pid.c，这个文件几乎可以原封不动地搬到任何控制项目里，包括温度控制、气压控制、无人机姿态控制等，只需要改一下target和feedback的赋值，以及限幅范围。

另外提醒一句：调参时记得给所有PID参数设置一个安全的初始值，写死在代码里，不要一开始就用外部变量。否则一旦串口通信异常，参数变成NaN或者大得离谱，电机不是飞车就是过流保护，折腾起来很烦。

本文还有配套的精品资源，点击获取