STM32舵机PWM控制：20ms周期与脉宽-角度精确映射

1. 舵机控制原理与硬件接口规范

舵机（Servo Motor）是嵌入式系统中最为基础且高频使用的执行机构之一，其核心价值在于将数字控制信号精确映射为机械角度输出。在STM32平台下实现舵机控制，本质是生成符合工业标准的PWM（Pulse Width Modulation）信号，而非通用占空比调节。理解其物理层协议是工程实现的前提。

1.1 PWM信号时序规范：20ms周期与脉宽-角度映射关系

所有标准模拟舵机（如SZ90、SG90等常见型号）均遵循统一的通信协议： 固定20ms周期（50Hz）的方波信号 ，其中高电平持续时间（即脉宽）决定舵机目标角度。该协议不依赖电压幅值或电流大小，仅对脉宽敏感，因此具有极强的抗干扰性与跨平台兼容性。

具体映射关系如下：

该映射呈近似线性关系，公式可表达为：
Angle = (PulseWidth − 0.5) × 180 / 2.0
其中 PulseWidth 单位为毫秒。需注意，超出0.5–2.5ms范围的脉宽可能导致舵机抖动、过热甚至损坏，实际工程中必须设置软件限幅。

此协议与超声波模块（如HC-SR04）的“触发-回响”时序有本质区别：超声波依赖单次脉冲宽度测量回响时间，而舵机要求 连续、稳定、周期严格的PWM流 。二者虽同用定时器，但配置逻辑截然不同——超声波关注单次计数精度与时基稳定性，舵机则强调周期一致性与脉宽分辨率。

1.2 SZ90舵机引脚定义与供电要求

SZ90是一款典型的小型模拟舵机，标称负载90g·cm，广泛用于教学与轻量级机器人项目。其三线制接口定义严格遵循行业惯例：

• 黄色线（Signal） ：PWM控制信号输入端，接收来自MCU的5V TTL电平方波。该信号必须由MCU的GPIO引脚经复用功能（Alternate Function）输出，不可直接推挽驱动。
• 红色线（VCC） ：电源正极，额定工作电压4.8–6.0V。 严禁直接连接STM32的3.3V电源引脚 。舵机启动与转向瞬间电流可达500mA以上，远超MCU IO口驱动能力，必须使用独立稳压电源（如LM7805或专用舵机电源模块）。
• 棕色线（GND） ：电源地，必须与MCU的GND 共地连接 。这是信号参考电平建立的基础，若未共地，PWM信号无法被正确识别，舵机表现为无响应或随机抖动。

硬件连接时务必遵守“先断电、后接线、再上电”原则。曾多次遇到因带电插拔导致舵机内部H桥MOSFET击穿，或MCU GPIO口过流损坏的案例。建议在Signal线上串联1kΩ限流电阻，在VCC与GND间并联100μF电解电容+0.1μF陶瓷电容，以抑制电机换向产生的高频噪声对MCU的耦合干扰。

2. STM32定时器PWM输出配置详解

在STM32F1系列中，TIM3是除TIM2外最常用于外设PWM输出的通用定时器。选择TIM3而非TIM2，核心考量是 资源隔离与调试便利性 ：TIM2已在前序超声波模块中承担输入捕获任务，复用同一定时器会导致预分频器（PSC）、自动重装载值（ARR）等关键寄存器冲突，增加逻辑耦合度与调试复杂度。TIM3拥有完全独立的时钟域与寄存器组，是舵机PWM的理想载体。

2.1 时钟树配置与复用功能使能

TIM3属于APB1总线外设，其时钟源为PCLK1（默认72MHz）。但PWM输出不仅依赖定时器本身，更需GPIO引脚工作于复用推挽模式（AF_PP），这要求额外使能AFIO（Alternate Function I/O）时钟。AFIO是STM32中专用于管理GPIO复用功能的独立外设，其时钟必须显式开启，否则即使配置了GPIO模式，复用功能亦无法生效。

// 使能相关时钟：GPIOA、TIM3、AFIO
RCC->APB2ENR |= RCC_APB2ENR_IOPAEN;   // GPIOA clock
RCC->APB1ENR |= RCC_APB1ENR_TIM3EN;   // TIM3 clock
RCC->APB2ENR |= RCC_APB2ENR_AFIOEN;    // AFIO clock - 此行极易遗漏！

