1 全景:六个框架各自是谁,差别到底在哪?

04-02 页已经介绍过 SimpleFOC / ODrive 的基本盘;本页把镜头拉近到「代码长什么样、跑在哪个中断里」,并把阵容扩到工程界最常打交道的六家:两家开源社区(SimpleFOC、ODrive)、一家功率场景老将(VESC)、两家芯片原厂(ST MC SDK、TI InstaSPIN-FOC),以及一个学术开源范式(MIT Mini Cheetah 关节驱动)。

同一个 FOC,六种「装法」。它们的数学内核几乎一样(采样 → Clark → Park → PI → 逆 Park → SVPWM,见 04-19 完整流程图),真正的差别集中在四个问题上:

• 电流环放在哪?——主循环轮询、ADC 中断、RTOS 线程,还是芯片 ROM 里的固化代码?这决定了实时性与性能天花板。
• 状态机长什么样?——有没有显式的轴状态机(axis state machine)?状态转换是手写 switch 还是任务链(task chain)?这决定了可靠性与产品化程度。
• 参数从哪来?——手填、Motor Profiler 自测、FAST 在线辨识,还是校准序列自动量?这决定了上手的难易。
• 许可绑定谁?——MIT 随便改、GPLv3 要传染、还是专有库绑定芯片?这决定了能不能商用、能不能移植。

1.1 六框架速览表

2 SimpleFOC:教学优先的两段式主循环

2.1 定位与代码架构

定位:把 FOC「去神秘化」的 Arduino 库。官方目标是 Demystify FOC algorithm and make a robust but simple Arduino library,MIT 许可,文档(docs.simplefoc.com)与社区教程是六家里最全的。它回答的问题是:怎么用最少的代码、最普通的硬件(ESP32/Arduino + 驱动板 + 磁编码器),第一次让 FOC 闭环转起来。

代码架构:面向对象三层——Motor(BLDCMotor 等)· Driver(功率驱动)· Sensor(编码器),C++ 类互相 link。所有电机类继承自 FOCMotor 基类,核心两段式入口 loopFOC() 与 move() 就定义在基类 FOCMotor.cpp 里(BLDCMotor/StepperMotor 继承复用);SVPWM/正弦/梯形调制在 setPhaseVoltage() 里实现。运动控制在库里抽象为 MotionControlType(力矩/速度/位置/开环),由 move() 按 controller 类型分派。

// SimpleFOC 用户视角的全部骨架(六家里最短)
#include <SimpleFOC.h>
BLDCMotor motor = BLDCMotor(7);          // 极对数
BLDCDriver3PWM driver = BLDCDriver3PWM(32, 33, 25);
MagneticSensorI2C sensor = MagneticSensorI2C(AS5600_I2C);  // 或 Encoder/ABI

void setup() {
  driver.init();  motor.linkDriver(&driver);
  sensor.init();  motor.linkSensor(&sensor);
  motor.controller = MotionControlType::velocity;  // 力矩/速度/位置
  motor.init();   motor.initFOC();                 // 校准电角度零偏
}
void loop() {
  motor.loopFOC();   // ① 低层 FOC: 读角度→(采样)→电流计算→SVPWM 出波
  motor.move(5.0f);  // ② 高层运动: 按控制模式把目标换算成电压/电流指令
}

2.2 中断结构与核心流程

中断结构:SimpleFOC 的主控制链默认跑在 Arduino 主循环的普通调用栈里,不依赖硬实时 ISR——这正是它好懂的原因,也是它性能天花板的根源(执行周期抖动大、频率受 loop 其他代码拖累)。需要注意的例外:ABI 增量编码器的 A/B 相计数用 GPIO 中断回调;低边电流采样(LowsideCurrentSense)在某些平台会挂 ADC 中断回调。但对最常见的「电压模式 + 磁编码器」配置,整个系统就是"主循环 + 一点点中断"。

