好的，以下是基于STM32的舵机控制程序示例及说明：

舵机控制原理

舵机通过PWM信号控制角度，通常要求：

• 周期：20ms（即频率50Hz）
• 脉冲宽度：0.5ms~2.5ms，对应角度0°~180°

开发环境

• 芯片型号：STM32F1xx系列（其他型号类似）
• 开发库：HAL库（标准库配置思路相同）
• 硬件接口：舵机信号线接STM32的PWM输出引脚（如PA6对应TIM3_CH1）

代码实现步骤

1. 配置PWM输出的定时器

以 TIM3 通道1（PA6）为例：

// 定时器初始化函数
void PWM_Init(void) {
    TIM_HandleTypeDef htim3;
    TIM_OC_InitTypeDef sConfigOC = {0};

    // 使能TIM3和GPIOA时钟
    __HAL_RCC_TIM3_CLK_ENABLE();
    __HAL_RCC_GPIOA_CLK_ENABLE();

    // 配置PA6为复用推挽输出（PWM）
    GPIO_InitTypeDef GPIO_InitStruct = {0};
    GPIO_InitStruct.Pin = GPIO_PIN_6;
    GPIO_InitStruct.Mode = GPIO_MODE_AF_PP;
    GPIO_InitStruct.Speed = GPIO_SPEED_FREQ_HIGH;
    HAL_GPIO_Init(GPIOA, &GPIO_InitStruct);

    // 配置TIM3
    htim3.Instance = TIM3;
    htim3.Init.Prescaler = 72 - 1;          // 预分频72，72MHz/72=1MHz
    htim3.Init.CounterMode = TIM_COUNTERMODE_UP;
    htim3.Init.Period = 20000 - 1;          // 20ms周期（1MHz计数，20000=20ms）
    htim3.Init.ClockDivision = TIM_CLOCKDIVISION_DIV1;
    HAL_TIM_PWM_Init(&htim3);

    // 配置PWM通道
    sConfigOC.OCMode = TIM_OCMODE_PWM1;
    sConfigOC.Pulse = 1500;                 // 初始脉宽1.5ms（中位90°）
    sConfigOC.OCPolarity = TIM_OCPOLARITY_HIGH;
    sConfigOC.OCFastMode = TIM_OCFAST_DISABLE;
    HAL_TIM_PWM_ConfigChannel(&htim3, &sConfigOC, TIM_CHANNEL_1);

    // 启动PWM输出
    HAL_TIM_PWM_Start(&htim3, TIM_CHANNEL_1);
}

2. 控制舵机角度函数

// 设置舵机角度（angle范围0~180）
void Servo_SetAngle(uint16_t angle) {
    // 将角度转换为脉冲宽度（0.5ms=500, 2.5ms=2500）
    uint16_t pulse = 500 + angle * (2000 / 180);

    // 更新TIM3的CCR1寄存器
    __HAL_TIM_SET_COMPARE(&htim3, TIM_CHANNEL_1, pulse);
}

3. 主函数调用

int main(void) {
    HAL_Init();
    PWM_Init();

    while(1) {
        Servo_SetAngle(0);    // 转到0°
        HAL_Delay(1000);
        Servo_SetAngle(90);   // 转到90°
        HAL_Delay(1000);
        Servo_SetAngle(180);  // 转到180°
        HAL_Delay(1000);
    }
}

关键参数说明

1. Prescaler（预分频）：
   72MHz时钟 / (Prescaler + 1) = 1MHz → 每个计数周期=1µs

2. Period（自动重装载值）：
   20000个周期 × 1µs = 20ms → 满足舵机周期要求

3. Pulse（比较寄存器值）：

   • 500 → 0.5ms（0°）
   • 1500 → 1.5ms（90°）
   • 2500 → 2.5ms（180°）

常见问题排查

1. 舵机不转动：

   • 检查电源是否独立供电（舵机电流较大）
   • 用示波器检测PWM波形是否正确
   • 确认GPIO配置为复用推挽输出（AF_PP）

2. 角度偏差：

   • 调整脉冲宽度范围（不同舵机可能有微小差异）

3. 抖动问题：

   • 增加电源电容（1000μF以上）
   • 确保地线连接可靠

根据实际需求修改定时器、引脚和参数即可。如果需要多路舵机控制，可配置多个定时器通道或使用PWM生成芯片（如PCA9685）。