不止于转动：用STM32F103的PWM精细控制MG996舵机角度，实现平滑运动与多点定位

STM32F103与MG996舵机的精密控制：从PWM基础到运动优化实战

在机器人关节控制、云台稳定系统等需要精确角度调节的场景中，舵机扮演着关键角色。而MG996作为一款高扭矩模拟舵机，其性能表现很大程度上取决于控制信号的精度。本文将带您深入探索如何利用STM32F103的定时器PWM功能，实现对MG996舵机角度的高精度控制，并解决实际应用中常见的运动平滑性问题。

1. 理解MG996舵机的控制特性

MG996是一款180度模拟舵机，采用PWM信号进行位置控制。与数字舵机不同，它对外部控制信号的响应有其独特的非线性特征。要实现对它的精密控制，首先需要深入理解其工作机制。

典型MG996舵机的控制信号规格如下：

在实际应用中，我们会发现几个关键现象：

• 死区现象：在脉冲宽度接近极值(500μs或2500μs)时，舵机响应会变得不敏感
• 非线性响应：相同的脉冲宽度变化量，在不同位置区间产生的角度变化量不一致
• 机械回差：从不同方向到达同一位置时，实际物理位置可能存在微小差异

这些特性意味着，简单的线性映射往往无法实现真正的精确控制。我们需要建立更精细的控制模型。

2. STM32F103的PWM配置与校准

STM32F103系列微控制器提供了强大的定时器功能，特别适合生成精确的PWM信号。以下是配置TIM2通道2输出PWM信号的核心代码：

// PWM初始化函数 void PWM_Init(void) { // 启用TIM2和GPIOA时钟 RCC_APB1PeriphClockCmd(RCC_APB1Periph_TIM2, ENABLE); RCC_APB2PeriphClockCmd(RCC_APB2Periph_GPIOA, ENABLE); // 配置PA1为TIM2_CH2输出 GPIO_InitTypeDef GPIO_InitStructure; GPIO_InitStructure.GPIO_Mode = GPIO_Mode_AF_PP; GPIO_InitStructure.GPIO_Pin = GPIO_Pin_1; GPIO_InitStructure.GPIO_Speed = GPIO_Speed_50MHz; GPIO_Init(GPIOA, &GPIO_InitStructure); // 定时器基础配置 TIM_TimeBaseInitTypeDef TIM_TimeBaseInitStructure; TIM_TimeBaseInitStructure.TIM_Period = 2000-1; // ARR值 TIM_TimeBaseInitStructure.TIM_Prescaler = 720-1; // PSC值 TIM_TimeBaseInitStructure.TIM_ClockDivision = TIM_CKD_DIV1; TIM_TimeBaseInitStructure.TIM_CounterMode = TIM_CounterMode_Up; TIM_TimeBaseInit(TIM2, &TIM_TimeBaseInitStructure); // PWM输出配置 TIM_OCInitTypeDef TIM_OCInitStructure; TIM_OCInitStructure.TIM_OCMode = TIM_OCMode_PWM1; TIM_OCInitStructure.TIM_OutputState = ENABLE; TIM_OCInitStructure.TIM_OCPolarity = TIM_OCPolarity_High; TIM_OCInitStructure.TIM_Pulse = 0; // 初始占空比 TIM_OC2Init(TIM2, &TIM_OCInitStructure); TIM_Cmd(TIM2, ENABLE); // 启动定时器 }

提示：上述配置中，72MHz主频经720分频后得到100kHz的计数器时钟，ARR设为2000得到50Hz的PWM频率(100kHz/2000=50Hz)，这是舵机控制的标准频率。

2.1 建立角度到CCR值的映射关系

理论上，0-180度角度对应500-2500μs脉冲宽度，对应CCR值应为50-250(因为每个计数代表10μs)。但实际上，我们需要通过校准建立更精确的映射表。

校准步骤如下：

1. 准备一个高精度角度测量工具（如数字角度尺）
2. 从CCR=50开始，每次增加5，记录实际角度
3. 在关键区域（如0-30度和150-180度）可缩小步长
4. 建立CCR-角度查找表，或拟合出非线性公式

示例校准数据可能如下：

基于这些数据，我们可以实现一个更精确的角度设置函数：

// 非线性角度映射函数 uint16_t AngleToCCR(float angle) { // 基于校准数据的三次多项式拟合 return (uint16_t)(50.0 + angle*(1.12 + angle*(0.0012 - angle*0.0000035))); } void SetServoAngle(float angle) { if(angle < 0) angle = 0; if(angle > 180) angle = 180; uint16_t ccr = AngleToCCR(angle); TIM_SetCompare2(TIM2, ccr); }

3. 实现舵机运动的平滑控制

直接让舵机从一个角度跳转到另一个角度会产生机械冲击，缩短使用寿命。我们需要实现平滑的运动过渡。

3.1 缓动函数设计

缓动函数可以控制运动过程中的加速度变化，常见的有：

• 线性缓动：速度恒定，加速度突变
• 二次缓动：匀加速/匀减速运动
• 正弦缓动：更自然的加减速过程

以下是实现正弦缓动效果的代码：

// 正弦缓动函数 float EaseInOutSin(float t) { return -(cosf(M_PI * t) - 1.0f) / 2.0f; } // 平滑移动舵机到目标角度 void SmoothMoveToAngle(float startAngle, float endAngle, uint32_t durationMs) { const uint32_t steps = 50; const uint32_t delay = durationMs / steps; for(uint32_t i = 0; i <= steps; i++) { float t = (float)i / (float)steps; float easedT = EaseInOutSin(t); float currentAngle = startAngle + (endAngle - startAngle) * easedT; SetServoAngle(currentAngle); DelayMs(delay); } }

