STM32F1驱动直流有刷电机的双闭环控制工程：位置式PID+HAL库完整实现

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

简介：直接可用的STM32F1电机控制工程，专为直流有刷电机设计，支持高精度位置与速度协同调节。采用经典双闭环结构——外环处理目标角度偏差，内环响应转速动态变化，全部基于位置式PID算法实现，配合编码器实时反馈完成闭环校正。代码完全使用标准C语言编写，严格遵循ST官方HAL库规范，适配Keil MDK开发环境，编译输出STM32_F1.axf可直接烧录运行。工程包含主程序main.c、中断服务stm32f1xx_it.c、系统初始化system_stm32f1xx.c，以及电机控制底层驱动模块；外设支持全面覆盖：TIM（PWM生成与编码器计数）、GPIO（电机方向与使能控制）、USART（调试信息输出）、ADC（预留电流采样接口）。所有.d依赖文件已就位，便于构建分析与问题定位。适用于智能小车转向控制、云台俯仰/偏航调节、自动化执行器等需要稳定定位和柔顺调速的嵌入式应用场景。

1. 项目概述：为什么双闭环是直流有刷电机高精度控制的“必选项”

你有没有遇到过这样的情况：给小车电机发一个“转到90度”的指令，结果它要么冲过头、来回抖动，要么慢吞吞爬行、迟迟停不准？或者云台在跟踪目标时，镜头晃得像喝醉酒，速度忽快忽慢，根本谈不上平滑？这些不是电机本身的问题，而是控制策略没到位。今天要聊的这个工程，就是为了解决这类典型痛点而生的——它不是一个玩具级的PWM调速demo，而是一套真正能落地、可复用、经得起实测考验的STM32F1驱动直流有刷电机的双闭环控制系统。

核心关键词里，“STM32F1”代表硬件平台，成熟、稳定、资料丰富；“有刷电机”是执行机构，结构简单、响应快、成本低，但惯性小、易受负载扰动；“PID双闭环”是控制灵魂，它把一个复杂的“位置+速度”协同任务，拆解成两个职责清晰、互相配合的子系统；“HAL库”是开发基石，它屏蔽了寄存器操作的繁琐，让工程师能把精力聚焦在控制逻辑本身；而“位置式PID”则是算法实现的具体形态，它直接输出控制量（比如PWM占空比），而不是增量，更适合需要绝对输出值的电机驱动场景。

我做过不下二十个电机控制项目，从学生时代的智能小车，到后来工业现场的简易执行器，踩过的坑几乎都和“单环控制”有关。单靠一个速度环，你只能保证电机转得快或慢，但无法精确知道它此刻到底转了多少圈；单靠一个位置环，又容易因为积分饱和导致启动猛、停止抖。双闭环就像一个经验丰富的驾驶员：外环（位置环）是导航员，盯着GPS坐标，告诉内环“我们现在离目标还差多少角度”；内环（速度环）是油门和刹车手，根据导航员的指令，实时调整油门深浅，确保车辆既不冲过站，也不在站前熄火。编码器就是这辆车的轮速传感器+里程表，它每转一圈就发出固定数量的脉冲，STM32的TIM模块则负责把这些脉冲精准地数出来，形成最可靠的反馈信号。

这个工程最大的价值，在于它不是纸上谈兵。它已经完成了从理论到代码的完整映射：所有外设初始化（GPIO控制方向、TIM生成PWM、TIM计数编码器、USART打印调试信息）、中断服务程序（特别是编码器捕获中断和PWM更新中断）、主循环调度逻辑，全部用标准C语言写就，并严格遵循ST官方HAL库的API规范。你拿到手，导入Keil MDK，点一下编译，就能生成一个可以直接烧录进芯片的STM32_F1.axf文件。目录里那些.d后缀的文件，不是多余的，它们是编译器自动生成的依赖关系列表，当你修改了某个头文件，Keil就知道哪些源文件需要重新编译，极大提升了大型工程的构建效率和问题排查能力。它瞄准的应用场景非常明确：智能小车的转向舵机替代方案、云台的俯仰/偏航轴、自动化产线上的定位夹爪——所有那些需要“指哪打哪、动如脱兔、静如处子”的嵌入式机电一体化场合。