核心流程:loopFOC() 读编码器角度 → (若有电流采样则做相电流计算)→ 依据当前力矩指令经逆 Park/SVPWM 输出三相电压;move() 则按速度/位置环 PID 把目标值换算成下一拍力矩指令。关键短板:绝大多数入门配置没有相电流采样硬件,电流环并不闭环——库用「电压 ≈ 力矩」的近似(或估算电流),力矩精度与电流谐波抑制天然弱于闭环电流环方案;即使加装 inline/lowside 采样,受平台定时器资源限制,电流环频率也远低于 ODrive/VESC 类方案。

2.3 优缺点与适用

适用:FOC 入门教学、云台/低速平稳运动、算法原型验证、读源码学架构。不适用:需要高带宽电流环的关节力控。想先动手跑通的读者,直接照 04-02 页第 3 节的最小示例开工。

3 ODrive:状态机驱动的高性能开源伺服

3.1 定位与代码架构

定位:「高性能 hobby/prosumer」路线的代表作——硬件 + 固件 + 上位机全开源(MIT),把工业伺服的三环结构塞进一块双轴板子。注意两点事实(截至本文核实):① 开源固件对应经典 v3.x 硬件,官方已标记 NRND(不再积极开发),新款 Pro/S1/Micro 的固件源码未公开;② 虽然如此,v3.x 固件仍是学习「产品级 FOC 固件怎么组织」的最佳文本之一。

代码架构:核心抽象是 Axis(轴)——一块板两个 Axis,每个 Axis 聚合 Motor(FOC 电流环)、Encoder(位置/速度估计)、Controller(位置/速度环)、Trapezoidal Trajectory(轨迹规划)等组件。每个组件有各自的后台线程(FreeRTOS),而电流环独占最高实时性:挂在 PWM 同步的 ADC 采样完成中断/最高优先级线程里,频率与 PWM 同量级——严谨地说在数 kHz 到数十 kHz 之间(依配置与硬件代次而变,不建议背具体数,面试说区间即可)。

// ODrive 固件阅读地图(v3.x 固件, 以仓库当前版本为准)
Firmware/MotorControl/
├── axis.cpp        // 轴状态机: Axis::run_state_machine_loop() + task chain
├── motor.cpp       // 电流环核心: Motor::FOC_current(Id_des, Iq_des, ...)
├── controller.cpp  // 位置环/速度环 + 轨迹跟踪
├── encoder.cpp     // 编码器计数 / 速度估计 / 校准
├── low_level.cpp   // ADC 采样启动(start_adc_pwm)· 模拟量 · 母线
└── sensorless_estimator.cpp / acim_estimator.cpp  // 可选无感/异步机估计

3.2 中断结构与轴状态机

中断结构:电流环在 PWM 周期驱动的采样中断里闭环(采两相电流 → FOC → 更新比较寄存器);位置/速度环跑在低一些频率的线程里;USB/CAN 通信又是更低优先级的线程。这是典型的「三层时间尺度」结构,几乎所有的产品级关节固件都是这个形状。

状态机:每个 Axis 有一个显式的 AxisState 状态机,上位机通过写 requested_state 请求切换。官方定义的状态包括:UNDEFINED / IDLE / STARTUP_SEQUENCE / FULL_CALIBRATION_SEQUENCE / MOTOR_CALIBRATION / ENCODER_INDEX_SEARCH / ENCODER_OFFSET_CALIBRATION / CLOSED_LOOP_CONTROL / LOCKIN_SPIN / ENCODER_DIR_FIND / HOMING / ENCODER_HALL_POLARITY_CALIBRATION / ENCODER_HALL_PHASE_CALIBRATION 等。上电启动链(STARTUP_SEQUENCE)会按配置依次串起「电机参数测量 → 编码器索引搜索 → 编码器零偏校准 → 进入闭环」,在固件里实现为一条 task chain(任务链)依次执行——这是 ODrive 架构里最值得抄的设计之一。

3.3 优缺点与适用

适用:机械臂关节原型、四足/人形单腿样机、高性能 DIY(轮式平衡、云台直驱)。配置步骤见 04-02 页第 4 节(odrivetool 校准与 Python 控制)。

