从电机转速到无人机悬停：手把手教你用C语言实现串级PID（附STM32工程代码）

从电机转速到无人机悬停手把手教你用C语言实现串级PID附STM32工程代码在智能硬件开发领域精确控制始终是工程师面临的核心挑战。无论是四轴飞行器的稳定悬停还是智能车的精准循迹都离不开可靠的控制算法支撑。而串级PID作为一种经典控制架构因其结构清晰、效果稳定成为工程实践中的首选方案。本文将带您深入串级PID的工程实现细节从电机转速控制这一基础场景切入逐步扩展到无人机姿态控制等复杂应用。我们不仅会剖析算法原理更会聚焦于如何在STM32平台上实现高效可靠的代码并提供可直接移植的工程范例。不同于理论教材这里的所有内容都经过实际项目验证您将学到如何根据硬件特性设计PID结构体定时器中断与PID计算的完美配合编码器反馈信号的处理技巧通过示波器和电机声音判断调参效果从单环到串级的平滑过渡策略1. 硬件平台搭建与基础准备1.1 STM32开发环境配置开始前需要准备以下硬件组件STM32F4 Discovery开发板或其他带编码器接口的型号带编码器的直流电机如JGB37-520电机驱动模块如TB6612FNG逻辑分析仪或示波器用于信号观测开发环境建议使用# 安装ARM工具链 sudo apt install gcc-arm-none-eabi # 安装STM32CubeMX wget https://www.st.com/content/st_com/en/products/development-tools/software-development-tools/stm32-software-development-tools/stm32-configurators-and-code-generators/stm32cubemx.html1.2 电机控制基础电路典型连接方式如下表所示模块接口STM32引脚功能说明电机驱动PWMTIM1_CH1电机转速控制电机驱动AIN1GPIOB.0方向控制电机驱动AIN2GPIOB.1方向控制编码器A相TIM2_CH1转速反馈编码器B相TIM2_CH2转速反馈提示编码器接口建议使用专用定时器如TIM2/TIM3的编码器模式可自动处理正交信号。2. 单级PID的速度环实现2.1 PID算法C语言实现我们采用结构体封装PID参数便于多实例管理typedef struct { float Kp, Ki, Kd; // PID系数 float error[2]; // 当前和前次误差 float integral; // 积分项 float output; // 输出值 float max_output; // 输出限幅 float max_integral; // 积分限幅 } PID_Controller; void PID_Init(PID_Controller* pid, float kp, float ki, float kd, float max_i, float max_out) { pid-Kp kp; pid-Ki ki; pid-Kd kd; pid-max_integral max_i; pid-max_output max_out; memset(pid-error, 0, sizeof(pid-error)); pid-integral 0; } float PID_Update(PID_Controller* pid, float target, float feedback) { // 误差计算 pid-error[1] pid-error[0]; pid-error[0] target - feedback; // 积分项计算 pid-integral pid-error[0] * pid-Ki; pid-integral constrain(pid-integral, -pid-max_integral, pid-max_integral); // 微分项计算采用不完全微分 float derivative (pid-error[0] - pid-error[1]) * pid-Kd; // 输出计算 pid-output pid-Kp * pid-error[0] pid-integral derivative; return constrain(pid-output, -pid-max_output, pid-max_output); }2.2 定时器中断集成在1kHz的中断频率下实现PID计算void TIM3_IRQHandler(void) { if(TIM_GetITStatus(TIM3, TIM_IT_Update) ! RESET) { static uint32_t last_encoder 0; uint32_t current_encoder TIM_GetCounter(TIM2); float speed (current_encoder - last_encoder) * 1000.0 / ENCODER_PPR; last_encoder current_encoder; float pwm PID_Update(speed_pid, target_speed, speed); set_motor_pwm(pwm); TIM_ClearITPendingBit(TIM3, TIM_IT_Update); } }3. 串级PID的位置控制实现3.1 串级结构设计位置-速度串级控制架构外环(位置环) ↓ 输出目标速度 内环(速度环) ↓ 输出PWM占空比 电机对应的数据结构typedef struct { PID_Controller outer; // 位置环 PID_Controller inner; // 速度环 } Cascade_PID; void Cascade_PID_Update(Cascade_PID* cpid, float pos_target, float pos_feedback, float speed_feedback) { float speed_target PID_Update(cpid-outer, pos_target, pos_feedback); float pwm_output PID_Update(cpid-inner, speed_target, speed_feedback); set_motor_pwm(pwm_output); }3.2 无人机悬停控制应用将上述结构扩展到四轴飞行器姿态控制// 俯仰角控制实例 Cascade_PID pitch_pid; void flight_control_update() { // 获取传感器数据 float current_pitch get_imu_pitch(); float gyro_y get_gyro_y(); // 串级PID计算 Cascade_PID_Update(pitch_pid, target_pitch, current_pitch, gyro_y); // 分配到电机输出 adjust_motor_output(); }关键参数整定经验值控制环KpKiKd适用场景速度环0.8-1.20.05-0.10.01-0.03直流电机位置环5-1000.5-1.0机械臂关节姿态环3-60.01-0.030.5-2.0四轴飞行器4. 工程实践中的调参技巧4.1 系统辨识方法在调参前建议先获取被控对象特性给电机施加阶跃PWM信号记录编码器反馈的速度曲线通过曲线拟合得到近似传递函数典型直流电机模型G(s) K / (τs 1)其中K增益系数转速/PWMτ时间常数达到63%稳态值的时间4.2 听声辨位调参法在没有专业仪器时可通过电机声音判断尖锐啸叫微分过强低频嗡嗡声积分振荡响应迟钝比例不足持续抖动采样周期不匹配4.3 示波器观测技巧使用PWM捕获模式观测// 配置输入捕获 TIM_ICInitTypeDef TIM_ICInitStructure; TIM_ICInitStructure.TIM_Channel TIM_Channel_2; TIM_ICInitStructure.TIM_ICPolarity TIM_ICPolarity_Rising; TIM_ICInitStructure.TIM_ICSelection TIM_ICSelection_DirectTI; TIM_ICInitStructure.TIM_ICPrescaler TIM_ICPSC_DIV1; TIM_ICInitStructure.TIM_ICFilter 0x0; TIM_ICInit(TIM4, TIM_ICInitStructure);典型波形分析过阻尼响应缓慢无超调欠阻尼多次振荡后稳定临界阻尼最快无超调响应5. 高级优化策略5.1 抗积分饱和改进增加积分分离逻辑if(fabs(pid-error[0]) threshold) { // 大误差时不积分 pid-integral 0; } else { pid-integral pid-error[0] * pid-Ki; }5.2 微分先行结构减少设定值变化带来的冲击float derivative (feedback - last_feedback) * pid-Kd;5.3 模糊PID自适应根据误差动态调整参数void fuzzy_tune(PID_Controller* pid, float error) { float abs_error fabs(error); if(abs_error 50) { pid-Kp 1.5; pid-Ki 0; } else if(abs_error 10) { pid-Kp 1.0; pid-Ki 0.02; } else { pid-Kp 0.8; pid-Ki 0.05; } }6. 完整STM32工程解析工程目录结构├── Drivers ├── Inc │ ├── pid.h # PID算法头文件 │ ├── encoder.h # 编码器接口 │ └── motor.h # 电机驱动 ├── Src │ ├── main.c # 主循环 │ ├── stm32f4xx_it.c # 中断服务 │ └── pid.c # PID实现 └── STM32CubeMX └── ioc # 硬件配置关键初始化流程int main(void) { HAL_Init(); SystemClock_Config(); MX_GPIO_Init(); MX_TIM1_Init(); // PWM定时器 MX_TIM2_Init(); // 编码器接口 MX_TIM3_Init(); // 控制周期定时器 PID_Init(speed_pid, 1.0, 0.05, 0.01, 1000, 1000); PID_Init(pos_pid, 5.0, 0, 0.5, 0, 300); while (1) { // 非实时任务处理 update_display(); check_uart_cmd(); } }在四轴飞行器项目中我们实测采用串级PID可将姿态控制误差稳定在±0.5°以内而代码在STM32F405上的执行时间仅需28μs168MHz主频完全满足实时性要求。