3.2 多位置序列控制

对于需要按顺序经过多个预设点的应用，可以设计如下控制结构：

typedef struct { float angle; uint32_t duration; } ServoPosition; void PlayPositionSequence(const ServoPosition* sequence, uint32_t count) { float currentAngle = 0; GetCurrentAngle(¤tAngle); // 需要实现当前位置反馈或记录 for(uint32_t i = 0; i < count; i++) { SmoothMoveToAngle(currentAngle, sequence[i].angle, sequence[i].duration); currentAngle = sequence[i].angle; } } // 使用示例 const ServoPosition cameraScan[] = { {30.0f, 800}, {90.0f, 1000}, {150.0f, 800}, {90.0f, 1000} }; PlayPositionSequence(cameraScan, sizeof(cameraScan)/sizeof(ServoPosition));

4. 高级技巧与性能优化

4.1 使用DMA实现自动位置序列

对于复杂的运动序列，可以使用DMA减轻CPU负担：

// 配置DMA自动更新CCR值 void PWM_DMA_Init(void) { // ... 初始化PWM如上 ... DMA_InitTypeDef DMA_InitStructure; RCC_AHBPeriphClockCmd(RCC_AHBPeriph_DMA1, ENABLE); DMA_DeInit(DMA1_Channel7); // TIM2_CH2使用DMA1通道7 DMA_InitStructure.DMA_PeripheralBaseAddr = (uint32_t)&TIM2->CCR2; DMA_InitStructure.DMA_MemoryBaseAddr = (uint32_t)ccrBuffer; DMA_InitStructure.DMA_DIR = DMA_DIR_PeripheralDST; DMA_InitStructure.DMA_BufferSize = BUFFER_SIZE; DMA_InitStructure.DMA_PeripheralInc = DMA_PeripheralInc_Disable; DMA_InitStructure.DMA_MemoryInc = DMA_MemoryInc_Enable; DMA_InitStructure.DMA_PeripheralDataSize = DMA_PeripheralDataSize_HalfWord; DMA_InitStructure.DMA_MemoryDataSize = DMA_MemoryDataSize_HalfWord; DMA_InitStructure.DMA_Mode = DMA_Mode_Circular; DMA_InitStructure.DMA_Priority = DMA_Priority_High; DMA_InitStructure.DMA_M2M = DMA_M2M_Disable; DMA_Init(DMA1_Channel7, &DMA_InitStructure); DMA_Cmd(DMA1_Channel7, ENABLE); TIM_DMACmd(TIM2, TIM_DMA_CC2, ENABLE); }

4.2 负载补偿与电流监测

在高负载情况下，舵机可能出现位置偏差。可以增加电流检测电路进行补偿：

[电路示意图] Vin ──[电阻分压]── ADC输入 │ [采样电阻] │ GND

对应的补偿算法：

float CurrentCompensation(float targetAngle, float currentSense) { static const float kComp = 0.5f; // 补偿系数，需实验确定 float deviation = (currentSense - NORMAL_CURRENT) * kComp; return targetAngle + deviation; }

4.3 温度监测与保护

长时间工作可能导致舵机过热，增加温度保护：

#define MAX_TEMPERATURE 70.0f void ServoUpdate(float targetAngle, float temperature) { static float reducedAngle = 0; if(temperature > MAX_TEMPERATURE) { reducedAngle += (MAX_TEMPERATURE - temperature) * 0.1f; if(reducedAngle < -20.0f) reducedAngle = -20.0f; SetServoAngle(targetAngle + reducedAngle); } else { reducedAngle *= 0.9f; // 逐渐恢复 SetServoAngle(targetAngle); } }

5. 实际应用案例分析：云台控制系统

将上述技术整合到一个两轴云台控制系统中，主要组件包括：

1. 硬件连接：

   • STM32F103C8T6最小系统板
   • 两个MG996舵机（俯仰和偏转）
   • MPU6050姿态传感器
   • 5V 3A电源

2. 控制逻辑流程：

   • 读取MPU6050获取当前姿态
   • 计算目标舵机角度
   • 应用平滑移动算法
   • 监测电流和温度
   • 调整PWM输出

3. 性能优化点：

   • 使用定时器中断定期更新位置
   • 对姿态数据进行卡尔曼滤波
   • 实现运动预测算法减少延迟

关键的控制循环代码结构：

void ControlLoop(void) { static uint32_t lastTick = 0; uint32_t currentTick = GetTick(); if(currentTick - lastTick < UPDATE_INTERVAL) return; lastTick = currentTick; // 读取传感器数据 float pitch, yaw; GetIMUData(&pitch, &yaw); // 计算目标角度 float targetPitch = CalculatePitch(pitch); float targetYaw = CalculateYaw(yaw); // 平滑移动 SmoothMoveToAngle(currentPitch, targetPitch, UPDATE_INTERVAL); SmoothMoveToAngle(currentYaw, targetYaw, UPDATE_INTERVAL); // 更新当前角度记录 currentPitch = targetPitch; currentYaw = targetYaw; // 监测系统状态 CheckSystemHealth(); }

在调试这类系统时，有几个实用技巧值得分享：

• 使用LED指示不同的工作状态（正常、过热、过载等）
• 保留串口调试接口输出关键参数
• 在关键位置添加时间戳标记，测量代码执行时间
• 对长时间运行的系统，定期保存运行日志到Flash