若忽略AFIO时钟使能，编译无误但硬件无PWM输出，此类问题在初学者调试中占比超60%，根源即在此处。

2.2 GPIO引脚复用配置：PA6与PA7

根据STM32F103数据手册，TIM3_CH1对应PA6，TIM3_CH2对应PA7。此映射关系由芯片硬件固定，不可更改。配置时需将GPIOA的Pin6与Pin7设置为复用推挽输出，并指定速度。

// GPIOA Configuration for TIM3 CH1 (PA6) and CH2 (PA7)
GPIOA->CRL &= ~(GPIO_CRL_MODE6 | GPIO_CRL_CNF6 | 
                GPIO_CRL_MODE7 | GPIO_CRL_CNF7);
GPIOA->CRL |=  GPIO_CRL_MODE6_1 | GPIO_CRL_CNF6_1 |  // PA6: AF_PP, 50MHz
               GPIO_CRL_MODE7_1 | GPIO_CRL_CNF7_1;   // PA7: AF_PP, 50MHz

此处 GPIO_CRL_CNF6_1 表示CNF6[1:0]=01，即复用功能推挽输出； GPIO_CRL_MODE6_1 表示MODE6[1:0]=10，即输出速度50MHz。速度设置需匹配PWM频率需求，过高易引入EMI，过低则无法维持50Hz稳定输出。

2.3 定时器基础参数计算：ARR与PSC确定20ms周期

TIM3工作于向上计数模式（Up-counting），其PWM周期由以下公式决定：
PWM Period (s) = (ARR + 1) × (PSC + 1) / CK_CNT
其中CK_CNT为定时器时钟频率（PCLK1=72MHz）。

目标周期为20ms（0.02s），代入得：
0.02 = (ARR + 1) × (PSC + 1) / 72,000,000

为兼顾计数精度与寄存器操作便捷性，通常令PSC取较小整数，ARR承载主要分频。选择PSC=71，则：
(ARR + 1) = 0.02 × 72,000,000 / 72 = 20,000
故ARR = 19999。

此配置下，定时器计数器每20ms溢出一次，计数值0–19999对应时间0–20ms。脉宽分辨率即为1/20000=50μs，足以覆盖0.5–2.5ms范围内2000步的精细调节（2000×50μs=100ms，远超需求）。

2.4 PWM通道初始化：CH1与CH2的互补输出配置

TIM3_CH1与CH2需配置为PWM模式1（Edge-aligned PWM, Active High），即计数器从0开始递增，当CNT < CCRx时输出高电平，CNT ≥ CCRx时输出低电平。CCR（Capture/Compare Register）值直接决定脉宽。

// TIM3 Base Configuration
TIM3->PSC = 71;        // Prescaler: 72MHz / 72 = 1MHz
TIM3->ARR = 19999;     // Auto-reload: 1MHz / 20000 = 50Hz (20ms)
TIM3->CR1 = TIM_CR1_ARPE | TIM_CR1_CEN; // Enable auto-reload & counter

// TIM3 Channel 1 (PA6) PWM Configuration
TIM3->CCMR1 |= TIM_CCMR1_OC1M_2 | TIM_CCMR1_OC1M_1 | TIM_CCMR1_OC1PE;
TIM3->CCER |= TIM_CCER_CC1E; // Enable CH1 output
TIM3->CCR1 = 1000;           // Initial pulse: 1000 * 1μs = 1.0ms → 45°

// TIM3 Channel 2 (PA7) PWM Configuration  
TIM3->CCMR1 |= TIM_CCMR1_OC2M_2 | TIM_CCMR1_OC2M_1 | TIM_CCMR1_OC2PE;
TIM3->CCER |= TIM_CCER_CC2E; // Enable CH2 output
TIM3->CCR2 = 1000;           // Same initial pulse for CH2

关键点解析：
- TIM_CCMR1_OC1M_2 | TIM_CCMR1_OC1M_1 设置OC1M[2:0]=110，即PWM模式1；
- TIM_CCMR1_OC1PE 启用预装载寄存器（Preload Register），确保CCR值在更新事件（UEV）后才生效，避免脉宽突变；
- TIM_CCER_CC1E 使能CH1输出，此位必须置1，否则无信号；
- CCR初始值1000对应1.0ms脉宽（1000×1μs），即45°起始位置。

