从数学公式到代码：手把手推导STM32舵机PWM角度控制算法（附两种表示法）

在嵌入式开发中，舵机控制是机器人、云台等项目的核心基础。市面上大多数教程只给出"填参数"式的代码片段，却很少解释为什么0.5ms对应-90°、2.5ms对应90°。本文将带您从数学原理出发，完整推导两种角度表示法的转换公式，并深入分析STM32定时器参数(arr/psc/ccr)的物理意义，最终实现可移植的PWM控制代码。

1. 舵机控制原理与数学模型

1.1 PWM信号与角度的对应关系

标准舵机的控制信号是周期20ms的PWM波，通过高电平脉冲宽度（0.5ms-2.5ms）控制角度。两种常见表示法：

• 对称表示法（-90°~90°）：

  code复制0.5ms → -90°
  1.5ms → 0°
  2.5ms → 90°
  

• 非对称表示法（0°~180°）：

  code复制0.5ms → 0°
  1.5ms → 90°
  2.5ms → 180°
  

1.2 线性映射的数学推导

建立角度θ与高电平时间t的线性关系：θ = k·t + b

对称表示法推导：

math复制0.5k + b = -90  
2.5k + b = 90  
=> k = 90, b = -135  
=> θ = 90t -135  

非对称表示法推导：

math复制0.5k + b = 0  
2.5k + b = 180  
=> k = 90, b = -45  
=> θ = 90t -45  

2. STM32定时器参数解析

2.1 时钟树与定时器配置

以STM32F407ZGT6为例，配置TIM8产生20ms周期PWM：

c复制TIM8_Init(200-1, 16800-1);  // arr=199, psc=16799

参数计算过程：

1. 系统时钟168MHz，经psc分频：

   code复制f_cnt = 168MHz / (psc+1) = 1kHz 
   

2. 计数周期：

   code复制T = (arr+1)/f_cnt = 200ms/1kHz = 20ms
   

2.2 CCR寄存器与脉宽换算

捕获比较寄存器CCR与高电平时间t的关系：

math复制t = (CCR/arr) × 20ms

代码实现对比：

3. 二自由度云台实现细节

3.1 双舵机协同控制

典型云台需要控制YAW（偏航）和PITCH（俯仰）两个自由度：

c复制void Servo_Update(int yaw, int pitch) {
    // 对称表示法
    TIM8->CCR1 = (yaw + 135)/9;      // 通道1控制YAW
    TIM8->CCR2 = (pitch + 135)/9;    // 通道2控制PITCH
}

3.2 安装误差补偿

实际机械安装可能存在偏差，可通过公式调整：

c复制// 示例：PITCH轴需要补偿-5°
TIM8->CCR2 = (pitch + 135 - 5)/9;  

调试技巧：先用示波器验证PWM波形，再安装舵机

4. 高级定时器TIM8的特殊配置

4.1 关键配置步骤

不同于基础定时器，高级定时器需要额外操作：

c复制TIM_CtrlPWMOutputs(TIM8, ENABLE);  // 必须使能PWM输出
GPIO_PinAFConfig(GPIOC, GPIO_PinSource6, GPIO_AF_TIM8);  // 引脚复用

4.2 完整初始化流程

1. 使能时钟：TIM8和GPIOC
2. 配置GPIO为复用功能
3. 设置时基单元（arr/psc）
4. 配置PWM模式
5. 使能预装载和输出

c复制TIM_OCInitStructure.TIM_OCMode = TIM_OCMode_PWM1;
TIM_OCInitStructure.TIM_Pulse = 0;  // 初始CCR值
TIM_OC1Init(TIM8, &TIM_OCInitStructure);

5. 两种表示法的工程选择建议

5.1 对称表示法优势

• 符合右手坐标系习惯
• 适合需要正负方向的应用（如平衡控制）
• 公式推导更直观

5.2 非对称表示法适用场景

• 兼容传统180°舵机
• 角度参数均为正值时更简洁
• 部分库函数默认采用此方式

实际项目中，我曾遇到机械结构限制必须使用非对称表示法的情况，通过封装转换函数保持代码可读性：

c复制float SymmetricToAsymmetric(float angle) {
    return angle + 90;  // -90°~90° → 0°~180°
}

调试时建议先用Servo_SetAngle(90,90)测试中点位置，再逐步调整。遇到异常首先检查：

1. 定时器时钟是否使能
2. PWM输出是否开启
3. 引脚复用配置是否正确