4 VESC:大功率场景的 RTOS 分层架构

4.1 定位与代码架构

定位:Benjamin Vedder 的开源功率电子生态,从几十瓦的云台电机到上百千瓦的电航应用都在用(官网口径),电动滑板/EBike/轮式机器人是最大用户群。功率等级、成熟度、工具链(VESC Tool 全家桶)是它的名片。许可要如实记:固件 GPLv3——商用整机要考虑 GPL 传染条款,这一点和 MIT 系完全不同。

代码架构(vedderb/bldc 仓库):跑在 ChibiOS(RTOS) 上,层次分明:

• 实时内核级:motor/mcpwm_foc.c 里的 FOC 中断服务(mcpwm_foc_isr_motor())——电流采样 + FOC + SVPWM 都压在与 PWM 同步的 ISR 里,这是全系统最硬的实时部分;
• 应用任务层:applications/ 目录(app_canbus、app_adc、app_uartcomm、app_nunchuk 等)——每种输入源一个任务,把「外部世界」翻译成电机目标值;
• 通信层:comm/(USB/UART/CAN 包协议与终端命令),加 terminal.c 命令行;
• 配置与硬件抽象:hwconf/(几十种官方/社区硬件板配置)、conf_general(参数管理)。

高级调制策略上,VESC 内置弱磁(field weakening)与 MTPA(最大转矩电流比)一类的高速/高效策略(具体开关以所用版本固件为准),这是 SimpleFOC 完全没有、ODrive 也较少触及的功率域功能。

4.2 优缺点与适用

适用:轮式/轮足机器人大功率轮毂驱动、电动滑板、中大功率关节(需自行封装力控语义)。B站搜「VESC 电机」有大量中文上手视频(见文末资源卡)。

5 ST MC SDK 6.x:芯片原厂的产品化 FOC 库

5.1 定位与代码架构

定位:ST 官方电机控制 SDK(X-CUBE-MCSDK,当前 6.x 代),面向产品化——家电、工业、泵类、工具。免费下载(走 ST 官网申请流程),但属专有许可,和开源社区的 MIT 系不同。它回答的问题是:「我要把一台未知电机做成可靠量产的产品,谁来替我把参数、代码、调试工具一次配齐?」

代码架构与工具链:三大件——

• Motor Profiler:接上未知电机自动测 Rs/Ls/反电动势常数等参数(官方叫 Motor profiler 与 one-touch tuning),解决了「参数从哪来」的问题;
• Motor Control Workbench + CubeMX 集成:图形化选电机、选功率板、配外设,直接生成工程代码——代码是「生成的」,不鼓励你手改结构;
• 固件库本体:观测器支持齐全(有感编码器/霍尔 + 无感状态观测器,SMO 类),利用 STM32(G4 等)的 CORDIC/FPU 加速坐标变换与三角运算。

5.2 任务调度与状态机

任务调度:MC SDK 把工作切成三个时间尺度——高频任务(电流环,跟随 PWM 更新节拍执行)、中频任务(速度/位置控制与状态推进,固定毫秒级周期)、后台任务(通信协议栈、监控、调试变量)。这套 HF/MF/背景划分与 ODrive 的「ISR/线程/通信」异曲同工,但更「库化」:入口函数、回调点、状态推进都由框架约定好。

状态机:电机控制状态机围绕一条主链运转:STOP → IDLE → ALIGNMENT(编码器/观测器对齐)→ START(启动序列)→ RUN → STOP,另有 ICLWAIT(过流等待)、充电自举电容、故障态等辅助状态。所有启动/停止指令(MC_StartMotor1 / MC_StopMotor1)都只是向状态机发请求,真正的时序由状态机统一推进——这正是产品代码需要的「谁都不能绕过状态机乱来」的纪律。

5.3 优缺点与适用

适用:家电/电动工具/工业辅助动力等产品化项目;用 ST 芯片自研关节固件时,它的状态机与任务划分也是最好的「抄作业」对象(见第 11 节)。

6 TI InstaSPIN-FOC:ROM 里的 FAST 观测器与参数自辨识

