【资源自取】如何掌握无传感器 PMSM 电机控制:STM32_FOC_SDK2.0 开源版本实战指南

原创2026-11-12 14:07:381,385 阅读

【资源自取】如何掌握无传感器 PMSM 电机控制:STM32_FOC_SDK2.0 开源版本实战指南

如果你想在 STM32 上做永磁同步电机(PMSM)的磁场定向控制(FOC,把三相电流分解为"励磁"和"转矩"两个分量来独立控制的算法),又想看完整源码而不是啃文档,STM32_FOC_SDK2.0 开源版本是一个现成的选择。这个仓库把 ST 早期发布的 FOC SDK 2.0 完整源码打包成一个 7z 压缩包,PMSM 和异步电机的 FOC 驱动全部可见。它更适合两类人:想搞懂 FOC 内部实现的初学者,以及想在 STM32F103 平台上做无传感器控制二次开发的工程师。

🎯 它解决什么问题

从零写一套 FOC 驱动,你至少得同时处理五件事:SVPWM 生成、三相电流采样与 Clarke/Park 变换、速度/电流环 PID、转子位置获取、启动策略。任何一件处理不好,电机都转不起来。

这个 SDK 的价值在于把上面这些全部写成了可编译的工程,而且源码没有闭源成库——包括最常被封装起来的无传感器观测器。默认配置下它走的是无传感器路线(NO_SPEED_SENSORS 宏开启):不装霍尔或编码器,靠算法从电压和电流反推转子位置,省掉传感器成本的同时还能省一次机械装配。带传感器的方案也保留了,STM32F10x_MCconf.h 里把 HALL_SENSORS 或 ENCODER 打开即可切换。

除了 PMSM,压缩包内还有一套 STM32_FOC_ACIM 异步电机(感应电机)IFOC 驱动,结构和 PMSM 侧基本对应,只是少了位置观测器、多了测速与转差频率逻辑。

📥 上手路径:从 7z 到可编译工程

仓库本身只有一个压缩包和说明,没有现成目录结构:

  • 仓库文件:STM32_FOC_SDK2.0 开源版本.7z(约 207 KB)、README.md、LICENSE(MIT)
  • 获取方式:
git clone https://gitcode.com/open-source-toolkit/af02b

解压后得到四个顶层目录:

  • STM32_FOC_PMSM/:PMSM 的 FOC 驱动,本文的主角,含 src/、inc/ 和三个工具链工程
  • STM32_FOC_ACIM/:异步电机 IFOC 驱动,目录结构与 PMSM 侧一一对应
  • STM32F10XFWLIB/:STM32F10x 标准外设库 V2.0(version.txt 可确认版本)
  • 各驱动目录下的 RVMDK/(Keil uVision 工程)、EWARM/(IAR)、MULTI/(HiTOP,带 .ld 链接脚本)

工程文件是当年配置的(Keil .Uv2/IAR .ewp/HiTOP .proj),源码、库文件和启动文件都已挂好,用对应 IDE 打开编译即可。需要说明的是,工程默认面向 ST 的评估板环境(代码注释里指向 STM3210B-EVAL 与 MB459 电机桥板),如果你用的是自己的 F103 开发板,引脚映射和采样通道要按硬件重配。

📂 核心目录结构一览

以 PMSM 侧为例,读代码时最常用的是 STM32_FOC_PMSM/src/ 和 STM32_FOC_PMSM/inc/ 两个目录:

  • 入口:src/main.c,依次做 NVIC_Configuration()、RCC_Configuration()、GPIO_Configuration(),再根据采样宏调用对应的 SVPWM 初始化
  • 驱动层:MC_FOC_Drive.c(FOC 主控流程)、MC_PID_regulators.c(各环 PID)、MC_MotorControl_Layer.c(外设抽象)
  • 数学层:MC_Clarke_Park.c(坐标变换,内置查表法三角函数)
  • 观测器:MC_State_Observer.c + MC_State_Observer_Interface.c(无传感器核心,下一节细讲)
  • 外设驱动:stm32f10x_svpwm_3shunt.c(三电阻采样)、stm32f10x_svpwm_1shunt.c(单电阻)、stm32f10x_svpwm_ics.c(电流互感器)、stm32f10x_hall.c、stm32f10x_encoder.c
  • 人机交互:MC_Keys.c(按键)、MC_Display.c(屏显)、stm32f10x_lcd.c、stm32f10x_MCdac.c(用 DAC 输出波形示波器观察)

所有"开关"集中在 inc/STM32F10x_MCconf.h:采样方式(THREE_SHUNT / SINGLE_SHUNT / ICS_SENSORS 三选一)、位置反馈(霍尔/编码器/无传感器三选一)、以及 FLUX_WEAKENING(弱磁)、FEED_FORWARD_CURRENT_REGULATION(前馈电流调节)、IPMSM_MTPA(IPMSM 最大转矩磁控)、OBSERVER_GAIN_TUNING(观测器增益在线整定)等可选功能。电机本体参数(极对数、定子电阻、电感、额定电流、最大转速)在 inc/MC_PMSM_motor_param.h,PWM 频率(默认 14.4 kHz 中心对齐)、死区(800 ns)、速度/转矩环 PID 初值在 inc/MC_Control_Param.h。

