STM32舵机平滑运动控制：从PWM基础到S型曲线算法实践

1. 从“能转”到“转得好”：舵机速度控制的真实需求

很多刚接触STM32和舵机的朋友，可能都经历过这样一个阶段：用PWM信号让舵机“嘎吱”一声转到指定角度，就觉得大功告成了。这确实没错，基础的PWM控制能让舵机到达目标位置。但当你真正想把舵机用在一个像样的项目里，比如做一个平滑转动的云台、一个拟人化的机器人关节，或者一个需要精准跟随的机械臂时，你就会发现，仅仅“能转”是远远不够的。

问题就出在“速度”上。如果你直接用一条指令让舵机从0度转到180度，它会用尽全力、以最快的速度“哐当”一下冲过去。这种瞬间的启停，带来的问题非常多：机械结构承受巨大的冲击，容易损坏齿轮；云台上的摄像头画面会剧烈抖动；机器人动作生硬，毫无美感可言。更关键的是，在需要动态跟踪或者连续路径规划的场合，这种“跳变”式的运动根本无法实现。

所以，“舵机速度控制”的核心需求，并不是让舵机转得更快——实际上，舵机的最大速度由其内部电机和减速箱决定，我们无法超越这个物理极限。我们真正要做的，是让舵机以我们期望的、可控的、平滑的速度运动到目标位置。这本质上是实现一个“软”的加速度和减速度过程，让运动曲线变得柔和、可控。在机器人、动画制作、精密仪器等领域，这被称为“轨迹规划”或“运动控制”的最基础一环。

基于STM32来实现这个功能，是一个性价比和灵活性俱佳的选择。STM32丰富的定时器资源可以产生非常精准的PWM波，其强大的计算能力又能轻松运行速度规划算法。相比于使用专用的舵机控制板，自己用STM32实现，你对整个控制逻辑有百分之百的掌控权，可以定制任何你想要的运动曲线，这也是学习和深入理解运动控制原理的绝佳途径。

2. 舵机速度控制的底层逻辑：PWM占空比与位置的关系

要控制速度，首先得彻底理解舵机是如何被控制的。市面上最常见的舵机（如SG90、MG996R）都是位置伺服舵机。它们内部有一个控制电路、一个直流电机、一套减速齿轮组和一个位置反馈电位器（或编码器）。

其工作逻辑是一个闭环控制：控制电路持续比较我们给出的PWM信号所指示的“目标位置”，与电位器反馈回来的“当前位置”。如果两者不一致，电路就会驱动电机正转或反转，直到当前位置与目标位置一致为止。而我们能控制的唯一输入，就是PWM信号的脉宽。

对于最常见的模拟舵机，控制信号是一个周期为20ms（频率50Hz）的PWM波。在这个周期内，高电平的持续时间（脉宽）决定了目标角度：

• 通常，0.5ms的脉宽对应0度（或-90度，取决于舵机型号）。
• 1.5ms的脉宽对应90度（中间位置）。
• 2.5ms的脉宽对应180度（或+90度）。

这里有一个关键的认知：舵机“看到”的只是当前这个PWM周期的脉宽值，并立刻将其解算为一个绝对位置指令。它没有记忆，不会知道上一个周期你给了什么指令。这就是为什么直接给一个从0.5ms跳变到2.5ms的PWM信号，舵机会全力冲向180度的原因——对它来说，目标位置瞬间从A点跳到了B点。

因此，实现速度控制的思路就清晰了：我们不能让目标位置（即PWM脉宽）跳变，而必须让它连续、平滑地变化。如果我们想用2秒钟从0度匀速转到180度，那么就需要在2秒内，将PWM脉宽从0.5ms逐步、均匀地增加到2.5ms。舵机在每个时刻接收到的都是一个“微调”后的新位置，它会朝着这个很近的新位置移动，宏观上就形成了平滑的匀速运动。这就像我们开车，不是一下子把方向盘打到头，而是一点点地转动。

