从数学本质理解PWM：用STM32CubeMX精准控制SG90舵机角度
第一次接触舵机控制时，我也曾对着那些神秘的数字感到困惑——为什么0度对应50，90度对应150？为什么ARR要设成2000？直到有一天，我意识到这一切背后藏着一个优雅的数学关系，就像突然看懂了魔术师的秘密手法。本文将带你穿透表象，直击PWM控制舵机的数学核心，让你从此告别死记硬背，真正掌握角度控制的自主权。
1. 舵机控制的数学密码
1.1 脉冲宽度与角度的线性关系
SG90这类标准舵机的控制逻辑其实非常直观：它期待每20毫秒收到一个脉冲信号，而这个脉冲的高电平持续时间决定了舵机转动的角度。具体来说：
- 0.5ms高电平 → 0度位置
- 1.5ms高电平 → 90度中立位置
- 2.5ms高电平 → 180度极限位置
这个关系可以用一个简单的线性方程表示：
目标角度 = (脉冲宽度 - 0.5ms) × (180度 / 2ms)或者反过来计算需要的脉冲宽度：
所需脉冲宽度(ms) = 0.5 + (目标角度 × 2 / 180)1.2 从时间到寄存器值的转换
在STM32的定时器系统中，我们通过ARR（Auto-Reload Register）和CCR（Capture/Compare Register）这两个关键寄存器来控制PWM输出：
- ARR决定了PWM的完整周期时长
- CCR决定了高电平的持续时间
假设我们设置ARR=2000，对应20ms周期（当定时器时钟配置适当时），那么CCR值与脉冲宽度的对应关系就是：
CCR = (所需脉冲宽度 / 20ms) × ARR将前面角度与脉冲宽度的关系代入，就得到了万能公式：
CCR = (0.5 + 目标角度×2/180) / 20 × ARR当ARR=2000时，公式简化为：
CCR = 50 + (目标角度 × 200 / 180)这就是为什么0度对应50，180度对应250——它们不是魔法数字，而是数学计算的必然结果。
2. CubeMX定时器配置实战
2.1 时钟树配置基础
在开始配置定时器前，我们需要先确保系统时钟设置正确。以STM32F103C8T6为例：
- 在Clock Configuration界面，通常选择外部晶振作为时钟源
- 确保APB1 Timer Clocks和APB2 Timer Clocks有正确的时钟频率
- 记录下TIM1所在的APB总线时钟频率（假设为72MHz）
提示：不同STM32系列时钟树结构可能不同，务必查阅对应型号的参考手册。
2.2 定时器参数计算
我们需要配置TIM1产生周期为20ms的PWM信号。关键参数计算如下：
预分频器(PSC)：降低定时器时钟频率
- 若定时器时钟为72MHz，先分频到1MHz方便计算：
- PSC = (72MHz / 1MHz) - 1 = 71
自动重装载值(ARR)：
- 目标周期 = 20ms = 20000μs
- 分频后时钟周期 = 1μs
- ARR = 20000 - 1 = 19999
不过实际应用中，我们常选择更小的ARR值（如2000）以获得更好的分辨率，此时需要重新计算PSC：
期望ARR = 2000 所需定时器时钟 = 2000 / 20ms = 100kHz PSC = (72MHz / 100kHz) - 1 = 719这样配置后：
- 实际PWM频率 = 72MHz / (719+1) / (2000) = 50Hz（周期20ms）
- 每个计数单位 = 1/100kHz = 10μs
- 0.5ms脉冲宽度 = 50计数 → CCR=50
2.3 CubeMX界面操作步骤
在Pinout & Configuration界面，选择TIM1
将Channel4设置为"PWM Generation CH4"
在Parameter Settings选项卡中：
- Prescaler (PSC): 719
- Counter Mode: Up
- Counter Period (ARR): 1999
- PWM Pulse: 初始CCR值（如150对应90度）
- CH Polarity: High
生成代码前，确保在NVIC Settings中启用了TIM1中断（如果需要）
3. 动态角度控制实现
3.1 基础控制函数
生成代码后，我们可以编写角度控制函数：
// 初始化PWM输出 HAL_TIM_PWM_Start(&htim1, TIM_CHANNEL_4); // 角度控制函数 void Set_Servo_Angle(float angle) { // 限制角度范围 if(angle < 0) angle = 0; if(angle > 180) angle = 180; // 计算CCR值 uint32_t ccr = (uint32_t)(50 + (angle * 200 / 180)); // 更新CCR __HAL_TIM_SET_COMPARE(&htim1, TIM_CHANNEL_4, ccr); }3.2 平滑运动控制
直接跳转到目标角度可能显得机械，我们可以添加缓动效果：
void Smooth_Move(float start_angle, float end_angle, uint16_t duration_ms) { uint32_t start_time = HAL_GetTick(); uint32_t end_time = start_time + duration_ms; while(HAL_GetTick() < end_time) { float progress = (float)(HAL_GetTick() - start_time) / duration_ms; float current_angle = start_angle + (end_angle - start_angle) * progress; Set_Servo_Angle(current_angle); HAL_Delay(10); } // 确保最终位置准确 Set_Servo_Angle(end_angle); }3.3 多舵机协同控制
当需要控制多个舵机时，可以使用定时器中断批量更新：
// 在tim.c中启用更新中断 HAL_TIM_Base_Start_IT(&htim1); // 在stm32f1xx_it.c中添加 void TIM1_UP_IRQHandler(void) { HAL_TIM_IRQHandler(&htim1); static uint8_t update_flag = 0; if(update_flag) { __HAL_TIM_SET_COMPARE(&htim1, TIM_CHANNEL_1, ccr1); __HAL_TIM_SET_COMPARE(&htim1, TIM_CHANNEL_2, ccr2); update_flag = 0; } else { update_flag = 1; } }4. 进阶技巧与问题排查
4.1 精度提升方法
ARR值选择：
- ARR=2000时，角度分辨率=180/200≈0.09度
- 增大ARR可提高理论分辨率，但会受限于定时器时钟
校准技术：
// 校准函数，记录实际角度与CCR的对应关系 void Calibrate_Servo() { float measured_angles[] = {0, 45, 90, 135, 180}; uint32_t measured_ccrs[5]; // 手动测量并记录实际角度对应的CCR值 // 然后使用线性拟合计算最佳参数 }
4.2 常见问题解决方案
| 问题现象 | 可能原因 | 解决方法 |
|---|---|---|
| 舵机无反应 | 电源不足 | 确保使用5V/2A以上电源 |
| 角度不准确 | 脉冲误差 | 检查ARR和PSC计算是否正确 |
| 舵机抖动 | 信号干扰 | 添加滤波电容，缩短信号线 |
| 发热严重 | 机械阻力 | 检查负载是否超出舵机能力 |
4.3 性能优化建议
动态调整PWM频率：
- 某些应用可以降低频率以节省功耗
- 但不要低于40Hz，否则舵机可能变得不稳定
省电模式：
void Servo_Sleep_Mode() { // 停止PWM输出 HAL_TIM_PWM_Stop(&htim1, TIM_CHANNEL_4); // 将舵机信号线拉低 HAL_GPIO_WritePin(GPIOA, GPIO_PIN_11, GPIO_PIN_RESET); }抗干扰设计：
- 信号线使用双绞线
- 在舵机电源端并联100μF电解电容和0.1μF陶瓷电容
- 避免信号线与电机电源线平行走线