🔍 深入一层:无传感器观测器是怎么做的

整个 SDK 里最值得读的文件是 STM32_FOC_PMSM/src/MC_State_Observer.c(README 里提到的就是它,注意压缩包里的实际路径是 STM32_FOC_PMSM/src/MC_State_Observer.c)。文件头注释写得很直白:这个模块实现 PMSM 反电动势(B-EMF,转子转动时定子绕组感应出的电压)的状态观测,由此辨识转子速度和位置。

其主入口 STO_Calc_Rotor_Angle() 每个采样周期执行一次,输入是电压参考值、采样电流和母线电压,输出是转子电角度与速度(dpp,degrees per PWM period)。思路可以概括为三步:

  1. 用电机电压方程,从"实际电压 − 电阻项 − 电感项(用上次电流估计)"推算出反电动势估计值;
  2. 估计的反电动势幅度对应转速,用它和指令转速做 PI 调节(代码里的 Speed_PI,对应 hPLL_P_Gain/hPLL_I_Gain),相当于一个锁相环;
  3. 锁相环收敛后,由反电动势的相位直接得到转子电角度,供 Park 变换使用。

为什么这样设计?因为无传感器方案的"传感器"就是算法本身:位置估计必须同时满足稳态精度和动态跟踪,而 PLL 结构天然具备这两点。代价也很明显——启动时电流小、反电动势弱,观测根本不可信,所以 MC_State_Observer_Interface.c 里专门有 STO_StartUp_Init() 做开环变频启动(wStart_Up_Freq、hFreq_Inc 逐步升频),等 IsObserverConverged() 判定收敛后才切入闭环。读这套代码时,把"启动 → 收敛判定 → 闭环切换"这条主线抓住,整个无传感器 FOC 就通了。

另一个容易让人困惑的设计是全程定点运算:变量都是 s16/s32,角度用 0~65535 映射 0~360°,三角函数走 hSin_Cos_Table[256] 查表。原因很现实——STM32F103 没有硬件 FPU,浮点运算在 14.4 kHz 的 PWM 中断里跑不起完整 FOC。这套定点标度约定(各参数的 Q 格式)虽然读起来费劲,但它保证了算法在目标硬件上的周期确定性,是移植到其他无 FPU 内核时的直接参考。

至于 SVPWM 部分,三个采样方案(三电阻/单电阻/互感器)各自一个文件,结构相同:中断里采一次电流、更新占空比、处理死区补偿,属于对照硬件理解即可,不必逐行精读。

⚠️ 使用中要注意什么

  • 代码年代与硬件绑定:源码版权头是 2007–2008 年,SDK 版本 v2.0.1,基于 F10x 标准外设库而非 HAL/LL。想移植到 F4/H7 等新系列,外设驱动层(SVPWM、采样、时基)基本要重写,算法层可以照搬思路。
  • 电机参数必须重配:MC_PMSM_motor_param.h 里的 RS(0.35 Ω)、LS(0.0006 H)、POLE_PAIR_NUM(2)、MOTOR_VOLTAGE_CONSTANT(4 V/kRPM)对应的是当年演示用的小电机,换自己的电机不把这些改对,观测器和 PID 都不可能收敛。
  • 默认宏组合:出厂默认是 THREE_SHUNT + NO_SPEED_SENSORS + FLUX_WEAKENING,MCconf.h 里对宏冲突有编译期检查,但三种采样、三种位置反馈只能各选一种,切换时注意重新编译。
  • 工具链版本较老:IAR 工程是 EWARM 5.11 的,Keil 工程是 .Uv2 格式,新版 IDE 打开可能需要转换或按 note.txt/readme.txt 的说明重建。
  • 文档稀缺:压缩包内没有独立文档目录,RVMDK/note.txt 只讲了启动文件问题;理解代码主要靠文件头注释和 MC_Control_Param.h 里的宏注释。README 里给出的路径含拼写错误("firwmare"),实际位置以 STM32_FOC_PMSM/src/ 为准。
  • 许可证:仓库根目录为 MIT License,可自由使用和二次开发;源码文件内仍保留 ST 的原始版权声明,商用时建议一并留意。

小结

一句话概括:这是一份在 STM32F103 上可编译、可运行的完整定点 FOC 参考实现,无传感器观测器是全开源的,最适合作为"逐行读懂 FOC"的教材或 F103 平台二次开发的骨架;如果你需要 HAL 风格的新平台代码、或者期望开箱即配自家硬件,它帮不上忙——它给的是思路和全部细节,而不是现成产品。

登录后查看全文
STM32_FOC_SDK2.0开源版本