STM32无刷电机FOC控制实战：硬件配置、算法实现与调试全解析

最近在折腾无刷电机 FOC 控制的朋友，应该多少刷到过“狗哥foc”这个作品。它不是什么花哨的 Demo，而是一套围绕 STM32 平台展开的 FOC 驱动方案，重点解决从开环跑起来到闭环稳住的完整过程。这次我们就顺着这个作品，把 FOC 无刷电机控制从硬件选型、工程配置、代码编写到调试验证的整条链路拆开讲一遍。

如果只对“能不能转”感兴趣，那直接看第 5 节的功能测试；如果你已经在调电流环、速度环但效果不理想，重点看第 6 节和第 8 节的排查方法；如果你打算做双电机或者想上 STM32G4 的 CORDIC 硬件加速，第 4 节和第 7 节值得细读。

这篇文章不会只讲概念，而是给出可直接落地的实验步骤、代码片段和调试工具链。读完你应该能自己搭一套最简单的 FOC 驱动实验环境，知道 PWM 定时器怎么触发 ADC 采样，知道双电阻采样的时序为什么关键，也知道无感方案里反电动势估算角度的基本思路。

1. FOC 项目核心能力速览

从“狗哥foc”这个作品中体现出的技术栈，基本覆盖了 FOC 控制从入门到工程化的几个关键环节。下面先用一张表把核心能力整理清楚。

能力项	说明
控制对象	三相无刷直流电机（BLDC）/ 永磁同步电机（PMSM）
MCU 平台	STM32F1/F4 入门，STM32G4、STM32H7 可获更强算力与硬件加速
典型控制架构	速度环 + 电流环双闭环，内环为 FOC 电流矢量控制
坐标变换	Clark 变换、Park 变换、逆 Park 变换、SVPWM 调制
电流采样	双电阻采样或单电阻采样，定时器触发 ADC 同步采样
角度获取	有传感器：编码器 / 磁编码器；无传感器：反电动势观测器估算
调制方式	SVPWM 七段式 / 五段式，中心对齐 PWM
硬件加速	STM32G4 系列 CORDIC 外设可加速三角函数与部分 FOC 计算
开环功能	支持开环电压 / 开环频率牵引，用于验证 PWM 与电流采样通路
闭环功能	电流环 PI 调节、速度环 PI 调节、限幅与积分抗饱和
调试方式	虚拟串口打印、上位机波形监视、实时数据修改参数
双电机支持	通过采样组扫描双触发，可扩展双电机 FOC 控制
适用人群	嵌入式开发、电机控制入门、机器人 / 无人机 / 电动工具开发者

这里要明确一个点：FOC 不是某个开源仓库做出来的“功能”，而是一套控制算法体系。狗哥foc 作品的价值在于把 MCU 底层配置、采样时序、坐标变换、PI 调节器、观测器这些内容串成了一个可运行的完整工程。对于初学者来说，最有价值的不是直接抄代码，而是理解代码背后每个模块为什么存在。

2. FOC 能做什么：适用场景与使用边界

FOC 全称是 Field Oriented Control，磁场定向控制。它的核心思想是把三相交流电流通过坐标变换，等效成直轴和交轴两个直流分量，从而像控制直流电机一样控制永磁同步电机或无刷电机。这种控制方式带来的直接好处是：启动平稳、低速扭矩大、高速效率高、动态响应快。

适用场景非常明确：

• 机器人关节电机，需要低速大扭矩和位置控制。
• 无人机 / 航模电机，需要高效率和高动态响应。
• 电动工具、电动自行车轮毂电机，需要平稳启动和过载能力。
• 伺服系统、CNC 主轴、3D 打印机闭环改造。
• 大学生电子设计竞赛、自动化课程设计、FOC 算法学习验证。

FOC 不适合的场景也很清楚：

• 简单的通断控制。如果只是让电机转起来，不需要扭矩控制，用六步换相方波驱动更简单，成本更低。
• 极端低成本量产场景。FOC 需要至少一路电流采样 ADC、一个定时器产生互补 PWM、较大的 MCU 算力，单片成本高于方波驱动。
• 对实时性要求极高且 MCU 资源极其受限的场景。FOC 中断服务函数里有三角函数和坐标变换，老旧的 8 位单片机基本跑不动。

