从数学公式到代码：手把手推导STM32F407舵机PWM角度控制算法（附两种角度表示法）-平芜编程栈

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

在嵌入式开发中，舵机控制是机器人、云台等项目的核心基础。很多开发者虽然能通过复制代码让舵机动起来，但对PWM信号与角度之间的数学关系、定时器参数配置原理却一知半解。本文将带您从数学公式推导开始，逐步实现STM32F407的舵机控制代码，并深入分析-90°~90°与0°~180°两种角度表示法的实现差异与适用场景。

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

1.1 PWM信号与角度的线性关系

标准舵机的控制信号是一个周期为20ms的PWM波，其中高电平持续时间（脉冲宽度）与角度呈线性对应关系：

0.5ms —— -90°（或0°） 1.0ms —— -45°（或45°） 1.5ms —— 0°（或90°） 2.0ms —— 45°（或135°） 2.5ms —— 90°（或180°）

这种线性关系可以用一次函数表示：

angle = k × pulse_width + b

其中：

angle：目标角度（°）
pulse_width：高电平脉冲宽度（ms）
k：斜率
b：截距

1.2 两种角度表示法的数学推导

表示法一：-90°~90°范围

给定两个已知点：

(0.5, -90)
(2.5, 90)

建立方程组：

0.5k + b = -90 2.5k + b = 90

解得：

k = 90 b = -135

因此角度计算公式为：

angle = 90 × pulse_width - 135

表示法二：0°~180°范围

给定两个已知点：

(0.5, 0)
(2.5, 180)

建立方程组：

0.5k + b = 0 2.5k + b = 180

解得：

k = 90 b = -45

因此角度计算公式为：

angle = 90 × pulse_width - 45

2. STM32定时器参数配置

2.1 定时器基本参数计算

STM32F407的TIM8定时器时钟频率为84MHz（APB2总线）。要实现20ms周期，需要配置ARR（自动重装载值）和PSC（预分频器）：

定时器时钟 = 84MHz / (PSC + 1) 定时器周期 = (ARR + 1) / 定时器时钟

设PSC=16800-1：

定时器时钟 = 84MHz / 16800 = 5kHz

设ARR=200-1：

定时器周期 = 200 / 5kHz = 40ms

注意：实际配置时需-1，因为计数从0开始

2.2 CCR值与脉冲宽度的转换

CCR（捕获/比较寄存器）值决定PWM高电平时间：

pulse_width = (CCR / ARR) × 20ms

因此CCR计算公式为：

CCR = (pulse_width / 20ms) × ARR

3. 代码实现与角度转换

3.1 -90°~90°表示法实现

void SetServoAngle_Symmetrical(int angle) { if(angle > 90) angle = 90; if(angle < -90) angle = -90; // 计算脉冲宽度(ms) float pulse_width = (angle + 135) / 90.0; // 计算CCR值 uint16_t ccr = (uint16_t)(pulse_width * 10); TIM8->CCR1 = ccr; }

关键点：

角度限幅处理
将角度转换为脉冲宽度
最后转换为CCR值

3.2 0°~180°表示法实现

void SetServoAngle_Unidirectional(float angle) { if(angle > 180) angle = 180; if(angle < 0) angle = 0; // 直接计算CCR值 uint16_t ccr = (uint16_t)(angle * 20.0 / 180.0 + 5); TIM8->CCR1 = ccr; }

对比两种实现方式：

特性	-90°~90°表示法	0°~180°表示法
角度范围	对称，适合双向运动	单向，适合单方向控制
代码直观性	需要额外计算	直接映射
安装校准	需要确定0°位置	需要确定90°位置
云台应用	更适合俯仰和偏航控制	更适合单轴控制

4. 二自由度云台实现技巧

4.1 双舵机协同控制

对于二自由度云台（如俯仰+偏航），需要协调两个舵机的运动：

typedef struct { int yaw; // 偏航角（-90~90） int pitch; // 俯仰角（-90~90） } GimbalAngle; void SetGimbalPosition(GimbalAngle angle) { // 偏航舵机（可能需要安装偏移校准） TIM8->CCR1 = (angle.yaw + 135) / 9; // 俯仰舵机（示例中包含-50的安装校准） TIM8->CCR2 = (angle.pitch + 135 - 50) / 9; }

4.2 高级定时器特殊配置

使用STM32高级定时器（如TIM8）时需特别注意：

必须使能PWM输出：

TIM_CtrlPWMOutputs(TIM8, ENABLE);

引脚复用配置：

GPIO_PinAFConfig(GPIOC, GPIO_PinSource6, GPIO_AF_TIM8); GPIO_PinAFConfig(GPIOC, GPIO_PinSource7, GPIO_AF_TIM8);

完整初始化流程：

void TIM8_Init(uint16_t arr, uint16_t psc) { // 1. 时钟使能 RCC_APB2PeriphClockCmd(RCC_APB2Periph_TIM8, ENABLE); RCC_AHB1PeriphClockCmd(RCC_AHB1Periph_GPIOC, ENABLE); // 2. GPIO配置（PC6/PC7） GPIO_InitTypeDef GPIO_InitStruct = { .GPIO_Pin = GPIO_Pin_6 | GPIO_Pin_7, .GPIO_Mode = GPIO_Mode_AF, .GPIO_Speed = GPIO_Speed_100MHz, .GPIO_OType = GPIO_OType_PP, .GPIO_PuPd = GPIO_PuPd_UP }; GPIO_Init(GPIOC, &GPIO_InitStruct); // 3. 时基配置 TIM_TimeBaseInitTypeDef TIM_TimeBaseStruct = { .TIM_Period = arr, .TIM_Prescaler = psc, .TIM_ClockDivision = TIM_CKD_DIV1, .TIM_CounterMode = TIM_CounterMode_Up }; TIM_TimeBaseInit(TIM8, &TIM_TimeBaseStruct); // 4. PWM输出配置 TIM_OCInitTypeDef TIM_OCStruct = { .TIM_OCMode = TIM_OCMode_PWM1, .TIM_OutputState = TIM_OutputState_Enable, .TIM_OCPolarity = TIM_OCPolarity_High }; TIM_OC1Init(TIM8, &TIM_OCStruct); TIM_OC2Init(TIM8, &TIM_OCStruct); // 5. 使能预装载和PWM输出 TIM_OC1PreloadConfig(TIM8, TIM_OCPreload_Enable); TIM_ARRPreloadConfig(TIM8, ENABLE); TIM_CtrlPWMOutputs(TIM8, ENABLE); TIM_Cmd(TIM8, ENABLE); }

5. 实际应用中的问题解决

5.1 安装校准技巧

舵机安装时的校准至关重要：

对于-90°~90°表示法：
- 先让舵机运行到0°位置（1.5ms）
- 在此位置安装机械结构
对于0°~180°表示法：
- 先让舵机运行到90°位置（1.5ms）
- 在此位置安装机械结构

校准偏移通常在代码中处理：

// 示例：俯仰轴有-5°的安装偏移 TIM8->CCR2 = (angle + 135 - (5 * 9)) / 9;

5.2 运动平滑处理

直接设置目标角度可能导致舵机运动不平稳，可以添加缓动算法：

void SmoothServoMove(int target_angle) { static int current_angle = 0; const int step = 2; // 每步变化量 while(abs(current_angle - target_angle) > step) { current_angle += (target_angle > current_angle) ? step : -step; SetServoAngle(current_angle); delay_ms(20); // 控制运动速度 } SetServoAngle(target_angle); // 确保到达最终位置 }