2. 控制架构与原理拆解：双闭环如何分工协作

理解一个控制系统的精髓，不在于记住代码怎么写，而在于搞懂它的“大脑”是怎么思考的。这个工程采用的经典双闭环结构，并非简单的两个PID串在一起，而是一个有着严密层级关系和数据流向的有机整体。我们来一层层剥开它的设计逻辑。

2.1 双闭环的层级关系与数据流

整个控制流程可以想象成一条流水线：
1. 设定值输入（Setpoint）：用户通过上位机、按键或算法计算，给出期望的目标位置（单位：编码器脉冲数或角度）。这是整个系统的“指挥棒”。
2. 外环（位置环）：它的输入是“目标位置”与“当前实际位置”的差值（即位置偏差 e_pos = target_pos - actual_pos）。它的工作就是把这个偏差，经过一个位置式PID运算，转换成一个“期望的速度”。注意，这个“期望速度”并不是最终的电机转速，而是一个中间指令，是给内环下达的“作战任务”。
3. 内环（速度环）：它的输入是“外环下达的期望速度”与“电机当前实际速度”的差值（即速度偏差 e_vel = target_vel - actual_vel）。它的任务就是把这个速度偏差，再经过一次位置式PID运算，最终输出一个具体的、可执行的控制量——也就是施加给电机的PWM占空比。

这个设计的精妙之处在于职责分离。位置环只关心“终点”，它不操心电机怎么跑，只管下达“你应该以多快的速度去那里”的宏观指令；速度环则只关心“过程”，它不关心最终要去哪，只管把外环给的速度指令，一丝不苟地、平稳地、快速地执行出来。这种分工，让系统既能达到高精度的位置控制（得益于外环的积分作用消除静态误差），又能拥有优异的动态响应性能（得益于内环对电机电气特性的快速补偿）。

2.2 为什么必须是“位置式PID”，而不是“增量式”？

PID算法有两种主流实现：位置式和增量式。它们的核心区别在于输出形式。
- 增量式PID：每次计算出的是本次输出相对于上次输出的“变化量”（Δu）。它的公式是 Δu(k) = Kp*[e(k)-e(k-1)] + Ki*e(k) + Kd*[e(k)-2e(k-1)+e(k-2)]。优点是抗积分饱和能力强，输出不会突变；缺点是它需要一个初始的“上一次输出值”作为基准，且在系统重启或手动干预后，这个基准可能丢失，导致输出跳变。
- 位置式PID：每次计算出的是一个绝对的、完整的控制量（u）。它的经典公式是 u(k) = Kp*e(k) + Ki*∑e(i) + Kd*[e(k)-e(k-1)]。

在这个电机控制工程中，我们坚定地选择了位置式PID。原因非常实际：
1. 输出物理意义明确：PWM占空比就是一个0%到100%的绝对值。位置式PID的输出 u(k) 经过限幅后，可以直接映射为占空比，逻辑清晰，没有歧义。
2. 便于手动/自动模式切换：在调试阶段，你可能需要手动给一个固定的占空比来测试电机。位置式PID的输出可以直接被“旁路”或“叠加”，而增量式PID的Δu在这种切换时，极易造成输出震荡。
3. 积分项处理更直观：虽然位置式PID有积分饱和的风险，但这个工程里，我们通过在代码中加入抗积分饱和（Anti-windup） 机制来解决。具体做法是：当PID输出 u(k) 被限幅（比如达到了最大占空比100%）时，我们就暂停对积分项 Ki*∑e(i) 的累加，防止它越积越大，一旦输出退出限幅区，积分项立刻恢复工作。这个技巧在bsp_motor_control.c的PID计算函数里有清晰体现，是实操中非常关键的一环。

2.3 编码器反馈：闭环的“眼睛”与“耳朵”

