AGV 底盘斜坡上堵转溜车,查了半天发现是抱闸和驱动器的时序反了

2026-11-161

 

引子

给仓库 AGV 做底盘调试,24V 直流电机带电磁抱闸。测试时发现一个诡异现象:小车在平地上停得住,但一旦停在 15° 斜坡上,即使 PID 输出已经拉到最大,车轮还是会慢慢往下溜。起初以为是电机扭矩不够或者 PID 参数太软,折腾了一整天,问题依旧。直到把抱闸的供电时序单独拿出来看,才发现是抱闸和驱动器的动作顺序搞反了。

硬件清单

·         主控:STM32F103C8T6

·         电机驱动器:艾思控 AQMD2408NS-MBE(适配 12V-45W / 24V-130W,倍流 16A/8A,短接制动峰值 50A,能耗制动 3A,带电刹接口、独立编码器接口、通讯隔离)

·         电机:JGB37-555 直流减速电机(24V,带霍尔编码器,带电磁抱闸)

·         电源:24V 5A 开关电源

·         传感器:编码器(电机自带)、MPU6050(测车身倾角)

·         其他:继电器模块(控制抱闸供电)、杜邦线

接线说明

24V 电源正极接驱动器 VCC,负极接驱动器 GND。驱动器 OUTA/OUTB 接电机动力线。抱闸线圈的两根线接继电器常开触点,继电器线圈由 STM32 GPIO 控制,抱闸供电从 24V 电源取。驱动器电刹接口(BRAKE)悬空未用(后面会提到)。编码器 A/B 接驱动器独立编码器接口,驱动器通过 RS485 与 STM32 通讯。STM32 通过 RS485 发送速度指令给驱动器。

现象描述

小车在平地上停止时,抱闸吸合,车轮锁死,纹丝不动。但在斜坡上停车时,抱闸吸合后车轮仍会缓慢下滑,PID 输出已经顶到 100%,电机发出"嗡嗡"声但转不动,车身一点点往下溜。用串口打印电流值,发现堵转电流已经接近驱动器限流值(大约 7A),但车轮还是锁不住。

排查过程

1.       怀疑电机扭矩不足:把小车架起来空载测试,电机能正常输出扭矩,堵转电流也达到了预期值。排除电机本身问题。

2.       怀疑 PID 参数太软:把 P 值加大,I 值加大,堵转时电流确实上去了,但车轮还是溜。说明不是控制算法的问题,而是机械锁止没到位。

3.       怀疑抱闸供电电压不够:用万用表测抱闸线圈两端电压,24V 正常。用手摸抱闸外壳,能感觉到明显的吸合力,抱闸本身没坏。

4.       用串口代替示波器看时序:这是关键一步。我在代码里给抱闸继电器控制和驱动器使能信号各打了一个时间戳,通过串口打印出来。发现抱闸吸合的时刻比驱动器停止输出的时刻晚了大约 200ms。也就是说:驱动器先停了,抱闸还没吸合,这 200ms 里车轮是完全自由的。

根因分析

·         抱闸是失电制动型:电磁抱闸的原理是通电松开、断电抱死。停车时需要先断电让抱闸弹簧压紧刹车片。但抱闸机械动作有延迟,从断电到完全抱死大约需要 100-200ms。

·         时序错误导致"真空期":我的代码逻辑是"先停驱动器,再断抱闸电"。驱动器停止输出后,抱闸还需要 200ms 才能完全抱死。在这段真空期里,车轮没有任何约束,斜坡上的重力分量直接让车轮下滑。

·         PID 救不回来:等抱闸完全抱死后,车轮已经溜了一段距离。此时 PID 再加大输出,电机试图反转把车拉回来,但抱闸已经锁死,电机堵转也拉不动,只能"嗡嗡"空耗电流。

解决过程

5.       调整抱闸时序:把代码逻辑改成"先断抱闸电,延时 300ms,再停驱动器"。这样抱闸有足够时间完全抱死后,驱动器才退出。AQMD2408NS-MBE 自带电刹接口,可以直接用驱动器的 BRAKE 信号控制抱闸,驱动器内部已经做好了时序管理,无需 MCU 额外延时。

6.       利用驱动器的短接制动功能:AQMD2408NS-MBE 支持短接制动峰值 50A,在抱闸完全抱死前,驱动器可以主动短接电机绕组产生反向电磁制动,填补抱闸动作的真空期。我在 RS485 指令里加入了短接制动使能,抱闸断电的同时驱动器立即短接电机。

7.       加入斜坡补偿:通过 MPU6050 检测车身倾角,当倾角大于 5° 时,停车前提前 500ms 开始减速,让车在抱闸动作前速度已经接近零,减小溜车惯性。

验证结果

重新测试斜坡停车。串口打印显示:抱闸断电后 50ms 内驱动器短接制动生效,车轮迅速减速;200ms 后抱闸完全抱死,车轮完全锁死。在 15° 斜坡上反复测试 20 次,溜车距离从原来的 3-5cm 缩减到 2mm 以内(机械间隙),肉眼几乎不可见。堵转电流从 7A 降到了 0.5A(仅需维持抱闸吸合),电机不再"嗡嗡"发热。

踩坑小结

·         抱闸时序是生命线:失电制动型抱闸必须"先断电抱闸,后停驱动",或者用驱动器自带的电刹接口让硬件自动管理时序。

·         串口可以当简易示波器:没有示波器时,用串口打印时间戳,能清晰看到各信号的先后顺序,排查时序问题非常有效。

·         短接制动填补真空期:驱动器带短接制动功能的,一定要用起来,抱闸动作的几百毫秒真空期靠它撑住。

·         斜坡测试不能省:平地测试完美的系统,上斜坡可能原形毕露。AGV 调试一定要做斜坡工况验证。

结尾

你做带抱闸的电机控制时,有没有遇到过类似的时序坑?最后是怎么解决的?评论区交流一下。

创作许可协议

本项目采用 CC BY(署名) 进行许可。

评论(0)
- 没有更多了 -