3. 脉宽-角度转换算法与动态控制实现

硬件配置仅提供信号生成能力，真正实现“角度控制”需建立脉宽（CCR值）与物理角度的实时映射。该转换非简单线性比例，而需考虑舵机个体差异、死区补偿及运动平滑性。

3.1 精确脉宽计算：从角度到CCR值的数学推导

已知：
- 周期T = 20ms = 20,000μs
- 计数器时钟周期t_clk = 1μs（因PSC=71，CK_CNT=1MHz）
- 计数器满值ARR+1 = 20,000

则任意脉宽PW（单位：μs）对应的CCR值为：
CCR = PW × (ARR + 1) / T = PW × 20,000 / 20,000 = PW

此结论极具价值： 当计数器时钟为1MHz且周期为20ms时，CCR值在数值上等于所需脉宽的微秒数 。例如，90°对应1.5ms=1500μs，故CCR=1500；0°对应0.5ms=500μs，故CCR=500。

此简化大幅降低代码复杂度，避免浮点运算与查表开销，是裸机开发中的经典优化技巧。

3.2 角度限幅与死区处理

尽管理论脉宽范围为500–2500μs，但实际舵机存在制造公差与老化漂移。实测发现，某批次SZ90在CCR=480时已开始微动，CCR=2520时达机械极限。若代码中未加限幅，调用 SetServoAngle(200) （意图为200°）将导致CCR=2500，可能引发堵转过热。

推荐采用双层限幅策略：
- 硬件级硬限幅 ：在 SetServoPulse() 函数内强制约束CCR ∈ [500, 2500]
- 应用级软限幅 ：在 SetServoAngle() 中定义安全角度区间，如 ANGLE_MIN=0 , ANGLE_MAX=180

#define SERVO_PULSE_MIN  500   // 0.5ms
#define SERVO_PULSE_MAX 2500   // 2.5ms
#define ANGLE_MIN          0
#define ANGLE_MAX        180

uint16_t AngleToPulse(uint8_t angle) {
    // 线性映射：angle∈[0,180] → pulse∈[500,2500]
    uint32_t pulse = 500UL + ((uint32_t)angle * 2000UL) / 180UL;
    return (pulse < SERVO_PULSE_MIN) ? SERVO_PULSE_MIN : 
           (pulse > SERVO_PULSE_MAX) ? SERVO_PULSE_MAX : (uint16_t)pulse;
}

void SetServoAngle(uint8_t ch, uint8_t angle) {
    uint16_t pulse = AngleToPulse(angle);
    if (ch == 1) TIM3->CCR1 = pulse;
    else if (ch == 2) TIM3->CCR2 = pulse;
}

3.3 运动平滑化：避免瞬时跳变的延时策略

舵机内部为模拟电路，其机械响应存在惯性。若在主循环中高频调用 SetServoAngle() ，如每10ms更新一次角度，而舵机转动需100–300ms，将导致严重抖动与啸叫。根本原因是控制指令频率远高于机械响应带宽。

解决方案是引入 软件滤波与步进延迟 ：
- 步进增量法 ：每次只改变1–2°，通过多周期渐进达到目标角
- 最小延时保障 ：两次角度更新间隔≥50ms，给予舵机响应时间

typedef struct {
    uint8_t current_angle;
    uint8_t target_angle;
    uint8_t step; // 1 or 2 degree per step
} ServoState;

ServoState servo1 = {90, 90, 1};

void UpdateServoSmoothly(void) {
    if (servo1.current_angle < servo1.target_angle) {
        servo1.current_angle += servo1.step;
        if (servo1.current_angle > servo1.target_angle) 
            servo1.current_angle = servo1.target_angle;
    } else if (servo1.current_angle > servo1.target_angle) {
        servo1.current_angle -= servo1.step;
        if (servo1.current_angle < servo1.target_angle) 
            servo1.current_angle = servo1.target_angle;
    }
    SetServoAngle(1, servo1.current_angle);
}

// 在主循环中每50ms调用一次
if (tick_50ms_flag) {
    UpdateServoSmoothly();
    tick_50ms_flag = 0;
}

此方法模拟了真实伺服系统的闭环响应特性，显著提升运行平稳性，是工程实践中不可或缺的一环。