注意：不同品牌、型号的舵机，其中位脉宽和角度范围可能有细微差异。务必查阅你的舵机数据手册进行校准。例如，有些舵机的中位是1.52ms，范围是0.5ms~2.5ms。微小的误差会导致角度不准。

3. 核心方案选择：定时器中断 vs. 硬件PWM动态更新

理解了原理，接下来就是如何在STM32上实现这种“脉宽平滑变化”。主要有两种主流方案，各有优劣，选择哪种取决于你对性能、精度和系统复杂度的要求。

3.1 方案一：定时器中断 + 动态重设CCR值

这是最直观、最灵活，也是初学者最容易理解的方案。其核心是利用STM32的一个基本定时器（如TIM6、TIM7）产生一个固定周期（比如10ms）的中断。在这个中断服务函数里，我们根据预设的速度规划，计算出一个新的目标脉宽，然后手动更新控制舵机的那个PWM定时器（如TIM1、TIM2等高级定时器）的捕获/比较寄存器（CCRx）。

步骤拆解：

1. 硬件连接：将舵机的信号线（通常是橙色或白色）连接到STM32的某个具有PWM输出功能的引脚上，例如TIM2_CH1对应的PA0引脚。
2. PWM定时器初始化：配置一个高级/通用定时器（如TIM2）产生频率为50Hz（周期20ms）的PWM波。初始化时，将CCR1寄存器设置为中位值（如对应1.5ms的计数值），让舵机先回到中点。

   // 示例：TIM2初始化部分代码 (HAL库) TIM_HandleTypeDef htim2; TIM_OC_InitTypeDef sConfigOC = {0}; htim2.Instance = TIM2; htim2.Init.Prescaler = 84-1; // 假设系统时钟84MHz，预分频后1MHz htim2.Init.CounterMode = TIM_COUNTERMODE_UP; htim2.Init.Period = 20000-1; // 1MHz / 20000 = 50Hz htim2.Init.ClockDivision = TIM_CLOCKDIVISION_DIV1; HAL_TIM_PWM_Init(&htim2); sConfigOC.OCMode = TIM_OCMODE_PWM1; sConfigOC.Pulse = 1500; // 初始脉宽对应1.5ms (1MHz时钟下，1500个 ticks) sConfigOC.OCPolarity = TIM_OCPOLARITY_HIGH; sConfigOC.OCFastMode = TIM_OCFAST_DISABLE; HAL_TIM_PWM_ConfigChannel(&htim2, &sConfigOC, TIM_CHANNEL_1); HAL_TIM_PWM_Start(&htim2, TIM_CHANNEL_1);

3. 控制定时器初始化：配置另一个基本定时器（如TIM6），使其产生一个10ms的中断。这个时间间隔就是我们对舵机位置进行“微调”的步进周期。

   // TIM6初始化，用于10ms中断 TIM_HandleTypeDef htim6; htim6.Instance = TIM6; htim6.Init.Prescaler = 8400-1; // 84MHz / 8400 = 10kHz htim6.Init.CounterMode = TIM_COUNTERMODE_UP; htim6.Init.Period = 100-1; // 10kHz / 100 = 100Hz (10ms) HAL_TIM_Base_Init(&htim6); HAL_TIM_Base_Start_IT(&htim6); // 开启中断

4. 中断服务函数与速度规划：在TIM6的中断服务程序里，实现核心逻辑。

   // 全局变量 uint32_t target_pulse = 2500; // 目标脉宽（对应180度） uint32_t current_pulse = 1500; // 当前脉宽 uint32_t step = 5; // 每次中断增加的脉宽步进值（单位：定时器tick） void HAL_TIM_PeriodElapsedCallback(TIM_HandleTypeDef *htim) { if (htim->Instance == TIM6) { // 判断是否到达目标 if (current_pulse < target_pulse) { current_pulse += step; if (current_pulse > target_pulse) current_pulse = target_pulse; __HAL_TIM_SET_COMPARE(&htim2, TIM_CHANNEL_1, current_pulse); } // 也可以处理反向运动... } }

   速度计算：这里的step值直接决定了速度。例如，从1500到2500，差值为1000。如果每10ms步进5，那么总时间 = 1000 / 5 * 10ms = 2000ms (2秒)。速度 = 180度 / 2秒 = 90度/秒。

