电机控制进阶2——PID位置控制实战：从单环到串级的设计与调参

1. 从单环到串级为什么需要位置-速度双环控制第一次尝试用PID控制电机位置时我天真地以为单环就能搞定所有问题——就像用一把螺丝刀想拆装整个机器人。结果在机械臂抓取测试中负载突变导致末端执行器晃动得像喝醉的章鱼。这就是单环位置PID的致命伤它只关心终点在哪却不管路上怎么走。单环结构的软肋在数学上非常直观。假设电机转动惯量为J阻尼系数为B单环位置控制的传递函数可以表示为G(s) (Kp Ki/s Kd*s) / (J*s² B*s)当负载突变相当于在方程右侧突然加上干扰项D系统会出现明显的相位滞后。我在数控平台上实测发现20%负载突变会导致单环系统产生15°的位置滞后。而串级控制就像给汽车装上导航仪老司机。内环速度环相当于经验丰富的司机专注于实时调整车速外环位置环如同导航系统只负责告诉司机下一个路口在哪。二者分工明确速度环处理电机惯性和负载扰动反应时间1ms位置环确保最终定位精度调节周期5-10ms实验室数据对比很能说明问题。在相同STM32F407平台测试指标单环位置PID位置-速度串级PID调节时间(ms)320180超调量(%)12.53.2抗扰动能力(N)0.52.82. 串级PID的硬件实战配置2.1 编码器配置的魔鬼细节很多人在配置STM32编码器接口时容易忽略两个关键点计数方向与电机转向的对应关系我的血泪教训曾经因为AB相接反导致电机越调越跑偏。正确的验证方法是// 测试代码片段 HAL_TIM_Encoder_Start(htim4, TIM_CHANNEL_ALL); while(1) { printf(CNT:%d\n, __HAL_TIM_GET_COUNTER(htim4)); HAL_Delay(100); }手动旋转电机轴正转时计数值应递增。溢出处理的黑科技当编码器4倍频后1000线的电机实际每转产生4000个脉冲。如果定时器是16位如TIM4每转16.384圈就会溢出一次。我的解决方案// 在溢出中断中记录溢出方向 void HAL_TIM_PeriodElapsedCallback(TIM_HandleTypeDef *htim) { if(htim-Instance TIM4) { g_overflow_cnt (TIM4-CR1 TIM_COUNTERMODE_UP) ? 1 : -1; } }2.2 定时器配置的黄金法则PID计算周期不是越短越好通过大量实验我总结出不同场景的最佳周期速度环0.5-2ms对应PWM频率10-20kHz位置环5-10ms配置CubeMX时有个隐藏技巧使用TIM7作为PID计算定时器TIM1/TIM8输出PWM。因为高级定时器的时钟树更稳定实测PWM抖动比通用定时器小30%。3. 从零开始整定串级PID参数3.1 内环速度PID整定记住这个口诀先Kp后KiKd最后加。具体操作将Ki、Kd设为0Kp从0开始增加直到电机出现等幅振荡记录此时的临界增益Ku和振荡周期Tu按照Ziegler-Nichols法则设置Kp 0.6 * Ku; Ki 2 * Kp / Tu; Kd Kp * Tu / 8;我在450W伺服电机上实测的调节过程迭代次数 Kp Ki 响应波形 1 5.0 0 衰减振荡 2 7.2 0.15 轻微超调 3 8.1 0.18 最优响应3.2 外环位置PID整定位置环要遵循慢工出细活原则保持速度环参数不变位置环Kp从速度环Kp的1/10开始重点调节Kd抑制超调一个实用的调试技巧用上位机观察阶跃响应时可以故意用手给电机施加扰动好的参数应该能在0.5秒内恢复稳定。4. 高级技巧与避坑指南4.1 抗积分饱和的工程实现串级PID最怕积分饱和。我的解决方案是在中断中加入// 在PID计算函数中 if(fabs(error) threshold) { integral 0; // 误差过大时清零积分 } else { integral error; integral constrain(integral, -max_integral, max_integral); }4.2 动态参数调整对于变负载场合可以实时检测电流变化并调整参数// 根据负载电流调整Kp float current read_motor_current(); float Kp_adaptive base_Kp * (1 0.2*(current - nominal_current));去年给某半导体设备厂商调试时他们的机械手要在50ms内完成300mm行程的精确定位。最终我们采用串级PID前馈控制实现了±0.01mm的重复定位精度。关键是在加速段增加速度前馈position_out pid_position() 0.3*target_velocity;5. 典型问题解决方案问题1电机在目标位置持续抖动检查步骤降低位置环Kd检查机械传动间隙增加速度环的滤波问题2响应速度慢优化方案提高速度环带宽加入加速度前馈检查电源电压是否充足记得第一次调试SCARA机器人时末端总是过冲。后来发现是谐波减速器的回差导致最终通过在位置环加入死区补偿解决了问题if(fabs(error) 0.02) { output 0; // 死区补偿 }