1. 项目背景与核心思路
做平衡车这事儿,我折腾过不少方案,从最早的有刷电机加PID控制,到后来的无刷电机简单驱动,最后发现FOC(磁场定向控制)算法才是真正能让无刷平衡车「稳如老狗」的关键。这次用的主控是STM32F103,别看它价格亲民,性能对付这种实时控制需求绰绰有余。
整个系统的核心思路很简单:通过陀螺仪实时检测车身姿态,用FOC算法精确控制无刷电机的扭矩和转速,再通过舵机控制板处理用户输入指令,最终实现自平衡、速度控制和方向控制的闭环系统。我自己实测下来,这套方案响应速度快、运行平稳,而且功耗控制得相当不错。
这里特别提一下FOC的优势——它不像传统方波控制那样「粗犷」,而是通过精确的磁场控制让电机转动更加平滑。这就好比骑自行车:方波控制像是一直猛踩刹车又猛加速,而FOC就像是专业骑手保持均匀发力,自然更稳更省电。
2. 硬件设计与关键选型
2.1 主控芯片:为什么选STM32F103
STM32F103这款芯片我用了快十年了,选择它主要原因有三个:首先是性价比极高,一片C8T6才十来块钱,但功能足够强大;其次是开发资源丰富,各种库函数和例程一应俱全,新手也能快速上手;最重要的是它的性能足够——72MHz的主频、硬件乘除法器、多路PWM输出和ADC,完全能满足FOC算法的实时计算需求。
实际使用时记得注意:一定要启用FPU(浮点运算单元)支持,虽然F103没有硬件FPU,但用好编译器优化和定点数运算,计算效率依然很高。我通常会把FOC的核心算法放在定时器中断里执行,确保控制周期稳定在50-100μs之间。
2.2 姿态传感器:陀螺仪的选择与使用
MPU6050是最常见的选择,便宜又大碗,但实际使用中有几个坑要注意。首先是安装位置,一定要尽量靠近车的重心,避免振动干扰。其次是数据滤波,我通常会用互补滤波结合卡尔曼滤波,这样既能快速响应又能抑制噪声。
最头疼的是温度漂移问题。有一次我的车在实验室跑得好好的,拿到室外就开始抖。后来发现是温差导致陀螺仪零点漂移。解决办法是在代码里加入温度补偿,或者干脆选用更高端的传感器如ICM20602。如果要求更高,甚至可以学四轴飞行器那样给传感器做个「小恒温仓」,不过对平衡车来说有点杀鸡用牛刀了。
2.3 电机与驱动方案
无刷电机我推荐用2804或2810这类盘式电机,扭矩大、响应快。关键是要带磁编码器(如AS5600),这是实现精准FOC控制的前提。编码器安装要注意与电机轴同心,哪怕一点点偏心都会导致控制抖动。
驱动板要用三相全桥驱动,DRV8302是个不错的选择,集成度高、保护功能完善。布线时要注意功率线路和信号线路分开走,避免干扰。我在第一次打样时就因为这个问题,电机一转单片机就复位,后来加了光耦隔离才解决。
2.4 电源管理设计
平衡车是移动设备,电源管理特别重要。我的方案是使用2-3节18650锂电池供电,配上TP4056充电芯片和AXP192电源管理芯片。关键是要在电机驱动电源和单片机电源之间加LC滤波,否则电机启动时的电压波动会让你怀疑人生。
实测中我发现,无刷电机在启动瞬间电流能到5A以上,所以电源线要足够粗,至少18AWG以上。曾经因为用了太细的导线,导致电机转速一直上不去,还以为是程序问题,折腾了半天才发现是供电不足。
3. FOC算法实现详解
3.1 FOC基础原理
FOC的核心思想其实不难理解:就像骑自行车时,我们不会直接控制腿的肌肉,而是通过大脑控制平衡和踩踏节奏。FOC也是先把电机的三相电流「翻译」成两个垂直的矢量(d轴和q轴),然后直接控制这两个矢量来实现精准的扭矩控制。
具体来说分三步:首先通过Clarke变换把三相电流转换成两相直角坐标系,然后通过Park变换把旋转的坐标系「固定」下来,最后用PID控制器精确控制q轴电流(扭矩)和d轴电流(磁场)。这套方法最大的好处是让无刷电机的控制变得像直流有刷电机一样简单直观。
3.2 电流采样与处理
电流采样是FOC的关键,精度直接决定控制效果。我推荐用采样电阻+运放的方案,成本低、精度足够。要注意采样时机——必须在PWM输出的「中间点」采样,避开开关噪声。
我在代码里通常会做多次采样取平均,还会加上低通滤波。曾经因为滤波参数设得太激进,导致系统响应迟缓,车一歪就倒;参数设得太小又容易振荡。最后找到的黄金比例是:采样频率20kHz,滤波器截止频率2kHz。
3.3 空间矢量调制(SVPWM)
SVPWM是FOC的执行环节,负责把计算出的电压矢量转换成实际的PWM信号。STM32F103的定时器完全能胜任这个任务,要配置成中心对齐模式,死区时间一般设500ns左右。
调试时可以用示波器看三相波形,应该是完美的正弦波。如果看到波形畸变,通常是死区时间设置不当。我有个血泪教训:死区时间太短会导致桥臂直通烧MOS管,太长又会使波形失真。最后用热像仪调试才发现问题所在。
4. 软件架构与控制逻辑
4.1 主循环与中断设计
软件架构要遵循「前台中断+后台循环」的原则。我把FOC算法放在定时器中断中执行,确保控制周期精确。而状态监测、用户交互这些不那么紧急的任务放在主循环里。
中断服务程序要尽可能短小精悍。最初我把太多计算放在中断里,结果系统经常卡死。后来只在中段里做必要的采样和计算,把非实时任务移到主循环,系统就稳定多了。
4.2 姿态解算算法
姿态解算我用的是Mahony互补滤波,计算量小、效果足够好。关键是要找到合适的滤波参数:比例参数(Kp)决定响应速度,积分参数(Ki)决定稳态精度。
调试时可以先让车静止,调整参数直到姿态角输出稳定;然后再用手推车测试动态响应。记得要先调内环(电流环)再调外环(姿态环),否则怎么调都调不好。
4.3 速度与方向控制
速度控制我用了双环结构:外环是速度PID,内环是电流FOC。这样分层设计的好处是响应快、超调小。方向控制则是通过差速实现:让两个轮子有微小的转速差,车就会转向。
这里有个技巧:转向时要给内轮适当的制动扭矩,这样转向更灵活。就像汽车过弯时内侧车轮会转得慢一些一样。实测下来,这种差速转向比单纯用舵机机械转向灵活得多。
5. 系统调试与优化
5.1 硬件调试要点
上电前一定要先检查电源短路!我用限流电源慢慢调高电压,观察电流变化。电机驱动板要先单独测试,确保六路PWM输出正常后再接电机。
调试时最实用的工具是示波器和逻辑分析仪。用示波器看电流波形和PWM波形,用逻辑分析仪抓取编码器数据。串口打印虽然方便,但会影响实时性,建议只在调试初期使用。
5.2 PID参数整定
PID调参是个耐心活。我的经验是:先P后I再D,从小到大慢慢试。先让P值从小到大增加,直到系统开始振荡,然后取这个值的60%-70%作为最终值。I值要慢慢加直到静态误差消除,D值用来抑制超调。
有个小技巧:在代码里做个参数调节接口,通过串口实时修改PID参数。这样就不用每次修改都重新烧录程序了。我通常会把参数保存在Flash里,下次上电自动加载。
5.3 抗干扰处理
平衡车在实际环境中会遇到各种干扰:地面不平、电池电压波动、电机发热……我的应对策略是:软件上加低通滤波和异常值检测,硬件上加去耦电容和屏蔽罩。
最难忘的是有一次车在木地板上跑得很稳,一到瓷砖地就抖。后来发现是轮胎抓地力不同导致模型参数变化,于是在代码里加了自适应调节功能,问题就解决了。
6. 实测效果与性能分析
经过优化后的系统,平衡角度误差能控制在0.5度以内,响应时间小于100ms。续航方面,用2000mAh电池可以连续运行1小时以上。最让我满意的是它的负载能力——坐上500g的重物依然能保持平衡。
速度控制也很精准,匀速行驶时误差小于0.1m/s。转向响应灵敏,最小转弯半径只有20cm。这些性能指标完全达到实用水平,拿来代步或者作为机器人平台都很合适。
7. 常见问题与解决方案
问题1:电机抖动厉害 检查编码器安装是否同心,电流采样是否准确,PID参数是否过于激进。有时候只是机械结构松动导致的。
问题2:启动时往一边倒 通常是传感器没校准,或者电机相序接反了。可以先用手扶着启动,观察控制输出是否正确。
问题3:运行一段时间后失控 大概率是温度漂移或者电源电压下降。加上温度补偿和电压补偿就能解决。
问题4:响应迟钝 检查控制周期是否太长,或者滤波参数设得太大。有时候只是电池电量不足导致的。
做完这个项目最大的体会是:硬件是基础,软件是灵魂,调试是关键。很多时候理论计算很完美,实际效果却不如预期,这时候就需要耐心调试和优化。现在回头看看,踩过的坑都是宝贵的经验。如果你也在做类似项目,我的建议是:先从简单的有刷电机开始,等摸清了平衡控制的套路再上无刷FOC,这样会顺利很多。
270



被折叠的 条评论
为什么被折叠?