方案一优缺点分析：

• 优点： 原理简单，易于理解和调试。灵活性极高，可以在中断函数里实现任何复杂的运动曲线（如S型加减速、抛物线等）。不占用DMA或高级定时器特殊功能。
• 缺点： 依赖中断。如果中断周期太短（比如想实现更平滑的1ms更新），会加重CPU负担，影响系统中其他中断的响应。在中断服务函数中进行浮点运算（如需计算S曲线）更需谨慎。

3.2 方案二：单定时器PWM+DMA自动传输

这是一种更高级、更“优雅”的方案，它能将CPU从频繁的中断中解放出来。其核心思想是：预先计算好一整条平滑运动轨迹上每一个点的PWM脉宽值，将这些值按顺序存入一个数组，然后利用DMA（直接存储器访问）控制器，按照定时器的更新事件，自动地将数组中的下一个值搬运到PWM定时器的CCR寄存器中。

步骤拆解：

1. 计算轨迹数组：在程序初始化时，根据期望的运动时间、速度和曲线，计算出一个pulse_buffer[]数组。数组长度 = 运动总时间 / PWM周期（20ms）。例如，2秒匀速运动，需要 2000ms / 20ms = 100 个点。

   #define BUFFER_SIZE 100 uint32_t pulse_buffer[BUFFER_SIZE]; void generate_trajectory(uint32_t start, uint32_t end, uint32_t num_points) { for (uint32_t i = 0; i < num_points; i++) { // 线性插值 pulse_buffer[i] = start + (end - start) * i / (num_points - 1); } }

2. 配置PWM定时器：配置TIM2产生50Hz PWM，这一点和方案一相同。
3. 配置DMA：将DMA通道配置为从存储器（pulse_buffer）到外设（TIM2->CCR1）的数据传输。关键点是触发源：设置为定时器的“更新事件”（UEV）。这样，每次PWM周期结束（产生更新事件）时，DMA就会自动将下一个数组值传给CCR1。

   // DMA配置示例（CubeMX配置更直观） // 需要配置DMA流，方向为Memory-to-Peripheral，外设地址为 &TIM2->CCR1 // 内存地址为 pulse_buffer，数据宽度为Word，循环模式开启。

4. 启动传输：启动DMA传输，并启动PWM定时器。之后，CPU就无需干预，舵机会自动按照数组定义的轨迹平滑运动。

方案二优缺点分析：

• 优点： CPU零开销，效率极高。运动过程极其平稳，因为DMA传输由硬件精确触发，不受其他中断干扰。非常适合需要多个舵机同步、精确执行复杂轨迹的场景（如舞蹈机器人）。
• 缺点： 实现难度稍高，需要对DMA有较好理解。需要提前知道完整的运动轨迹并预计算数组，不适合需要频繁、动态改变目标点的实时交互场景（除非动态刷新数组）。会占用一个DMA通道。

如何选择？

• 对于学习、单个舵机控制或运动模式不固定的项目，强烈推荐方案一（定时器中断）。它直观，调试方便，灵活性无与伦比。
• 对于多舵机、要求运动平滑性极高、或CPU任务繁重的产品级应用，方案二（PWM+DMA）是更专业的选择。

4. 让运动更高级：从匀速到S型加减速

如果我们只是简单地在中断里做线性累加（current_pulse += step），舵机的运动速度是恒定的，这会产生一个问题：在运动的起点和终点，速度会从0突变到V，又从V突变到0。这种加速度的突变（即“加加速度”或“冲击”无穷大），在物理上依然会造成振动和噪音。

