立创开源：基于STM32F103的FOC驱动器设计（芙宁娜·彩印版）——硬件电路与软件实现详解

立创开源基于STM32F103的FOC驱动器设计芙宁娜·彩印版——硬件电路与软件实现详解最近在做一个云台项目需要驱动一个小功率的无刷电机并且要实现精准的位置和速度控制。找了一圈发现市面上的驱动器要么太贵要么功能不满足。于是我决定自己动手设计一个开源的FOC驱动器。这个项目我把它叫做“芙宁娜·彩印版”核心是STM32F103C8T6单片机目标是实现一个功能完整、成本可控、适合学习和二次开发的驱动器。如果你也对电机控制感兴趣或者正在寻找一个可以驱动云台电机、航模电机的方案那么这篇教程就是为你准备的。我会手把手带你从硬件电路设计到软件框架搭建把整个项目的核心要点和踩过的坑都讲清楚。咱们不玩虚的直接上干货。1. 项目整体规划我们要做一个什么样的驱动器在动手画原理图之前咱们得先想清楚这个驱动器要干什么。简单来说它就是一个“大脑”“肌肉”的组合。大脑STM32F103C8T6单片机。它负责运行FOC算法处理编码器信号接收上位机指令实现位置、速度、力矩三个闭环控制。肌肉DRV8313电机驱动芯片。它接收“大脑”发来的PWM信号输出大电流去驱动电机的三相线圈。感官电流采样电路INA199和磁编码器。它们负责“感受”电机当前的电流大小和转子位置反馈给“大脑”进行精确控制。嘴巴和耳朵UART、CAN通信接口。用来和外部设备比如遥控器、主控板对话接收控制指令上报状态信息。能量来源支持两种供电方式一种是常规的电池输入DC 12V另一种是通过Type-C接口用PD快充头诱骗出12V电压方便调试。整个系统的框图可以这样理解[上位机/遥控器] --UART/CAN-- [STM32F103 “大脑”] --PWM/ADC-- [DRV8313 “肌肉”] -- [无刷电机] ^ ^ | | [磁编码器] [电流采样 INA199]我们的任务就是把这些模块用电路连接起来并编写让它们协同工作的软件。2. 硬件电路设计详解硬件是项目的基石设计好了后面调试能省一半的力气。咱们按照信号流和电源流一块一块来看。2.1 电源管理如何安全又灵活地供电驱动器需要两种电压给电机驱动和部分电路用的12V以及给单片机、编码器等芯片用的3.3V。第一路12V电源输入与PD诱骗为了调试方便我们设计了双路12V输入。电池输入接口这是一个最直接的DC插座接上12V电池就能用。Type-C PD诱骗电路这是本设计的一个亮点。我们使用了CH224K这颗芯片。它的作用是和一个支持PD协议的手机充电头“谈判”让它固定输出12V电压。这样你手边任何一个快充头都可能成为你的电机电源非常方便实验室调试。注意CH224K电路已经过验证能稳定诱骗出12V。但务必使用质量合格的PD充电头。第二路3.3V降压电路12V不能直接给单片机用需要降压到3.3V。这里我们选用了一颗经典的DCDC芯片——TPS5430。为什么用DCDC而不是LDO因为电机驱动板功耗可能不小DCDC效率高发热小。TPS5430输入范围是5.5V到36V完全满足我们12V输入的需求而且它集成度高外围电路简单自带过流、过压、过热保护。一个关键坑点原文特别提醒如果Type-C诱骗失败比如用了不支持PD的充电头并且没有接电池那么整个12V输入端就没电。TPS5430因为输入电压低于5.5V而无法工作导致后级整个3.3V系统瘫痪。所以调试时一定要确保12V电源正常。防倒灌电路当同时连接USB给CH340串口芯片供电约5V和电池12V时如果没有保护电池的12V可能会倒灌进USB口烧坏电脑或USB设备。我们在电路中加入了二极管等元件构成了防倒灌保护电路确保电流只能单向流动。2.2 核心控制STM32最小系统与程序下载主控芯片是大家熟悉的“蓝色小药丸”——STM32F103C8T6。最小系统包括晶振、复位电路、Boot模式选择电路和滤波电容。这部分是经典设计照搬成熟方案即可稳定性有保障。为了方便烧录程序我们集成了CH340CUSB转串口芯片并且设计成了自动下载电路。传统下载的麻烦通常给STM32下载程序需要手动拨动BOOT0跳线帽再按复位键。自动下载的便利我们利用CH340C芯片的DTR和RTS信号线通过电路连接自动控制STM32的BOOT0和NRST引脚。在软件如FlyMCU中选择“DTR低电平复位RTS高电平进BootLoader”后点击下载软件就能自动完成复位和进入下载模式的动作无需手动操作。操作提示使用自动下载功能时需要装上连接RXD-UTX和TXD-URX的跳线帽。下载成功后实物图里LED灯被点亮就是程序跑起来的标志。2.3 动力核心DRV8313三相电机驱动驱动电机我们选择了TI的DRV8313。它是一个集成了三个半H桥的驱动芯片相当于把三个独立的电机驱动桥路做到了一起非常节省空间。优点集成度高外围电路相对分立方案简单很多。保护齐全芯片内部自带过流保护、短路保护、欠压锁定和过温关断。这意味着当电机堵转或短路时芯片会自己关断输出保护自身和电机大大增强了系统的可靠性。接口简单直接接收来自STM32的6路PWM信号每相高、低侧各一路就能控制电机的三相输出。电路设计要点原理图中参考了利用DRV8313内部比较器实现电流限制的电路。原文作者提到这个功能可以选择不焊接保留了0603封装的焊盘用于短接给了我们灵活性。初期调试可以不焊让驱动全力输出后期需要精确限流时再焊接相关元件。2.4 关键反馈电流采样与位置检测FOC控制之所以精准离不开实时的电流和位置反馈。电流采样INA199FOC算法需要知道电机三相中至少两相的电流。我们在电机驱动桥臂的下管和地之间串联了毫欧级别的采样电阻Shunt Resistor。电流流过会产生一个微小的电压差。INA199的作用这个电压差太小单片机ADC直接测不准。INA199是一个专用的电流分流监控器它能将这个微小电压差放大固定的倍数比如50倍、100倍输出一个适合STM32 ADC采集的电压信号0-3.3V。这样我们就能精确反推出电机的相电流。位置检测磁编码器我们采用“径向磁铁磁编码器芯片”的方案。将一个小磁铁固定在电机转子的尾部磁编码器芯片如AS5600等正对着磁铁安装。转子转动时磁场方向变化磁编码器就能通过I2C或SPI接口实时向STM32报告转子的绝对角度。有了这个角度FOC算法才能知道当前该给哪一相通电。2.5 人机交互与通信接口为了让驱动器更易用我们预留了丰富的接口OLED显示屏接口用于显示电机转速、电流、错误代码等信息。旋转编码器接口可以接一个带按键的旋转编码器作为本地设置参数的人机交互设备。UART接口除了用于程序下载的CH340还引出了额外的UART可以连接其他串口设备。CAN接口工业和高可靠性场景常用的通信方式抗干扰能力强可以组网。我们预留了CAN收发器如TJA1050的接口。3. PCB设计要点画PCB不是简单的连线尤其是电机驱动板布局布线直接影响性能和稳定性。作者分享了几条很实在的经验大电流走线加粗给电机供电的12V线路和三相输出线U/V/W电流可能达到数安培。必须使用足够宽的走线比如60mil以上或者采用铺铜的方式以减少线路压降和发热。采样电路差分走线电流采样电阻两端的走线到INA199输入脚必须严格按照差分对来走。即两条线并排、等长、等距这样可以有效抑制外部噪声干扰保证采样精度。这是很多初学者容易忽略而导致电流采样不准的关键点。铺铜与过孔大面积铺铜可以改善电源和地的稳定性。但铺铜会产生“孤岛”孤立的小块铜皮这些孤岛在焊接时可能受热不均。好的习惯是使用大量过孔将孤岛与主地平面连接起来或者直接删除它们。4. 软件框架与实现思路原文提供的代码是一个简单的测试代码用于验证硬件基本功能如GPIO控制LED、ADC采样。但对于一个完整的FOC驱动器软件架构要复杂得多。这里我结合项目要求梳理一下软件的实现思路。4.1 核心FOC三闭环控制算法这是软件的“灵魂”。通常我们会移植或借鉴成熟的开源FOC库如SimpleFOC、ODrive的代码等。算法的核心任务是在STM32中实时运行Clarke变换 Park变换将测得的三相电流Ia, Ib, Ic从静止坐标系转换到随转子旋转的D-Q坐标系下。其中Iq电流负责产生转矩控制转速/力矩Id电流通常控制为0用于弱磁控制等高级应用。PID调节器实现位置环、速度环、电流环通常是D轴和Q轴两个电流环的三闭环控制。最内环电流环。响应最快目标是让电机实际电流紧紧跟随算法计算出的期望电流。中间环速度环。输入是目标速度输出是期望的Q轴电流转矩电流。最外环位置环。输入是目标位置输出是期望速度。反Park变换 SVPWM将经过PID调节后的D-Q轴电压再变换回三相电压并通过SVPWM算法生成6路PWM波最终驱动DRV8313。4.2 多通信接口控制驱动器需要支持多种控制方式UART通信可以接收来自电脑上位机如调试助手、自定义的上位机软件的指令设置目标位置、速度、力矩并回传状态数据。协议可以自定义如简单的字符串指令SPD:1000表示设置转速为1000RPM。CAN通信在机器人、无人机等多节点系统中CAN总线是首选。需要实现CAN协议如CANopen让驱动器成为一个标准的网络节点接收主控发来的控制帧。编码器本地控制通过板载的旋转编码器可以在脱离上位机的情况下手动调整电机运行参数或模式。4.3 简单OLED显示界面利用STM32的硬件I2C驱动OLED屏幕如SSD1306。可以显示几页信息状态页实时显示当前转速、电流、温度。参数页显示PID参数、控制模式位置/速度/力矩。设置页结合旋转编码器可以修改PID参数等。4.4 代码组织建议一个清晰的项目结构会让开发事半功倍。可以这样组织你的工程/Drivers /STM32F1xx_HAL_Driver // HAL库文件 /BSP // 板级支持包 bsp_drv8313.c/h // DRV8313驱动 bsp_ina199.c/h // 电流采样ADC读取 bsp_encoder.c/h // 磁编码器读取 bsp_oled.c/h // OLED显示 bsp_uart_can.c/h // 通信接口 /Core /Inc /Src main.c foc_algorithm.c/h // FOC核心算法 pid_controller.c/h // PID控制器 communication.c/h // 协议解析与处理 /Middlewares /SimpleFOC // 如果使用开源库5. 调试心得与注意事项上电顺序务必先确保3.3V电源正常STM32工作再给12V电机驱动部分上电。防止驱动芯片误动作。电流采样校准上电后在不驱动电机的情况下读取INA199的输出电压。理论上应该接近零点例如1.65V如果采用Vref/2作为基准。如果有偏差需要在软件中做零点校准。PWM死区时间驱动DRV8313时STM32生成的互补PWM必须设置死区时间。防止同一桥臂的上下管同时导通造成短路炸管。死区时间通常设置在几百纳秒到几微秒。编码器对齐对于FOC电机初始的电角度必须准确。上电后需要执行一个“编码器对齐”程序通常是给电机一个固定的矢量力让转子转到已知的初始位置并与编码器的零位对应起来。循序渐进调试不要一开始就上完整的FOC算法。可以先测试GPIO控制LED验证最小系统。ADC读取电流采样值验证采样电路。读取磁编码器角度验证位置传感。输出固定的PWM让电机简单地转起来验证驱动电路。最后再逐步集成FOC算法先开环运行再闭环调试。这个“芙宁娜·彩印版”FOC驱动器项目从电源、驱动、采样到主控和交互提供了一个非常完整且经过验证的硬件平台。软件上虽然只给出了测试代码但明确了实现位置、速度、力矩三闭环以及多通信接口的目标为我们指明了开发方向。开源硬件最大的魅力就在于你可以站在前人的肩膀上根据自己的需求去修改、优化和填充软件。希望这篇详解能帮你理清思路少走弯路早日做出自己稳定可靠的电机驱动器。