6.1 定位与架构:把「最难的脑子」焊死在芯片里

定位:TI 面向白电/泵/风机等无感(one-wire 或 zero-sensor)量产场景的 FOC 方案。它的杀手锏是 FAST 估计器(Flux, Angle, Speed, Torque):一个统一的电机观测器,直接固化在 TMS320F2806x(F/M)等特定 Piccolo 型号的片内 ROM 里(TI 官方口径:FAST 仅以 ROM 形式提供于特定器件),配合 MotorWare 软件框架与引导 GUI 使用。

架构特点:你写的应用代码调用 ROM 里的 FAST 句柄;FAST 输出磁链、角度、转速、转矩四个量,FOC 电流环用它做无感换相。参数辨识是全自动的:上电跑一遍辨识流程,电机电阻 Rs、电感 L(以及感应电机的 Rr、额定磁链 V/Hz)直接量出来——这是它「五分钟出活」的核心卖点。代价也很明确:黑盒(ROM 代码不可读不可改)+ 绑定 TI 特定型号,换平台就归零。

6.2 优缺点与适用

适用:白电(空调风机/洗衣机)、泵类、风扇等标量负载的无感量产。对机器人工程师,它值得学的不是「拿来用」,而是「参数自辨识 + 统一观测器」的产品思路——无感观测器的算法族谱见 04-17 状态观测器全解。

7 MIT Mini Cheetah:学术开源范式与「MIT 模式」CAN 命令

7.1 定位:不是「一个库」,而是一套被产业复刻的关节范式

定位:MIT Biomimetics Robotics Lab 的 Mini Cheetah 四足机器人展示了「准直驱关节 + 高带宽力控」能跑能跳能后空翻。其开源仓库 Cheetah-Software(MIT 许可)包含整机控制(robot)与仿真(sim)软件栈;注意:关节内部的电流环固件并未随该仓库开源,但它的关节接口协议被产业界原样复刻——CubeMars AK 系列、T-Motor、达妙、宇树 GO 系列执行器等都提供「MIT 模式」,使它成为足式/人形关节自研绕不开的参照系。

7.2 层级结构与「MIT 模式」报文

层级:关节内,FOC 电流环跑在 STM32 的 PWM 同步采样中断里,频率为数十 kHz 量级(保证电流带宽);关节外,整机控制器以固定高频(如 1kHz 量级)通过 CAN 广播每个关节的目标。命令层就是著名的「MIT 模式」:把 5 个控制量打包进一个 8 字节 CAN 数据帧——

// 「MIT 模式」CAN 命令帧(8 字节, 产业通行的打包约定)
// 五个控制量按固定位宽压缩: 位置 16bit + 速度/Kp/Kd/前馈电流 各 12bit
p_des(16bit) | v_des(12bit) | kp(12bit) | kd(12bit) | i_des(12bit)

// 语义是「软件刚度-阻尼 + 前馈」的关节级 PD:
tau_cmd = kp * (p_des - p) + kd * (v_des - v) + i_des

// 三个量全给 0 → 纯力矩(前馈)模式,即 tau = i_des
// kp/kd 给大、i_des=0 → 变成位置伺服(刚度阻尼由 kp/kd 决定)

这条公式是理解人形/四足关节的钥匙:整机控制器在 1kHz 发「目标+刚度+阻尼」,关节内的电流环把它变成真正的电磁转矩——力控的「力」是两层合作出来的(整机侧的 WBC/MPC 算关节力矩,关节侧保证力矩准确,见 04-02 第 5.4 节)。宇树的执行器 SDK 就是这套模式的工程化封装。

7.3 优缺点与适用

适用:足式/人形机器人关节自研的接口与架构参照。选定该范式后,第 11 节的自研建议直接可用;商业关节模组怎么按此协议使用,见 02-05 参考资料汇总的关节模组产品清单。

8 横向对比大表:13 个维度一表定乾坤