为了解决这个问题，工业运动控制中普遍采用“S型加减速曲线”。它通过对加速度也进行平滑处理，使得速度曲线呈S形，加速度曲线呈梯形，从而将冲击降到最低。

对于STM32上的舵机控制，我们完全可以实现一个简化版的S型曲线规划。核心思想不再是每次给一个固定的位置增量（step），而是根据一个速度变量v来更新位置，而这个速度变量v本身又是根据加速度a来变化的。

我们可以规划一个包含7段的S型曲线：加加速段、匀加速段、减加速段、匀速段、加减速段、匀减速段、减减速段。但对于很多舵机应用，一个简化的3段或5段模型已经足够。

下面是一个简化S型算法的中断服务函数思路：

// 全局状态变量 typedef enum { ACCEL, // 加速段 CONST, // 匀速段 DECEL // 减速段 } MoveState; MoveState state = ACCEL; float current_pos = 1500.0; // 当前位置（浮点以便计算） float current_vel = 0.0; // 当前速度 float target_pos = 2500.0; float max_vel = 100.0; // 最大速度 (pulse/s) float accel = 20.0; // 加速度 (pulse/s^2) float decel_dist; // 减速段需要提前开始计算的距离 void HAL_TIM_PeriodElapsedCallback(TIM_HandleTypeDef *htim) { if (htim->Instance == TIM6) { float dt = 0.01f; // 中断周期10ms = 0.01s switch(state) { case ACCEL: current_vel += accel * dt; if (current_vel > max_vel) current_vel = max_vel; // 计算剩余距离，判断是否需要开始减速 if ((target_pos - current_pos) <= (current_vel*current_vel / (2*decel))) { state = DECEL; } else if (current_vel >= max_vel) { state = CONST; } break; case CONST: // 计算剩余距离，判断是否需要开始减速 if ((target_pos - current_pos) <= (max_vel*max_vel / (2*decel))) { state = DECEL; } break; case DECEL: current_vel -= decel * dt; if (current_vel < 0) current_vel = 0; break; } // 更新位置 current_pos += current_vel * dt; if (state == DECEL && current_vel <= 0) { current_pos = target_pos; // 确保到达终点 // 运动结束，可以关闭中断或进入空闲状态 HAL_TIM_Base_Stop_IT(&htim6); } // 将浮点位置转换为整数CCR值并更新 __HAL_TIM_SET_COMPARE(&htim2, TIM_CHANNEL_1, (uint32_t)current_pos); } }

这个实现比匀速复杂，但带来的运动品质提升是质的飞跃。舵机的启动和停止会变得非常柔和安静，对机械结构的保护也更好。

5. 实战避坑与性能优化要点

理论最终要落到实操上。下面是我在多个STM32舵机项目中总结出的关键经验和容易踩的坑。

1. 定时器时钟与计数值计算这是最基础的坑。务必弄清楚你的STM32主频，以及定时器时钟经过分频后的实际频率。例如，STM32F103系列常用72MHz主频，如果定时器预分频设为72-1，则计数器时钟为1MHz。此时，一个计数值就代表1微秒。那么1.5ms的中位脉宽，对应的CCR值就是1500。计算错误会导致角度严重偏差。

2. 中断服务函数（ISR）的优化如果你采用中断方案，必须保证ISR执行时间尽可能短。

• 避免浮点运算：在中断里进行浮点计算（如上面的S型算法）在低端MCU上可能耗时较长。可以考虑使用“定点数”运算（将所有变量放大1000或10000倍，用整数计算），或者将复杂的计算放在主循环中，ISR只做简单的赋值。
• 使用__HAL_TIM_SET_COMPARE宏：这个HAL库宏是设置CCR值最安全快捷的方式。
• 注意变量类型：在中断和主程序之间共享的变量（如current_pulse,target_pulse），如果MCU是32位而变量是8位或16位，读写可能不是原子操作。对于简单的uint32_t类型，在Cortex-M内核上通常是原子的，但为了安全，可以暂时关闭中断进行更新，或者使用C11的原子操作。

