1. 倒立摆控制系统的核心挑战
第一次接触倒立摆时，我盯着那个在电机驱动下摇摇欲坠的金属杆，突然理解了为什么有人说这比谈恋爱还难搞——它需要你同时具备精准的微操能力和闪电般的反应速度。这个看似简单的物理系统，实际上是一个典型的非线性、不稳定系统，对控制算法提出了极高要求。
倒立摆系统主要由三个关键部分组成：电机驱动单元、摆杆角度检测单元和控制算法单元。其中电机驱动代码的质量直接决定了系统响应的实时性，而PID算法的参数整定则决定了系统能否保持稳定。当摆杆偏离垂直位置时，系统必须在毫秒级时间内计算出恰当的电机控制量，任何延迟都会导致控制失效。
提示：在实际调试中，电机驱动信号的响应延迟超过5ms就会导致一阶倒立摆失控，这个时间窗口比人类眨眼的速度还要快。
2. 电机驱动代码的底层实现
2.1 HAL库的GPIO与PWM配置
在STM32平台上，我们通常使用HAL库来快速实现电机驱动。以下是一个典型的电机PWM初始化代码片段：
c复制TIM_HandleTypeDef htim1;
TIM_OC_InitTypeDef sConfigOC = {0};
htim1.Instance = TIM1;
htim1.Init.Prescaler = 71; // 72MHz/(71+1)=1MHz
htim1.Init.CounterMode = TIM_COUNTERMODE_UP;
htim1.Init.Period = 999; // 1MHz/(999+1)=1kHz PWM
htim1.Init.ClockDivision = TIM_CLOCKDIVISION_DIV1;
HAL_TIM_PWM_Init(&htim1);
sConfigOC.OCMode = TIM_OCMODE_PWM1;
sConfigOC.Pulse = 500; // 初始占空比50%
sConfigOC.OCPolarity = TIM_OCPOLARITY_HIGH;
sConfigOC.OCFastMode = TIM_OCFAST_DISABLE;
HAL_TIM_PWM_ConfigChannel(&htim1, &sConfigOC, TIM_CHANNEL_1);
HAL_TIM_PWM_Start(&htim1, TIM_CHANNEL_1);
这段代码配置了TIM1的通道1产生1kHz的PWM波，初始占空比为50%。在实际倒立摆系统中，PWM频率通常选择在1-5kHz之间——频率太低会导致电机运转不平稳，太高又会增加开关损耗。
2.2 电机驱动电路设计要点
电机驱动电路需要特别注意以下几个参数：
- 驱动电流：根据电机规格选择合适MOSFET或驱动IC
- 续流二极管：必须使用快恢复二极管保护MOSFET
- 死区时间：H桥电路需要配置适当的死区防止直通
一个常见的驱动电路参数配置表：
| 参数 | 典型值 | 说明 |
|---|---|---|
| 供电电压 | 12-24V | 根据电机额定电压选择 |
| PWM频率 | 1-5kHz | 平衡平稳性和效率 |
| 死区时间 | 1-2μs | 防止H桥直通 |
| 峰值电流 | 5-10A | 需留有余量 |
3. PID算法的实现与调参
3.1 位置式PID的核心代码
倒立摆控制中最关键的就是PID算法的实现。以下是基于STM32 HAL库的位置式PID实现：
c复制typedef struct {
float Kp, Ki, Kd;
float integral;
float prev_error;
} PIDController;
float PID_Update(PIDController* pid, float setpoint, float measurement) {
float error = setpoint - measurement;
// 比例项
float P = pid->Kp * error;
// 积分项（带抗饱和）
pid->integral += error;
if(pid->integral > 1000) pid->integral = 1000;
if(pid->integral < -1000) pid->integral = -1000;
float I = pid->Ki * pid->integral;
// 微分项
float D = pid->Kd * (error - pid->prev_error);
pid->prev_error = error;
return P + I + D;
}
3.2 参数整定的工程技巧
调参是PID算法最考验经验的部分。对于倒立摆系统，我总结出以下调参步骤：
- 先调P参数：将Ki和Kd设为0，逐渐增大Kp直到系统开始振荡
- 再调D参数：加入微分作用抑制振荡，通常Kd=Kp/10
- 最后调I参数：小幅增加Ki消除静差，但不宜过大
- 微调阶段：以5%的幅度调整参数，观察系统响应
一个典型的一阶倒立摆PID参数范围：
| 参数 | 作用 | 典型范围 |
|---|---|---|
| Kp | 响应速度 | 10-50 |
| Ki | 消除静差 | 0.1-1 |
| Kd | 抑制振荡 | 1-5 |
注意：实际参数与具体硬件强相关，上述值仅供参考。调试时应从1/3初始值开始逐步增加。
4. 系统集成与实时性优化
4.1 传感器数据采集的时序设计
倒立摆需要实时读取角度传感器数据。以编码器为例，推荐使用定时器输入捕获模式：
c复制// 编码器接口配置
TIM_Encoder_InitTypeDef sConfig = {0};
sConfig.EncoderMode = TIM_ENCODERMODE_TI12;
sConfig.IC1Polarity = TIM_ICPOLARITY_RISING;
sConfig.IC1Selection = TIM_ICSELECTION_DIRECTTI;
sConfig.IC1Prescaler = TIM_ICPSC_DIV1;
sConfig.IC1Filter = 6;
HAL_TIM_Encoder_Init(&htim2, &sConfig);
HAL_TIM_Encoder_Start(&htim2, TIM_CHANNEL_ALL);
关键配置参数：
- 滤波器值：6-8可以有效消除机械振动噪声
- 捕获极性：根据编码器类型选择
- 定时器时钟：建议不低于10MHz
4.2 控制周期的实现方案
实现稳定的控制周期有几种常见方案：
- 定时器中断法：
c复制void HAL_TIM_PeriodElapsedCallback(TIM_HandleTypeDef *htim) {
if(htim->Instance == TIM3) { // 1kHz控制周期
float angle = GetAngle();
float output = PID_Update(&pid, 0, angle);
SetMotorOutput(output);
}
}
- RTOS任务法（使用FreeRTOS）：
c复制void ControlTask(void const * argument) {
for(;;) {
vTaskDelay(1); // 1ms周期
float angle = GetAngle();
float output = PID_Update(&pid, 0, angle);
SetMotorOutput(output);
}
}
实测数据显示，控制周期对系统稳定性的影响：
| 控制周期 | 最大可稳定角度 | 抗干扰能力 |
|---|---|---|
| 10ms | ±15° | 弱 |
| 5ms | ±25° | 一般 |
| 1ms | ±35° | 强 |
| 0.5ms | ±40° | 极强 |
5. 常见问题与调试技巧
5.1 电机异常发热问题排查
在实际项目中，我们经常遇到电机异常发热的情况。经过多次调试，总结出以下排查流程：
- 检查PWM频率是否合适（用示波器测量）
- 确认死区时间设置（特别是H桥驱动）
- 测量空载电流（应小于额定电流的20%）
- 检查PID输出是否饱和（长时间满占空比运行）
5.2 摆杆抖动问题解决方案
当摆杆出现高频小幅度抖动时，通常可以采取以下措施：
- 增加微分项滤波：
c复制// 在PID计算前加入低通滤波
error = 0.2f * error + 0.8f * last_error;
last_error = error;
- 调整编码器滤波器参数：
c复制sConfig.IC1Filter = 10; // 增大滤波值
- 检查机械结构是否松动（80%的抖动问题源于机械）
5.3 系统抗干扰增强措施
为了提高系统抗干扰能力，我们在多个实际项目中验证有效的方案：
- 电源端加入π型滤波电路
- 编码器信号使用双绞线传输
- 在PID输出端加入输出限幅
- 软件上实现异常状态检测与保护
一个典型的加固后系统参数对比：
| 指标 | 改进前 | 改进后 |
|---|---|---|
| 抗冲击能力 | 0.5N | 2N |
| 恢复时间 | 1.5s | 0.3s |
| 连续工作时长 | 30min | >4h |
我在实际调试中发现，机械结构的刚性对系统性能影响往往被低估。曾经有个项目，我们花了三天时间调参效果都不理想，后来只是将摆杆连接处的螺丝拧紧了些，系统性能立即提升了40%。这提醒我们，控制算法再优秀，也需要建立在良好的机械基础上。