面试与选型都靠这张表。维度看着多,记法是把它们分成四组:实时性组(电流环位置/频率、采样要求)、算法组(观测器、参数辨识、SVPWM)、工程组(状态机、通信、代码规模、学习曲线)、合规组(许可、硬件绑定、场景)。

9 选型决策树:六个问题定去向

选型不要背表,问自己六个问题:目标是什么 → 有没有力控要求 → 功率多大 → 要不要产品化 → 有没有编码器 → 是不是整机关节阵列。走一遍下面的树:

10 如何读源码:通用四步路线 + 两个起点

读任何电机控制固件,都按同一条路线走,不要从 main.c 顺着读到尾:

10.1 起点一:SimpleFOC(先读懂「教学版骨架」)

• 入口:src/common/base_classes/FOCMotor.cpp —— FOCMotor::loopFOC() 与 FOCMotor::move()(两段式的真正定义处,BLDCMotor 只是继承);
• 调制:src/BLDCMotor.cpp 的 setPhaseVoltage() —— 梯形/正弦/SVPWM 三种调制怎么切换;
• 外环:src/common/pid.cpp(PID 实现)与 lowpass_filter.cpp(一阶低通)——最小可读的控制器参考实现;
• 通信:src/communication/Commander.cpp —— 串口命令协议的极简范本。

读完检验:能不看书手画「loopFOC + move」的数据流图,能说出角度 θ 从传感器到 SVPWM 的完整路径。

10.2 起点二:ODrive(再读懂「产品级骨架」)

// ODrive v3.x 固件(路径与函数名以仓库当前版本为准)
Firmware/MotorControl/
├── axis.cpp        → Axis::run_state_machine_loop()   // ③ 状态机: requested_state 队列 + task chain
├── motor.cpp       → Motor::FOC_current(Id, Iq, ...)  // ② 电流环核心
├── low_level.cpp   → start_adc_pwm()                  // ① ISR 入口: PWM 触发 ADC 采样的启动配置
├── controller.cpp  → Controller::update()             // ②' 位置/速度外环
└── encoder.cpp     → Encoder 校准/估计                 // 观测与标定

读完检验:能说出「一条 input_torque 指令从 CAN/USB 进来,经过哪些层、变成哪几组 PWM 比较寄存器的值」;能解释 CLOSED_LOOP_CONTROL 与 IDLE 之间会经过哪些状态。这一套读下来,再看 VESC 的 mcpwm_foc.c 或 MC SDK 生成的代码,只是「换个文件夹名」而已。

11 自研建议:从哪抄架构,checklist 管住风险

11.1 三件「值得直接抄」的设计

把它们拼起来,就是一个合格的自研关节固件雏形:ODrive 的实时骨架 + MC SDK 的状态纪律 + MIT 模式的接口。观测器与参数辨识可以后置(先用编码器 + 出厂标定,无感留给 04-17 的算法储备)。

11.2 自研工程 checklist(立项就贴墙上)

• 实时性:电流环是否独占最高优先级?最坏情况执行时间(而非平均值)是否测过?电流环频率是否 ≥ 速度环 5 倍以上?
• 采样:ADC 是否 PWM 中心对齐同步触发?低边采样的窗口是否避开开关沿?双电阻丢一相时是否有降级策略?
• 安全:过流(逐波限流+软件阈值)、过压/欠压、过温降额、超时通信丢失回 IDLE——四类保护是否全部独立于通信层生效?上电默认状态是否为 IDLE?
• 校准:电角度零偏、电阻电感、编码器方向——校准序列是否有 task chain 式的顺序与失败回退?
• 接口:CAN 命令是否兼容「MIT 模式」语义?帧 ID/字节序/回传频率是否写进协议文档?固件版本号是否可查?
• 许可:抄的代码是什么许可?GPLv3 部分是否与专有代码隔离?商用法务是否过目?

12 本节自测

13 参考来源与延伸资源

以下链接均经检索核实可达(2026-09 核实;其中知乎站内搜索需在浏览器中打开)。站内配套:三家简介见 04-02 固件与电机控制,FOC 完整流程图见 04-19 FOC 算法完全图解,观测器深入见 04-17,面试问法见 06-11 保研复试面试题库。