没有反馈，就没有闭环。在这个系统中，编码器是唯一的、也是最重要的传感器。它通常安装在电机轴上，随电机一起旋转，每转一圈产生固定数量的A/B相正交脉冲（比如1024线编码器，一圈就是1024个脉冲）。

STM32F1的高级定时器（如TIM1, TIM2, TIM3, TIM4）具备专门的“编码器接口模式”。它不仅能计数，还能自动识别旋转方向。其原理是：当A相脉冲上升沿到来时，如果B相是高电平，则计数器加1（正转）；如果B相是低电平，则计数器减1（反转）。这样，无论电机正转还是反转，计数器都能准确反映其角位移。

这里有一个极易被忽略的细节：编码器计数值的溢出处理。假设你用的是16位定时器（最大计数值65535），而你的电机需要旋转很多圈，计数值很快就会溢出。如果软件不做处理，actual_pos 就会从65535突然跳回0，造成巨大的位置偏差 e_pos，进而引发PID输出的剧烈震荡。因此，在stm32f1xx_it.c的编码器捕获中断服务程序（通常是TIMx_IRQHandler）里，我们必须检测计数器的溢出标志（TIM_FLAG_UPDATE），并在中断中进行“软计数”——维护一个32位的全局变量，每当发生溢出，就给这个变量加1（或减1），从而将16位的硬件计数扩展为32位的软件计数，彻底解决长距离运动的定位问题。

3. 核心模块解析与实操要点：从硬件配置到代码落地

一个成功的嵌入式控制工程，是硬件配置、外设驱动和控制算法三者严丝合缝的结合。下面，我将带你深入到这个工程的几个核心模块，解释每一行关键代码背后的“为什么”，以及我在实操中总结出的“怎么做”。

3.1 硬件资源规划与引脚分配（bsp_basic_tim.c / bsp_motor_control.c）

在开始写代码之前，必须先画一张清晰的“作战地图”，也就是硬件资源规划。这个工程主要用到了以下几类引脚：

提示：在system_stm32f1xx.c中，SystemClock_Config()函数负责配置系统时钟。对于电机控制，推荐将APB1总线（TIM2/TIM3/TIM4所在总线）频率设为最高72MHz，以获得最高的PWM分辨率和编码器计数精度。例如，若PWM频率要求为20kHz，则TIM3的计数周期为 72MHz / 20kHz = 3600，这意味着你可以将ARR设为3599，从而获得1/3600 ≈ 0.028%的占空比调节精度。

3.2 定时器中断与任务调度（stm32f1xx_it.c）

中断是实时控制系统的“心跳”。这个工程主要依赖两个中断源：