使用边界还包含合规问题。驱动电机时涉及供电电压、功率器件散热和机械防护。高压电机调试时必须使用隔离探头或低压安全供电，不要让旋转中的电机轴裸露，尤其在测试双电机或高转速场景时，要提前设定转速限幅和电流限幅。如果这个方案后续用到无人机、电动车辆等产品中，必须评估对应行业的安规和认证要求。

3. FOC 开发环境准备与硬件选型

3.1 硬件清单

搭建一套 FOC 实验环境，建议准备以下硬件。

硬件	推荐配置	说明
主控板	STM32F103 入门，STM32G431 进阶	G4 系列内置 CORDIC 和更高主频，适合 FOC
驱动板	三相全桥驱动，如 DRV8301、DRV8323、EG2134	集成栅极驱动和电流放大，降低搭建难度
电机	低压无刷电机，KV 值 100 到 1000，极对数已知	建议使用带编码器的版本，便于闭环验证
电源	可调直流稳压电源，12V 到 24V，带限流	调试初期限流 1A 到 2A，避免炸管
仿真器	ST-Link V2 或 DAP-Link	下载程序、在线调试、变量监视
电流采样	驱动板自带双电阻采样电路	采样电阻引出信号到 ADC 引脚

没有驱动板时，也可以用六颗 MOSFET 自己搭三相桥，但调试难度会明显上升，建议第一次接触 FOC 直接买集成驱动模块。

3.2 软件环境

软件部分需要这几样：

• STM32CubeMX，用于配置时钟、PWM 定时器、ADC 和串口。
• Keil MDK 或 STM32CubeIDE，用于编译和下载。
• 串口调试助手，用于查看打印信息和下发指令。
• 如果做波形观察，可以准备 Serial Studio 或 VOFA+，通过串口把电流、速度、角度数据绘成曲线。
• 如果是 STM32G4 系列，确认所用库支持 CORDIC 外设，FMAC 也可用于滤波运算。

3.3 理论知识准备

FOC 算法本身涉及的数学并不超纲。核心是几个变换公式。

Clark 变换把三相电流转换到两相静止坐标系：

I_alpha = Ia I_beta = (Ia + 2*Ib) / sqrt(3)

Park 变换把静止坐标系转换到旋转坐标系：

Id = I_alpha * cos(theta) + I_beta * sin(theta) Iq = -I_alpha * sin(theta) + I_beta * cos(theta)

逆 Park 变换则把电压指令从旋转坐标系转回静止坐标系，再交给 SVPWM 生成三相占空比。

“FOC 控制中有效磁链怎么计算”，这个问题在很多无感方案里会出现。有效磁链本质上是对反电动势积分得到的磁链估算值，用于构造转子位置观测器。工程中常用低通滤波器代替纯积分，避免积分漂移。公式层面可以理解成：

Flux_alpha = Integral(E_alpha) ≈ Integral(V_alpha - R*I_alpha - L*dI_alpha/dt) Flux_beta = Integral(E_beta) ≈ Integral(V_beta - R*I_beta - L*dI_beta/dt)

转子角度可以通过磁链分量的反正切或者锁相环获得。这也就是无感 FOC 中“用反电动势估算角度”的基本原理。

4. STM32 FOC 工程配置与启动流程

4.1 CubeMX 关键配置

FOC 的底层配置非常依赖定时器和 ADC 的配合。这里以常用的高级定时器 TIM1 为例。

先配置 PWM 输出：

• TIM1 的 CH1、CH2、CH3 作为三相上桥 PWM 输出。
• CH1N、CH2N、CH3N 作为三相下桥 PWM 输出。
• PWM 频率一般取 10kHz 到 20kHz，对应计数周期。
• 选择中心对齐模式，一边计数，方便在特定计数点触发 ADC 采样。
• 加入死区时间，防止上下桥直通。

电流采样是决定 FOC 控制质量的关键。双电阻采样模式下，ADC 触发时机必须和 PWM 开关状态严格对齐。常见的做法是使用定时器触发 ADC 注入组转换，在 PWM 中心点附近采样。

这里给出一个简化配置示例，实际引脚和分频系数以你的板子为准：

# TIM1 中心对齐模式，PWM 频率 20kHz，死区 1us TIM1_Clock = 72MHz TIM1_Prescaler = 0 TIM1_Period = 3600 TIM1_CounterMode = CenterAligned1 TIM1_OCMode = PWM TIM1_DeadTime = 72