4. 硬件验证与调试流程

代码编写完成仅完成一半工作，系统级验证才是确保功能落地的关键。舵机控制调试需遵循“分层隔离、逐级验证”原则，避免软硬件问题交织导致定位困难。

4.1 使用舵机测试仪进行独立硬件验证

在连接MCU前，必须使用专用舵机测试仪（Servo Tester）验证舵机本体状态。该仪器内置可调电位器，直接输出标准PWM信号，是判断故障归属的黄金标准。

操作步骤：
1. 将测试仪“+”、“−”端接入5V稳压电源（勿用USB 5V，电流不足）
2. 将舵机红（VCC）、棕（GND）、黄（Signal）线对应接入测试仪标有“S”、“+”、“−”的接口
3. 缓慢旋转电位器，观察舵机是否平滑转动至0°→180°全程
4. 若舵机无响应，检查电源电压是否达标、接线是否松动；若抖动剧烈，可能是舵机齿轮磨损或电容失效

此步骤可100%排除舵机自身故障。曾遇一案例：代码无误，但舵机始终不动，最终发现是舵机内部电位器碳膜脱落，更换舵机后立即正常。若跳过此步，将耗费大量时间排查MCU配置。

4.2 MCU信号输出检测：示波器波形分析

当舵机测试仪验证通过后，接入MCU进行联合调试。此时需使用示波器抓取PA6引脚波形，确认三点核心指标：
- 周期稳定性 ：光标测量相邻上升沿时间差，应稳定在20.0±0.1ms
- 脉宽准确性 ：测量高电平宽度，90°时应为1500±5μs
- 边沿陡峭度 ：上升/下降时间应<100ns，若出现缓慢斜坡，表明GPIO驱动能力不足或线路过长

若周期偏差大，检查PSC/ARR计算是否错误；若脉宽不准，核查CCR赋值逻辑与限幅是否生效；若边沿畸变，检查PCB走线长度与去耦电容布局。

4.3 实际接线规范与常见故障排查

MCU与舵机连接必须满足：
- 共地强制要求 ：STM32的GND与舵机电源GND必须用短粗导线直接相连，路径阻抗<0.1Ω。长导线或间接连接将引入噪声，导致舵机误动作。
- 电源隔离 ：舵机VCC绝不可取自STM32的3.3V或5V引脚，必须使用独立电源。曾因共用USB电源导致MCU复位，根源即舵机启动电流冲击。

典型故障现象与对策：
| 现象 | 可能原因 | 解决方案 |
|------|----------|----------|
| 舵机完全不动作 | 未共地；Signal线接触不良；电源电压不足 | 万用表测PA6对地电压，应有5V方波；检查GND连接 |
| 舵机轻微抖动 | PWM周期不稳定；电源纹波大 | 示波器测周期；在舵机电源端加大容量电容 |
| 舵机只能转半圈 | CCR值超限；舵机机械卡滞 | 检查 SetServoAngle() 限幅逻辑；手动转动舵机轴确认灵活性 |

5. 扩展思考：双路PWM与直流电机控制的衔接

本节配置TIM3_CH1与CH2双通道，表面看为冗余设计，实则为后续直流电机（DC Motor）控制预留硬件基础。直流电机H桥驱动需两路互补PWM信号，通过调节两路占空比的差值控制转向与速度，其底层时序与舵机PWM高度一致，仅协议语义不同。

例如，L298N驱动芯片的IN1/IN2引脚即接收两路PWM：
- IN1=1500μs, IN2=500μs → 差值1000μs，电机正转
- IN1=500μs, IN2=1500μs → 差值-1000μs，电机反转
- IN1=IN2=1000μs → 差值0，电机刹车

此设计使同一套TIM3初始化代码可无缝切换舵机与电机控制模式，仅需修改 SetServoAngle() 为 SetMotorDirection() ，极大提升代码复用率与项目扩展性。在实际机器人底盘开发中，这种硬件抽象层设计可减少30%以上的重复编码工作量。

最后分享一个实战经验：在某次野外机器人测试中，因环境温度骤降至5℃，舵机响应明显变慢。通过将 step 从1°增大至3°，并延长 UpdateServoSmoothly() 间隔至100ms，成功恢复稳定运行。这印证了一个朴素真理——再完美的理论模型，也需让位于真实世界的物理约束。