1. 编码器捕获中断（TIMx_UP_IRQn）：这是最高优先级的中断。它的唯一任务，就是在每次编码器计数器溢出（Update Event）时，更新我们的32位全局位置变量 g_actual_position。代码逻辑极其简洁：
   c void TIM3_IRQHandler(void) { HAL_TIM_IRQHandler(&htim3); // 先调用HAL库的通用处理函数 if (__HAL_TIM_GET_FLAG(&htim3, TIM_FLAG_UPDATE) != RESET) { if (__HAL_TIM_GET_IT_SOURCE(&htim3, TIM_IT_UPDATE) != RESET) { __HAL_TIM_CLEAR_IT(&htim3, TIM_IT_UPDATE); // 检查硬件计数器是向上溢出还是向下溢出 if (htim3.Instance->CNT == 0xFFFF) // 向上溢出到0 { g_actual_position += 0x10000; // 加上一个完整的16位周期 } else if (htim3.Instance->CNT == 0x0000) // 向下溢出到FFFF { g_actual_position -= 0x10000; // 减去一个完整的16位周期 } } } }
   > 注意：这段代码必须放在HAL_TIM_IRQHandler()之后，否则HAL库可能会清除掉我们关心的更新标志。

2. 主控循环中断（SysTick_IRQn）：我们将SysTick定时器配置为1ms中断。这是整个控制算法的“节拍器”。在main()中，我们调用HAL_SYSTICK_Config(HAL_RCC_GetHCLKFreq() / 1000)来完成配置。在SysTick_Handler()中，我们只做一件事：设置一个全局标志位 g_control_flag = 1。然后，在main()的主循环里，我们不断检查这个标志：
   c while (1) { if (g_control_flag) { g_control_flag = 0; Motor_Control_Loop(); // 执行一次完整的双闭环计算 } // 其他后台任务... HAL_Delay(1); // 这个延时只是为了不让CPU空转，实际项目中应替换为更高效的等待方式 }
   这种“中断置标+主循环执行”的方式，比在中断里直接执行复杂算法要安全得多，避免了中断嵌套和执行时间过长的问题。

3.3 双闭环PID计算核心（bsp_motor_control.c）

这是整个工程的“大脑”。我们来看Motor_Control_Loop()函数的核心骨架：

void Motor_Control_Loop(void)
{
  static int32_t last_pos_error = 0;
  static int32_t last_vel_error = 0;
  static int32_t integral_pos = 0;
  static int32_t integral_vel = 0;

  // 1. 获取当前实际位置（已由中断更新）
  int32_t actual_pos = g_actual_position;

  // 2. 计算位置环偏差
  int32_t pos_error = g_target_position - actual_pos;

  // 3. 位置环PID计算（位置式）
  integral_pos += pos_error;
  // 抗积分饱和：如果输出即将超限，则暂停积分累加
  if ((int32_t)(g_kp_pos * pos_error + g_ki_pos * integral_pos + g_kd_pos * (pos_error - last_pos_error)) > MAX_PWM)
  {
    integral_pos -= pos_error; // 回退一步
  }
  int32_t target_vel = g_kp_pos * pos_error + g_ki_pos * integral_pos + g_kd_pos * (pos_error - last_pos_error);
  last_pos_error = pos_error;

  // 4. 将目标速度限制在合理范围内（例如±10000脉冲/秒）
  target_vel = CLAMP(target_vel, -MAX_VEL, MAX_VEL);

  // 5. 获取当前实际速度（通过计算两次位置差得到）
  static uint32_t last_time_ms = 0;
  uint32_t current_time_ms = HAL_GetTick();
  if (current_time_ms != last_time_ms)
  {
    int32_t delta_pos = actual_pos - g_last_position;
    g_actual_velocity = (delta_pos * 1000) / (current_time_ms - last_time_ms); // 单位：脉冲/秒
    g_last_position = actual_pos;
    last_time_ms = current_time_ms;
  }

  // 6. 计算速度环偏差
  int32_t vel_error = target_vel - g_actual_velocity;

  // 7. 速度环PID计算（位置式）
  integral_vel += vel_error;
  if ((int32_t)(g_kp_vel * vel_error + g_ki_vel * integral_vel + g_kd_vel * (vel_error - last_vel_error)) > MAX_PWM)
  {
    integral_vel -= vel_error;
  }
  int32_t pwm_output = g_kp_vel * vel_error + g_ki_vel * integral_vel + g_kd_vel * (vel_error - last_vel_error);
  last_vel_error = vel_error;

  // 8. 输出限幅与方向控制
  pwm_output = CLAMP(pwm_output, -MAX_PWM, MAX_PWM);
  if (pwm_output >= 0)
  {
    HAL_GPIO_WritePin(DIR_GPIO_Port, DIR_Pin, GPIO_PIN_SET); // 正转
  }
  else
  {
    HAL_GPIO_WritePin(DIR_GPIO_Port, DIR_Pin, GPIO_PIN_RESET); // 反转
  }
  __HAL_TIM_SET_COMPARE(&htim3, TIM_CHANNEL_1, ABS(pwm_output)); // 设置PWM占空比
}

实操心得：这里的速度计算是“差分法”，即 速度 = Δ位置 / Δ时间。HAL_GetTick()提供毫秒级时间戳，精度足够用于大多数应用。但要注意，如果电机转速极低（比如每秒只转几圈），Δ位置可能为0，导致速度读数为0，这会误导速度环。一个更鲁棒的做法是使用定时器的输入捕获功能，直接测量编码器脉冲的周期，但这会增加硬件复杂度。对于本工程，我们默认电机运行在有一定转速的工况下，差分法完全够用。

4. 实操过程与完整工程构建：从零开始的Keil MDK配置指南

现在，让我们把前面所有的理论和模块，组装成一个能在Keil MDK里一键编译、烧录、运行的完整工程。这个过程看似简单，但其中隐藏着无数新手会踩的“深坑”。我会以一个真实、详细的步骤链来呈现。

4.1 Keil MDK工程创建与基础配置

1. 新建工程：打开Keil uVision5，选择 Project -> New uVision Project...，选择你的STM32F1系列芯片（例如STM32F103C8Tx）。在弹出的对话框中，选择ARM -> STMicroelectronics -> STM32F1xx下的对应型号。
2. 添加CMSIS与HAL库：Keil会询问是否复制启动文件，选择“Yes”。接着，你需要手动添加ST官方的HAL库。最便捷的方式是使用STM32CubeMX生成一个最小化的初始化工程，然后将其Core/Inc和Core/Src文件夹下的所有.h和.c文件，连同Drivers/下的CMSIS和STM32F1xx_HAL_Driver文件夹，一并复制到你的工程目录中。切记：不要直接在Keil里“Add Group”，而是先在文件管理器里把文件放好，再在Keil的“Project”窗口里右键“Add Existing Files to Group…”。
3. 配置包含路径（Include Paths）：这是编译能否成功的关键。进入 Project -> Options for Target... -> C/C++ -> Include Paths，添加以下路径（假设你的工程根目录为STM32_Motor）：
   .\Core\Inc .\Drivers\CMSIS\Device\ST\STM32F1xx\Include .\Drivers\CMSIS\Include .\Drivers\STM32F1xx_HAL_Driver\Inc .\Drivers\STM32F1xx_HAL_Driver\Inc\Legacy .\BSP // 这是你存放自己写的bsp_xxx.c/h文件的目录
   > 提示：路径中的反斜杠\在Keil里是允许的，但如果出现编译错误提示“cannot open source input file”，第一反应就是检查这里的路径是否拼写正确、是否存在。

4.2 外设初始化与主函数逻辑（main.c）

main.c是整个工程的入口。它的结构非常清晰：

int main(void)
{
  /* MCU Configuration--------------------------------------------------------*/
  /* Reset of all peripherals, Initializes the Flash interface and the Systick. */
  HAL_Init(); // 初始化HAL库，包括SysTick

  /* Configure the system clock */
  SystemClock_Config(); // 配置72MHz系统时钟

  /* Initialize all configured peripherals */
  MX_GPIO_Init();       // 初始化所有GPIO（DIR, EN, etc.）
  MX_TIM3_Init();       // 初始化TIM3：CH1为PWM输出，CH1/CH2为编码器输入
  MX_USART1_Init();     // 初始化USART1：用于printf调试输出
  MX_ADC1_Init();       // 初始化ADC1：预留电流采样（可选）

  /* USER CODE BEGIN 2 */
  // 在这里进行电机控制相关的初始化
  Motor_Control_Init(); // 初始化PID参数、清零全局变量等
  HAL_TIM_Encoder_Start(&htim3, TIM_CHANNEL_ALL); // 启动编码器计数
  HAL_TIM_PWM_Start(&htim3, TIM_CHANNEL_1);        // 启动PWM输出
  HAL_TIM_Base_Start_IT(&htim3);                   // 启动TIM3的更新中断（用于编码器溢出）
  HAL_SYSTICK_Config(HAL_RCC_GetHCLKFreq() / 1000); // 配置1ms SysTick中断
  /* USER CODE END 2 */

  /* Infinite loop */
  /* USER CODE BEGIN WHILE */
  while (1)
  {
    /* USER CODE END WHILE */

    /* USER CODE BEGIN 3 */
    if (g_control_flag)
    {
      g_control_flag = 0;
      Motor_Control_Loop();
    }
    // 可在此处添加其他后台任务，如接收上位机指令
  }
  /* USER CODE END 3 */
}

注意：MX_TIM3_Init()函数是由STM32CubeMX生成的，它内部会调用HAL_TIM_Encoder_Init()来配置编码器模式。你必须确保在MX_TIM3_Init()之后，才调用HAL_TIM_Encoder_Start()，否则启动会失败。

4.3 调试与验证：如何确认你的双闭环真的在工作？

光编译通过还不够，我们必须亲眼看到它在工作。这个工程提供了两套验证手段：

1. USART串口调试：在Motor_Control_Loop()的末尾，添加如下代码：
   c printf("POS:%ld, TARGET:%ld, VEL:%ld, PWM:%ld\r\n", g_actual_position, g_target_position, g_actual_velocity, pwm_output);
   然后使用串口助手（如XCOM、SSCOM）连接开发板，波特率设置为115200。你会看到一串飞速滚动的数据，这就是系统的实时状态。观察POS是否稳定地趋近于TARGET，VEL是否在TARGET附近小幅波动，PWM是否平滑变化。如果POS纹丝不动，首先检查编码器接线和TIM3的初始化是否正确；如果PWM一直为0，检查DIR引脚电平和使能信号。

2. 逻辑分析仪抓波形：这是最硬核的验证方式。将逻辑分析仪的通道分别接到DIR引脚和PWM引脚上。当你给一个阶跃的目标位置时，你应该能看到：DIR引脚先稳定在一个电平（决定转向），然后PWM引脚的占空比从0开始，按照一个平滑的曲线（可能是S型）逐渐增大，到达峰值后，再平滑地减小到一个维持值，最终电机停稳，PWM也稳定在一个较小的值上以克服静摩擦力。这个波形，就是双闭环协同工作的“心电图”。

5. 常见问题与排查技巧实录：那些只有亲手焊过板子才知道的坑

再完美的设计，也会在现实世界中遇到各种“意外”。以下是我在多个项目中反复遇到、并被证实有效的排查清单。它不是教科书里的理论，而是从烙铁尖上冒出来的经验。

5.1 电机完全不转：从电源到代码的逐级排查

这是一个典型的“全无反应”故障，排查必须从最底层开始：

提示：一个屡试不爽的“最小化测试法”是：暂时注释掉所有PID计算代码，在Motor_Control_Loop()里直接写死 __HAL_TIM_SET_COMPARE(&htim3, TIM_CHANNEL_1, 2000); 并 HAL_GPIO_WritePin(DIR_GPIO_Port, DIR_Pin, GPIO_PIN_SET);。如果此时电机能转，就证明硬件和基础驱动没问题，问题一定出在控制算法逻辑里。

5.2 电机抖动、定位不准：PID参数整定实战指南

这是双闭环最常见、也最让人头疼的问题。PID参数（Kp, Ki, Kd）没有标准答案，必须根据你的具体电机、负载、编码器线数来“调教”。我的整定流程如下：

1. 先调速度环（内环）：将位置环“禁用”，即让target_vel恒为一个固定值（如5000）。此时，系统就是一个单纯的速度闭环。

   • Kp：从小（如1）开始，逐步增大。你会看到电机响应越来越快，但过大会导致转速在目标值上下高频振荡。找到一个临界点，再将Kp设为该值的70%。
   • Ki：在Kp稳定后，缓慢增加Ki。它的作用是消除静态误差（比如带载时转速略低于目标值）。增加Ki会让系统更“执着”，但过大会引起低频振荡（“喘息”）。一般Ki取Kp的1/10到1/50。
   • Kd：最后加入Kd。它能抑制振荡，让响应更“沉稳”。但Kd对噪声敏感，编码器信号稍有干扰，就会被放大。通常Kd取Kp的1/10左右，甚至为0。

2. 再调位置环（外环）：在速度环稳定后，启用位置环。

   • Kp：同样从小开始。过大的Kp会导致电机像弹簧一样在目标位置附近来回弹跳。目标是让它能快速接近，但不反弹。
   • Ki：这是消除“定位死区”的关键。即使速度环完美，电机也可能因为静摩擦力，在离目标很近的地方停住不动。Ki能持续“推”它一把，直到完全到位。但Ki过大，会让电机在目标点附近缓慢地、持续地“蠕动”。
   • Kd：位置环的Kd主要用于抑制超调。它能让电机在接近目标时提前“刹车”，避免冲过头。但它的作用不如速度环Kd明显。

实操心得：永远不要同时调整三个参数！每次只动一个，记录下效果。我习惯用一个Excel表格，横轴是时间，纵轴是POS和TARGET两条曲线，每次调参后都截图保存。这样，几天下来，你就有了自己的“参数-效果”数据库，下次换电机，就能快速找到起点。

5.3 编码器计数异常：方向错乱、丢脉冲的终极解决方案

编码器问题往往表现为：电机正转时，POS却在减小；或者电机匀速转动，POS却在“跳变”。

• 方向错乱：这99%是A/B相接反了。最简单的办法，就是把编码器的A相和B相连线，在硬件上对调一下。如果还不行，检查TIMx->SMCR寄存器的SMS位，确认是否配置为了正确的编码器模式（0b001）。
• 丢脉冲：这是高速旋转时的噩梦。原因通常是编码器信号质量差（线路过长、未加终端电阻、受到电机驱动噪声干扰）。解决方案是：
  1. 硬件滤波：在编码器A/B相线上，各并联一个10nF的瓷片电容到地，滤除高频噪声。
  2. 软件滤波：在TIMx_IRQHandler()中，对连续两次读取的计数值进行比较，如果差值过大（比如超过100），就认为是干扰，丢弃本次读数，只保留上次的有效值。
  3. 提高定时器时钟：如果条件允许，将APB1总线频率从36MHz提升到72MHz，让TIM3的计数器能跟上更快的脉冲频率。

最后，分享一个小技巧：在main()的开头，加入一段“自检”代码：

// 自检：手动旋转电机一圈，看串口打印的POS变化是否在预期范围内（如±1024）
printf("Starting self-test...\r\n");
HAL_Delay(2000);
int32_t start_pos = g_actual_position;
HAL_Delay(5000); // 给你5秒时间手动转一圈
int32_t end_pos = g_actual_position;
printf("Delta: %ld\r\n", end_pos - start_pos);

这个简单的自检，能在你正式开始PID调试前，就帮你排除掉90%的硬件连接和基础驱动问题。它不花哨，但无比实用。

我个人在实际使用中发现，这套双闭环框架的威力，远不止于控制一个电机。只要把g_target_position的来源从一个固定值，换成一个由上位机通过UART发送的动态指令，或者一个由视觉算法实时计算出的目标坐标，它就能立刻升级为一个智能运动平台的核心。它像一块坚固的基石，上面可以搭建起任何你想要的上层应用。

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

简介：直接可用的STM32F1电机控制工程，专为直流有刷电机设计，支持高精度位置与速度协同调节。采用经典双闭环结构——外环处理目标角度偏差，内环响应转速动态变化，全部基于位置式PID算法实现，配合编码器实时反馈完成闭环校正。代码完全使用标准C语言编写，严格遵循ST官方HAL库规范，适配Keil MDK开发环境，编译输出STM32_F1.axf可直接烧录运行。工程包含主程序main.c、中断服务stm32f1xx_it.c、系统初始化system_stm32f1xx.c，以及电机控制底层驱动模块；外设支持全面覆盖：TIM（PWM生成与编码器计数）、GPIO（电机方向与使能控制）、USART（调试信息输出）、ADC（预留电流采样接口）。所有.d依赖文件已就位，便于构建分析与问题定位。适用于智能小车转向控制、云台俯仰/偏航调节、自动化执行器等需要稳定定位和柔顺调速的嵌入式应用场景。

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