用STM32 HAL库给MG90S舵机写个‘微服务’：角度控制与平滑运动实践

用STM32 HAL库构建MG90S舵机驱动模块：从基础控制到平滑运动算法

在机器人关节控制、云台稳定系统以及自动化设备中，舵机作为精确定位执行器扮演着关键角色。MG90S这款微型舵机因其体积小、扭矩适中而广受欢迎，但许多开发者在使用STM32驱动时往往止步于基础PWM输出，忽略了代码的可维护性和运动品质优化。本文将展示如何基于STM32 HAL库构建一个高内聚、低耦合的舵机驱动模块，实现角度直接控制和平滑运动功能。

1. 硬件基础与HAL库PWM配置

MG90S舵机采用标准的PWM控制协议，典型工作频率为50Hz（周期20ms），其中脉冲宽度在0.5ms到2.4ms之间对应0°到180°的角度变化。与直接操作寄存器不同，HAL库提供了更抽象的硬件接口层。

首先配置TIM3作为PWM发生器，通道2输出至PB5引脚：

void MX_TIM3_Init(uint32_t prescaler, uint32_t period) { TIM_ClockConfigTypeDef sClockSourceConfig = {0}; TIM_MasterConfigTypeDef sMasterConfig = {0}; TIM_OC_InitTypeDef sConfigOC = {0}; htim3.Instance = TIM3; htim3.Init.Prescaler = prescaler; htim3.Init.CounterMode = TIM_COUNTERMODE_UP; htim3.Init.Period = period; htim3.Init.ClockDivision = TIM_CLOCKDIVISION_DIV1; htim3.Init.AutoReloadPreload = TIM_AUTORELOAD_PRELOAD_ENABLE; HAL_TIM_Base_Init(&htim3); sClockSourceConfig.ClockSource = TIM_CLOCKSOURCE_INTERNAL; HAL_TIM_ConfigClockSource(&htim3, &sClockSourceConfig); HAL_TIM_PWM_Init(&htim3); sMasterConfig.MasterOutputTrigger = TIM_TRGO_RESET; sMasterConfig.MasterSlaveMode = TIM_MASTERSLAVEMODE_DISABLE; HAL_TIMEx_MasterConfigSynchronization(&htim3, &sMasterConfig); sConfigOC.OCMode = TIM_OCMODE_PWM1; sConfigOC.Pulse = 0; sConfigOC.OCPolarity = TIM_OCPOLARITY_HIGH; sConfigOC.OCFastMode = TIM_OCFAST_DISABLE; HAL_TIM_PWM_ConfigChannel(&htim3, &sConfigOC, TIM_CHANNEL_2); HAL_TIM_MspPostInit(&htim3); }

关键参数计算：

• 对于72MHz主频的STM32F1，预分频值7199可将计数器时钟降至10kHz
• 自动重装载值199对应20ms周期（50Hz）
• 脉冲值范围50-240对应0.5ms-2.4ms脉宽

2. 构建舵机驱动抽象层

直接操作PWM寄存器会使得业务逻辑与硬件细节耦合，我们引入面向对象思想创建舵机驱动模块：