3. 多个舵机的同步控制当你需要控制多个舵机（比如6足机器人需要18个舵机）时，挑战来了。

• 方案一（中断法）：仍然可以使用一个定时器中断。在中断里用一个循环依次更新所有舵机对应的CCR寄存器。只要舵机数量不多（比如少于10个），且中断周期在10-20ms，STM32完全能胜任。关键点：所有舵机的PWM应使用同一个定时器的不同通道，这样它们的周期（20ms）是严格同步的，只有占空比独立。
• 方案二（DMA法）：这是多舵机控制的终极方案。你可以创建一个二维数组pulse_buffer[CHANNEL_NUM][POINT_NUM]，或者一个一维大数组，其中按顺序存放了所有通道在每一个时间点的CCR值。然后配置DMA为“存储器到外设”的循环模式，但外设地址设置为定时器的CCR寄存器数组的首地址（如&TIM2->CCR1），并设置数据宽度为“字”，DMA会连续传输多个字到连续的CCR寄存器中。这需要仔细研究定时器CCR寄存器的内存映射和DMA的传输配置，一旦调通，威力无穷。

4. 电源与地线的处理舵机，尤其是大扭矩舵机（如MG996R），在启动和堵转时电流可以高达1-2A。这会给你的3.3V/5V系统电源带来巨大的噪声和压降。

• 绝对不要直接用开发板上的5V引脚给多个舵机供电！开发板的线性稳压器根本提供不了这么大电流。
• 必须使用独立电源：为舵机准备一个独立的5V/2A以上的开关电源模块。确保舵机电源的地（GND）与STM32开发板的地连接在一起，形成“共地”。
• 在电源入口处并联一个大电容（如470uF~1000uF的电解电容），可以吸收舵机瞬间启动产生的电流冲击，稳定电压。
• 信号线连接：尽管电流不大，但建议在STM32的PWM输出引脚和舵机信号线之间串联一个220~470欧姆的电阻，可以起到一定的限流和隔离作用，保护MCU的IO口。

5. 死区与脉宽边界保护舵机有其物理极限。持续给一个小于0.5ms或大于2.5ms的脉宽，可能会让电机持续堵转，发热甚至烧毁。

• 在更新CCR值的函数里，务必加入边界检查。

  #define PWM_MIN 500 // 0.5ms #define PWM_MAX 2500 // 2.5ms void set_servo_pulse(uint32_t pulse) { if (pulse < PWM_MIN) pulse = PWM_MIN; if (pulse > PWM_MAX) pulse = PWM_MAX; __HAL_TIM_SET_COMPARE(&htim2, TIM_CHANNEL_1, pulse); }

• 对于S型曲线规划，在计算轨迹的起点和终点时，也要确保它们落在有效范围内。

6. 调试技巧：用逻辑分析仪或示波器看波形当舵机不按预期运动时，最有效的调试手段就是查看PWM信号波形。

• 使用逻辑分析仪（几十块钱的就行）连接舵机信号线，可以清晰看到PWM的周期和脉宽是否准确，以及脉宽是否在按你设定的规律平滑变化。
• 观察波形可以立刻帮你定位是软件计算问题（脉宽变化不对），还是硬件定时器配置问题（周期不对）。

实现平滑的舵机速度控制，是从单片机“点灯”级应用迈向真正“运动控制”领域的第一步。这个过程会让你深入理解定时器、中断、PWM，甚至DMA这些核心外设，也会让你对闭环控制、轨迹规划有最直观的认识。从简单的线性插值开始，逐步尝试S型曲线，再到用DMA解放CPU，每一步的进阶都能带来项目品质的显著提升。最重要的是动手去试，用示波器去观察，当你看到舵机终于能优雅地、安静地划过一道弧线时，那种成就感就是最好的回报。