注意，这只是配置思路，不是可直接导入的 CubeMX 文件。你必须根据 MCU 型号、时钟树和驱动芯片要求修改分频和死区参数。

ADC 配置：

• 使用 ADC1 的注入通道，转换通道对应驱动板输出的两个相电流。
• 触发源选择 TIM1_TRGO 或 TIM1_CH1，具体取决于你选择的 ADC 触发方式。
• 采样时间尽量短，但要保证信号稳定后再启动转换。

4.2 FOC 控制循环主体

控制循环通常在 PWM 更新中断或 ADC 转换完成中断里执行。一个标准的 FOC 循环包含以下步骤：

1. 读取电流采样值。
2. 进行电流校准，减去零漂。
3. 获取转子角度。无感方案则是通过观测器计算得到。
4. 执行 Clark 变换。
5. 执行 Park 变换。
6. 电流环 PI 调节，输出 Ud、Uq。
7. 逆 Park 变换，得到 U_alpha、U_beta。
8. SVPWM 计算三相占空比。
9. 更新比较寄存器。

下面是一个简化的 FOC 控制循环伪代码，展示主流程：

void FOC_ControlLoop(void) { // 1. 读取电流采样 float Ia = ADC_GetCurrentA(); float Ib = ADC_GetCurrentB(); float Ic = -Ia - Ib; // 三相平衡 // 2. 零漂校准 Ia -= current_offset_a; Ib -= current_offset_b; // 3. 获取角度：编码器或观测器 float theta = Get_Rotor_Angle(); // 4. Clark 变换 float I_alpha = Ia; float I_beta = (Ia + 2.0f * Ib) * 0.57735f; // 5. Park 变换 float cos_t = fast_cos(theta); float sin_t = fast_sin(theta); float Id = I_alpha * cos_t + I_beta * sin_t; float Iq = -I_alpha * sin_t + I_beta * cos_t; // 6. 电流 PI 调节，Id 目标通常为 0 float Ud = PI_Id_Controller(Id_ref - Id); float Uq = PI_Iq_Controller(Iq_ref - Iq); // 7. 逆 Park 变换 float U_alpha = Ud * cos_t - Uq * sin_t; float U_beta = Ud * sin_t + Uq * cos_t; // 8. SVPWM 生成占空比 SVPWM_Update(U_alpha, U_beta, &duty_a, &duty_b, &duty_c); // 9. 更新定时器比较值 TIM1->CCR1 = duty_a; TIM1->CCR2 = duty_b; TIM1->CCR3 = duty_c; }

如果使用 STM32G4 的 CORDIC 外设，可以把三角函数运算交给硬件执行，减少 CPU 开销。在 STM32H7 上则主要依赖更高的主频和 FPU，计算压力也不大。FOC 计算密集的部分主要在坐标变换和 PI 调节，这些在 G4 系列上通过 CORDIC 和 FPU 可以做到微秒级别完成。

4.3 开环牵引启动

刚写完代码不要急着闭环。先用开环方式验证 PWM 和电流采样通路。开环控制下不需要转子位置，直接输出一组旋转的电压矢量，让电机被强制牵引旋转。

开环启动的要点是频率缓慢上升，电压幅度同步上升。频率上升太快会失步，电压太低可能拖不动。可以在代码里用一个简单的斜坡函数：

float openloop_speed = 1.0f; // Hz float openloop_voltage = 0.2f; // 占空比幅度，从 0.2 倍开始 float openloop_angle = 0.0f; void OpenLoop_Tick(float dt) { openloop_speed += 1.0f * dt; // 每秒增加 1Hz，不超过目标速度 openloop_voltage += 0.5f * dt; openloop_angle += 2.0f * PI * openloop_speed * dt; float U_alpha = openloop_voltage * fast_cos(openloop_angle); float U_beta = openloop_voltage * fast_sin(openloop_angle); SVPWM_Update(U_alpha, U_beta, &duty_a, &duty_b, &duty_c); }

开环能平稳转起来，说明 PWM 极性、死区时间、驱动芯片使能、三相桥连接基本没问题。接下来才能进入电流采样校准和闭环调试。

5. FOC 功能测试与效果验证

5.1 测试前检查清单

在给电机上电之前，按这个清单逐项检查：

• PWM 极性是否正确。上下桥逻辑是否反了。
• 死区时间是否足够。过小会导致上下桥直通。
• ADC 采样通道是否对应实际电流采样电阻。
• 电流采样零漂是否记录。上电后电机静止，ADC 读到的电流值应接近 0。
• 电源限流是否设置。第一轮测试建议限制在额定电流的 20% 到 30%。

5.2 开环测试

测试目的：验证 PWM 输出、三相桥驱动、电机是否正常旋转。

操作步骤：

1. 烧录开环程序。
2. 串口发送启动指令，频率从 1Hz 开始缓慢上升。
3. 观察电机是否转动，转向是否正确，电流是否在合理范围。

预期结果：

• 电机平稳旋转，无剧烈抖动和啸叫。
• 三相电流大小接近，波形接近正弦。
• 电流幅值应在电源限流范围内。

判断成功的标准：电机能跟随设定频率旋转，停止指令后电机制动或自由停车。

常见失败：

• 电机不转，先检查使能引脚和 PWM 输出。用示波器看三相 PWM 波形。
• 电机抖动但不连续旋转，可能是两相接反，或开环电压过低。
• 电机啸叫严重，可能是 PWM 频率落在可听范围内，或开环频率步进太快。

5.3 电流采样测试

测试目的：验证双电阻采样时序和 ADC 数值是否可信。

操作步骤：

1. 电机静止时读取三路电流值，记录零漂。
2. 开环运行后，通过调试器或串口把电流值输出。
3. 对比示波器电流探头与代码读数的偏差。

预期结果：

• 静止时电流读数接近 0，误差在几十 mA 以内。
• 运行后电流读数随负载变化，呈现正弦变化趋势。

双电阻采样的关键点是采样点必须放在 PWM 中心对齐时刻。如果采样点不对，电流突变会导致采到毛刺值。FOC 代码中“定时器触发 ADC 采样”就是为这个目的服务。初始化时要把 ADC 触发配置成与 PWM 同步，不要在中断里随意延时后再采样。

5.4 电流环闭环测试

测试目的：验证 Park 变换、PI 调节器、SVPWM 正反馈通路是否工作正常。

操作步骤：

1. 手动给定 Iq_ref，Id_ref 设为 0。
2. 电机转子用手堵住或带一定负载。
3. 观察电流环响应，用上位机记录 Iq 波形。

预期结果：

• Iq 能快速跟随 Iq_ref，无明显震荡。
• Id 保持在 0 附近，说明坐标变换方向正确。
• 如果 Id 发散，大概率是电角度方向反了，交换两相线序，或调整编码器方向。

电流环 PI 参数可以先按经验式给一个初始值，再做微调：

float Kp_i = 0.5f; float Ki_i = 0.01f;

实际整定时，Kp 负责快速响应，Ki 负责消除稳态误差。Kp 太大会导致电流震荡，Ki 太大会导致低频振荡。观察电流波形是整定 PI 的直接手段，不要盲目抄别人的参数，电机电感、母线电压不同，最优参数差异很大。

5.5 无感角度估算测试

如果做无感 FOC，核心难点是“无感 FOC 如何获取反电动势来计算估算角度”。基本思路是：

• 通过电机模型和已知的电压、电流，估算反电动势。
• 对反电动势积分得到磁链，再估算电角度。
• 也可以用锁相环跟踪反电动势相位，得到连续角度和速度。

测试时重点观察：

• 低速和零速阶段，反电动势信号很小，观测器不稳定。这也是无感 FOC 普遍需要“开环启动 + 切换闭环”的原因。
• 切换时机太早，电机会抖动；切换太晚，可能过流。一般建议在额定转速的 5% 到 10% 后切入闭环。
• 观测器参数和电机电感、电阻参数强相关。电机参数不准，观测角度会偏移，表现为电流变大、效率降低、电机发热。

5.6 双电机采样测试

双电机 FOC 是一个进阶需求。材料中提到的“双电机采样组扫描双触发”，本质是让一个 MCU 交替处理两个电机的电流采样和控制循环。

实现思路是：

• ADC1 采样电机 A 的电流，ADC2 采样电机 B 的电流。
• 两个定时器分别产生两路 PWM，触发各自对应的 ADC 注入组。
• 控制循环可以用一个主循环轮询两个电机，也可以用 DMA 双缓冲分别存储两组采样值。
• 中断优先级要设计好，避免相互打断导致采样数据错乱。

双电机调试时，先把两个电机分别用开环跑通，再同时开环，最后分别切闭环。不要一上来就双闭环，否则两个电机的耦合问题会掩盖算法本身的问题。

6. FOC 调试接口、数据监视与上位机

6.1 虚拟串口打印数据

FOC 控制循环执行频率通常为 10kHz 到 20kHz。如果每个周期都往串口打印数据，串口带宽完全不够。工程上使用“低速打印”策略：控制循环里维护计数，每累计 100 次或 200 次，打印一次当前电流和速度值。

volatile uint16_t print_counter = 0; void FOC_ControlLoop(void) { // FOC 核心计算 ... if (++print_counter >= 200) { print_counter = 0; printf("Iq:%d.%03dA Id:%d.%03dA Speed:%d.%03d rad/s\r\n", (int)i_q, (int)(fabs(i_q) * 1000) % 1000, (int)i_d, (int)(fabs(i_d) * 1000) % 1000, (int)speed, (int)(fabs(speed) * 1000) % 1000); } }

6.2 上位机波形查看

只靠 printf 看数字，很难判断 PI 参数是否合适。建议用 VOFA+ 或 Serial Studio，把 Id、Iq、转速、电角度通过串口发上去，查看实时波形。

数据格式可以自定义，简单一点用 CSV：

id,iq,speed,angle 0.12,1.05,15.2,0.31

然后在上位机里配置对应的通道，就能看到动态响应。电流环是否震荡、速度环响应是否过快，一眼就能看出来。

6.3 参数在线修改

调试 PI 参数时反复烧录程序效率太低。建议把 PI 参数设计成可在线修改的变量，通过串口命令接收新值：

void UART_Command_Parse(uint8_t *buf, uint16_t len) { // 格式: "KPI 0.8" if (strncmp((char*)buf, "KPI", 3) == 0) { float val = atof((char*)(buf + 4)); Kp_i = val; } else if (strncmp((char*)buf, "KII", 3) == 0) { float val = atof((char*)(buf + 4)); Ki_i = val; } }

这样可以一边转电机一边调参数，效率提升非常明显。

7. FOC 资源占用与性能观察

FOC 对 MCU 资源的占用主要由三部分构成：PWM/ADC 外设资源、中断频率、主循环计算量。

ADC 和定时器资源：

• 一路 FOC 至少需要 1 个高级定时器、1 个 ADC、若干 DMA 通道。
• 双电阻采样需要 2 个 ADC 输入通道，推荐使用注入组，保证两个通道在同一时刻被采样。
• 双电机方案需要 2 个高级定时器、2 个 ADC 或 1 个 ADC 的多个注入组，加上 DMA 双缓冲。

CPU 占用：

• 10kHz 控制频率意味着控制循环每 100us 执行一次。
• 如果用 STM32F103 @ 72MHz，软件三角函数会占用较长时间，建议使用查表法或 CORDIC 软件实现。
• STM32G4 @ 170MHz 带硬件 CORDIC，坐标变换的计算时间明显降低，适合更复杂的无感观测器。
• STM32H7 @ 480MHz 算力更强，可以在一个芯片里跑双电机 FOC 加上位机通信、温度采样等任务。

性能观察方法：

• 用调试器查看控制循环执行时间，在 FOC_ControlLoop 入口翻转一个 GPIO，用示波器测高电平宽度。
• 观察中断响应时间，确认没有长代码阻塞 ADC 中断。
• 改用 DMA 搬运 ADC 数据，可以避免在中断里等待转换结果。

降低 CPU 占用的手段：

• 使用快速三角函数库，或者直接用 STM32G4 的 CORDIC。
• 使用浮点运算单元，不要在中断里使用 double。
• PI 调节器用增量式，减少积分项累积误差。
• 数据打印放到主循环，不要放在控制中断里。
• 无感观测器里的矩阵运算能简化的尽量简化，使用查表替代复杂函数。

8. 常见问题与排查方法

问题现象	可能原因	排查方式	解决方案
电机不转，PWM 无输出	定时器未启动 / 使能引脚低电平	示波器测 PWM 引脚、查 GPIO 配置	启动定时器 PWM 输出，拉高驱动使能
电机剧烈抖动	两相线序错误 / 电角度方向错误	交换任意两相，重测开环	调整线序或编码器方向
上桥和下桥直通发热	死区时间太小	示波器看互补 PWM 波形	增大死区时间，G4/F1 均需配置死区
电流采样值跳变严重	ADC 采样点与 PWM 不同步	双电阻采样波形时域分析	使用定时器触发 ADC 注入组采样
电流环发散	编码器方向反 / Park 变换符号错误	记录角度和电流波形	反转角度方向或调整线序
Id 不为 0 且无法收敛	相序不对或角度偏移	检查编码器零点偏移	标定编码器零点或加角度偏置
无感低速不稳定	反电动势信号过小	查看观测器估算角度和参考角度差异	采用开环启动加闭环切换策略
转速一高就啸叫	PWM 频率低或电流环参数偏大	增加 PWM 频率，降低 Kp	调整 PWM 到 20kHz 以上，重新整定电流环
串口打印卡死	中断优先级导致互锁	检查 UART 中断和 FOC 中断优先级	把控制中断优先级设为最高
运行一段时间电机发热	电流环参数差或 Id 不为 0	上位机看电流波形	检查坐标变换并整定电流环
双电机模拟量串扰	两个 ADC 采样通道共用参考地	示波器分别测两路信号	优化 PCB 布局，分开采样地线

9. FOC 工程化最佳实践与安全合规

从“能转”到“稳定跑”，中间差的往往是细节。下面这些经验适合直接用在 FOC 项目里。

第一，第一版程序要保守。上电前默认电流限幅为额定的 20%，转速限幅也设低一点。测试时手边放一个急停开关，出现啸叫或震荡立刻切断电源。FOC 调试过程中过流炸管大多数不是算法问题，而是参数给得太大。

第二，参数尽量集中管理。把电机参数、PI 参数、采样电阻值、母线电压放到一个结构体里，方便换电机时统一修改：

typedef struct { float rs; // 相电阻 float ls; // 相电感 float pole_pair; // 极对数 float bus_voltage; float current_limit; float speed_limit; float kp_i; float ki_i; float kp_speed; float ki_speed; } Motor_Config;

第三，保留一套最小可运行配置。每次调试用 Git 打标签，开环验证、电流环闭环、速度环闭环分别保存一份干净工程。不要在校验观测器的时候把开环代码删掉，出问题时很难回退。

第四，数据记录要有时间戳。上位机记录数据时，每一帧都带上 tick 值，方便定位问题是控制周期抖动还是外部扰动。调试中断执行时间时，GPIO 翻转配合示波器比仿真器变量更直观。

第五，安全合规不能省。涉及电机调试时，注意绝缘和机械防护。高压平台要使用隔离电源、隔离探头，严禁带电操作接线。电池供电设备要加保险丝和反接保护。如果后续产品化，需要通过对应市场的安规、EMC、RoHS 等要求。不要在产品发布时省掉这些环节。

第六，涉及他人开源代码、驱动板原理图、电机参数表时，注意版权和授权。培训机构或教程里给出的代码可以在学习时参考，但商用前要确认许可证。不要直接拿别人未开源的东西做商业产品。

10. 总结与下一步

这次从狗哥foc 的作品出发，把 FOC 无刷电机控制的技术链路完整梳理了一遍。最值得先验证的不是闭环算法，而是开环转起来之后，电流采样数据是否可信。采样时序不对，后面所有闭环调试都会变成玄学。最先要跑通的也是开环牵引，这是最基础的信号链路检查。

最容易踩的坑有两个：一个是 PWM 死区配置，另一个是采样点与 PWM 不同步。这两个问题不会让程序崩溃，但会让电流波形难看、电机发热严重、PI 参数怎么调都调不好。遇到这类问题时，不要先怀疑算法，先拿示波器看波形。

后续可以继续扩展的方向：

• 把单电机 FOC 扩展到双电机，验证采样组扫描双触发机制。
• 在 STM32G4 上启用 CORDIC，对比软件三角函数和硬件加速的性能差异。
• 在 STM32H7 上跑更复杂的无感观测器，例如滑模观测器或龙贝格观测器。
• 增加位置环，把 FOC 应用到关节伺服控制。
• 把电流环、速度环、位置环全部模块化，接入 ROS 或串口指令控制。

最后留一个建议：调试 FOC 时准备一个笔记本，每次修改参数、每次波形异常都做记录。这个习惯在排查零漂、方向、采样时序这类看似不起眼的问题时，能省掉大量重复劳动。接下来就看你怎么把这套流程在自己的板子上跑通了。