📘

⭐ SimpleFOC 官方文档(docs.simplefoc.com)

两段式 API、控制模式、支持板卡与 SimpleFOCStudio 全说明;MIT 许可与「Demystify FOC」定位的官方出处。学习入口第一站。

官方文档⭐ 必读入门

🔧

SimpleFOC 源码仓库(simplefoc/Arduino-FOC)

读源码起点:src/common/base_classes/FOCMotor.cpp(loopFOC/move 定义处)、BLDCMotor.cpp(setPhaseVoltage 调制)、communication/Commander.cpp。

GitHub读源码

📘

ODrive 官方文档(docs.odriverobotics.com)

odrivetool、轴状态(axis states)、校准与控制接口说明(站点为 JS 渲染,请在浏览器打开);经典 v3.x 与新款 Pro/S1/Micro 资料分区。

官方文档配置必读

🔧

⭐ ODrive 固件与硬件仓库(odriverobotics/ODrive)

v3.x 固件(MIT)阅读地图:axis.cpp 轴状态机、motor.cpp 的 FOC_current、low_level.cpp 的 ADC 启动。README 注明 v3.x 已 NRND,新款固件未开源——引用时请以仓库当前版本为准。

GitHub⭐ 读源码起点中级

📘

VESC Project 官网(vesc-project.com)

VESC Tool 下载、硬件文档、社区论坛;官方定位从几十瓦云台到上百千瓦电航的全功率覆盖,滑板/机器人是主力场景。

官方站点大功率

🔧

VESC 固件仓库(vedderb/bldc · GPLv3)

阅读起点:motor/mcpwm_foc.c 的 ISR 电流环、applications/ 应用任务(app_canbus 等)、comm/ 通信层、ChibiOS RTOS。商用前务必确认 GPL 传染影响。

GitHub高级

📘

ST X-CUBE-MCSDK 产品页(st.com)

Motor Profiler 与一键整定、FOC 库、无感状态观测器、CubeMX 集成工作流的官方说明;免费下载(需走 ST 申请流程,专有许可以随包协议为准)。

官方站点产品化

📄

TI InstaSPIN-FOC 软件技术参考手册(SPRUHI9)

F2806xF 上 ROM 固化 FAST 估计器与软件架构的权威参考;配套 InstaSPIN 用户指南(SPRUHJ1)讲 Rs/L/磁链自辨识与无感调试全流程。

TI 官方无感深入

📄

TI InstaSPIN-MOTION 用户指南(SPRUHJ0)

F2806xM 上的完整无感 FOC 方案(FAST + 电流/速度环在片内 ROM)用户手册,与 SPRUHI9 互为补充。

TI 官方无感深入

🔧

⭐ MIT Cheetah-Software 仓库(mit-biomimetics · MIT 许可)

Cheetah 3 / Mini Cheetah 的整机控制与仿真开源栈(robot/sim/common);注意关节内电流环固件不在仓库内,但「MIT 模式」接口被产业广泛复刻。

GitHub⭐ 人形关节参照高级

📄

CubeMars AK60-6「MIT 模式」配置教程(官方)

以 AK 系列执行器为例演示 MIT 模式 CAN 配置与 C++ 控制——看「学术范式如何变成商业模组出厂功能」的最直接样本。

厂商教程实操

🎬

B站搜索:ODrive 教程

中文视频最集中的 ODrive 上手渠道:环境搭建、固件烧写、odrivetool 调参与 FOC 讲解(如「灯哥教你入门 ODrive」系列等)。

B站搜索视频

🎬

B站搜索:VESC 电机

VESC Tool 使用、电机参数检测、滑板/轮足改装的中文实操视频入口,配合第 4 节分层架构理解更顺。

B站搜索视频

💬

知乎搜索:SimpleFOC ODrive 对比(需浏览器打开)

中文社区对两个开源方案选型的实战讨论集;另一个值得搜的词是「电机控制框架」。注意甄别营销内容,以官方文档交叉验证。

知乎搜索社区讨论