typedef struct { TIM_HandleTypeDef *htim; uint32_t channel; float current_angle; float min_pulse; float max_pulse; } Servo_MG90S; void Servo_Init(Servo_MG90S *servo, TIM_HandleTypeDef *htim, uint32_t channel) { servo->htim = htim; servo->channel = channel; servo->min_pulse = 50.0f; // 0.5ms in 10kHz ticks servo->max_pulse = 240.0f; // 2.4ms in 10kHz ticks servo->current_angle = 90.0f; // Default to middle position // Start PWM generation HAL_TIM_PWM_Start(servo->htim, servo->channel); Servo_SetAngle(servo, servo->current_angle); } void Servo_SetAngle(Servo_MG90S *servo, float angle) { // Constrain angle to 0-180 range angle = angle < 0 ? 0 : (angle > 180 ? 180 : angle); // Linear mapping from angle to pulse width float pulse = servo->min_pulse + (angle / 180.0f) * (servo->max_pulse - servo->min_pulse); // Update PWM compare register __HAL_TIM_SET_COMPARE(servo->htim, servo->channel, (uint32_t)pulse); servo->current_angle = angle; }

这个抽象层实现了：

• 硬件细节封装（TIM句柄、通道号）
• 角度范围约束
• 线性映射计算
• 当前状态维护

3. 实现平滑运动算法

机械系统突然的位置变化会产生冲击，我们需要实现缓动(easing)效果。以下是基于状态机的实现方案：

typedef enum { SERVO_IDLE, SERVO_MOVING } Servo_State; typedef struct { Servo_MG90S base; Servo_State state; float target_angle; float step_size; uint32_t update_interval; uint32_t last_update; } Servo_MG90S_Advanced; void Servo_Advanced_Init(Servo_MG90S_Advanced *servo, TIM_HandleTypeDef *htim, uint32_t channel, float step_deg_per_ms) { Servo_Init(&servo->base, htim, channel); servo->state = SERVO_IDLE; servo->step_size = step_deg_per_ms; servo->update_interval = 10; // ms servo->last_update = HAL_GetTick(); } void Servo_SetAngleSmooth(Servo_MG90S_Advanced *servo, float angle, uint32_t now) { angle = angle < 0 ? 0 : (angle > 180 ? 180 : angle); servo->target_angle = angle; if(fabsf(servo->base.current_angle - angle) < 0.5f) { servo->state = SERVO_IDLE; return; } servo->state = SERVO_MOVING; servo->last_update = now; } void Servo_Update(Servo_MG90S_Advanced *servo, uint32_t now) { if(servo->state != SERVO_MOVING) return; if(now - servo->last_update < servo->update_interval) return; float delta = servo->step_size * (now - servo->last_update); float new_angle; if(servo->base.current_angle < servo->target_angle) { new_angle = servo->base.current_angle + delta; if(new_angle > servo->target_angle) { new_angle = servo->target_angle; servo->state = SERVO_IDLE; } } else { new_angle = servo->base.current_angle - delta; if(new_angle < servo->target_angle) { new_angle = servo->target_angle; servo->state = SERVO_IDLE; } } Servo_SetAngle(&servo->base, new_angle); servo->last_update = now; }

应用示例：

Servo_MG90S_Advanced my_servo; int main(void) { HAL_Init(); SystemClock_Config(); MX_TIM3_Init(7199, 199); // Initialize servo with 10 degrees/ms speed Servo_Advanced_Init(&my_servo, &htim3, TIM_CHANNEL_2, 0.5f); // Command smooth movement to 45 degrees Servo_SetAngleSmooth(&my_servo, 45.0f, HAL_GetTick()); while (1) { // Update servo position in main loop Servo_Update(&my_servo, HAL_GetTick()); // Other application logic... HAL_Delay(1); } }

4. 高级运动控制特性扩展

基础平滑运动可以进一步扩展为更复杂的运动模式：

4.1 运动曲线生成器

typedef float (*EasingFunction)(float); float LinearEasing(float t) { return t; } float EaseInQuad(float t) { return t*t; } float EaseOutQuad(float t) { return t*(2-t); } void Servo_MoveWithEasing(Servo_MG90S_Advanced *servo, float target_angle, uint32_t duration_ms, EasingFunction easing) { servo->start_angle = servo->base.current_angle; servo->target_angle = target_angle; servo->move_start = HAL_GetTick(); servo->move_duration = duration_ms; servo->easing_func = easing; servo->state = SERVO_EASING; } void Servo_UpdateEasing(Servo_MG90S_Advanced *servo, uint32_t now) { if(servo->state != SERVO_EASING) return; uint32_t elapsed = now - servo->move_start; if(elapsed >= servo->move_duration) { Servo_SetAngle(&servo->base, servo->target_angle); servo->state = SERVO_IDLE; return; } float progress = (float)elapsed / servo->move_duration; float eased_progress = servo->easing_func(progress); float delta_angle = servo->target_angle - servo->start_angle; float new_angle = servo->start_angle + (delta_angle * eased_progress); Servo_SetAngle(&servo->base, new_angle); }

4.2 多舵机同步控制

通过创建舵机组并统一更新，可以实现机械臂等需要协调运动的场景：

#define MAX_SERVOS 4 typedef struct { Servo_MG90S_Advanced servos[MAX_SERVOS]; uint8_t count; } Servo_Group; void ServoGroup_Add(Servo_Group *group, Servo_MG90S_Advanced *servo) { if(group->count >= MAX_SERVOS) return; group->servos[group->count++] = *servo; } void ServoGroup_UpdateAll(Servo_Group *group, uint32_t now) { for(uint8_t i = 0; i < group->count; i++) { if(group->servos[i].state == SERVO_MOVING) { Servo_Update(&group->servos[i], now); } else if(group->servos[i].state == SERVO_EASING) { Servo_UpdateEasing(&group->servos[i], now); } } }

4.3 运动轨迹规划

对于需要精确时间控制的复杂运动，可以预先定义轨迹点：

typedef struct { float angle; uint32_t duration_ms; EasingFunction easing; } TrajectoryPoint; void Servo_ExecuteTrajectory(Servo_MG90S_Advanced *servo, const TrajectoryPoint *points, uint8_t count) { servo->trajectory = points; servo->trajectory_length = count; servo->trajectory_index = 0; servo->state = SERVO_TRAJECTORY; servo->move_start = HAL_GetTick(); Servo_MoveWithEasing(servo, points[0].angle, points[0].duration_ms, points[0].easing); } void Servo_UpdateTrajectory(Servo_MG90S_Advanced *servo, uint32_t now) { if(servo->state != SERVO_TRAJECTORY) return; if(servo->state == SERVO_EASING) { Servo_UpdateEasing(servo, now); if(servo->state == SERVO_IDLE) { servo->trajectory_index++; if(servo->trajectory_index < servo->trajectory_length) { const TrajectoryPoint *point = &servo->trajectory[servo->trajectory_index]; Servo_MoveWithEasing(servo, point->angle, point->duration_ms, point->easing); } else { servo->state = SERVO_IDLE; } } } }

5. 实际应用中的优化技巧

在机器人项目中应用这些技术时，还需要考虑以下实践细节：

机械系统校准表：

电源管理注意事项：

• 使用低ESR电容（100μF以上）靠近舵机供电引脚
• 避免长距离信号线（超过30cm需加缓冲电路）
• 多舵机系统建议采用独立电源供电

抗抖动处理：

#define ANGLE_HYSTERESIS 0.3f void Servo_SetAngleDebounced(Servo_MG90S *servo, float angle) { if(fabsf(servo->current_angle - angle) > ANGLE_HYSTERESIS) { Servo_SetAngle(servo, angle); } }

运动超时保护：

void Servo_UpdateWithTimeout(Servo_MG90S_Advanced *servo, uint32_t now) { if(servo->state == SERVO_MOVING && now - servo->last_update > 500) { // 500ms timeout servo->state = SERVO_IDLE; return; } Servo_Update(servo, now); }