大家好欢迎来到《手把手带你学 FOC》系列第十二期。前面的章节中我们花了不少篇幅介绍 Clark 变换、Park 变换、SVPWM、PID 电流环、速度环等核心概念。不少同学反馈理论看了不少公式也推了很多但是一到写代码就不知道从哪里下手更不知道如何让电机真正转起来。这一期我们换一个思路先不追求“完美的磁场定向控制”而是从 FOC 中一个非常基础但极其重要的环节入手——电机开环控制。通过本文你将理解什么是电机开环控制它的本质是什么。开环控制在 FOC 体系中处于什么位置。如何手写一个最简单的 FOC 开环控制代码V/F 开环与 I/F 开环。为什么开环控制是学习无感 FOC 的必经之路。开环控制常见问题与排查方法。这篇内容适合刚接触 FOC、对电机控制感兴趣的同学也适合那些已经能跑通 SVPWM 但不知道怎么生成旋转磁场的嵌入式开发者。代码以 STM32 平台为例但思路完全通用。1. 什么是电机开环控制1.1 开环控制的基本概念控制领域谈到“开环”与“闭环”最直观的区别是系统是否存在反馈通道。开环控制是指系统的输出不会影响控制作用即给定一个输入控制器按预设的规律执行不关心实际执行结果是否与期望一致。举个例子开环控制你设定电机转速 1000 RPM控制器输出一个对应占空比的 PWM电机的实际转速可能只有 800 RPM也可能因为负载变化降到 500 RPM但控制器不会感知这一点。闭环控制控制器通过编码器或观测器获取实际转速与目标值比较再调整输出使转速稳定在 1000 RPM 附近。对于直流有刷电机开环控制只是输出一个固定的 PWM 占空比非常简单。但对于无刷电机BLDC/PMSM尤其是采用 FOC 控制的电机开环控制却不那么直观——你不仅要给定电压大小还要给定电压矢量的方向而且这个方向要随着转子位置或时间变化。1.2 FOC 中的开环控制是什么在 FOC 中电流矢量由直轴电流 Id 和交轴电流 Iq 构成。正常闭环运行时Id 和 Iq 是通过电流采样与 Clark/Park 变换获得的实际值再经过 PI 调节得到 Ud 和 Uq。而开环控制下我们直接给定 Ud 和 Uq不依赖电流反馈也不依赖转子位置反馈。为了让电机旋转起来我们需要让电压矢量在空间中旋转。在 FOC 的坐标系中这意味着需要让 Uq 对应的电角度 θ 随时间线性增加。这个过程可以理解为给定一个恒定的电压幅值。让电压矢量的角度按照设定的速度增量递增。将旋转的电压矢量通过逆 Park 变换、SVPWM 输出到三相桥臂。这里要特别注意开环 FOC 并不需要对转子实际位置进行检测而是“假设”转子处于一个预设的电角度位置。这是一种典型的 V/F电压/频率控制思路在异步电机调速中很常见在同步电机PMSM中也有应用但前提是负载不能太大、加减速不能太激进否则会失步。1.3 为什么要学习开环控制很多初学者会觉得FOC 不就是要闭环吗学开环有什么意义实际上开环控制是 FOC 调试过程中一个非常实用的中间步骤验证硬件链路开环控制不需要编码器和电流环参与可以快速确认逆变器、驱动芯片、MOS 管、电机三相接线是否正常。验证 SVPWM 输出在开环控制中SVPWM 输出的相电压波形直接影响电机旋转如果三相波形有问题会直接影响后续闭环调试。验证采样电路虽然开环不需要电流环参与输出电压但要想后续闭环必须确认电流采样电路是否正常。开环运行期间可以通过采样电流波形判断采样电路是否良好。摸清电机参数通过开环运行可以估算电机极对数、相电阻、反电动势系数等基础参数。无感 FOC 启动的前置环节无感 FOC 在零速或低速阶段通常采用 I/F 开环启动强制换相把转子拉到一定转速后再切入无感观测器闭环。所以开环控制不是“不重要的过渡方案”而是 FOC 工程实践中不可缺少的调试工具。2. 开环控制分类V/F 开环与 I/F 开环在 FOC 实际工程中开环控制通常有两种实现思路它们对应的控制量和适用场景不同。2.1 V/F 开环控制电压-频率控制V/F 控制又称恒压频比控制是最传统的开环调速方式。核心思想是保持电压幅值 V 与输出频率 f 的比值恒定。在 FOC 表达中假设我们不给 Id只给 Iq 对应的电压 Uq_ref同时保持 Ud_ref 0那么施加到电机上的合成电压矢量的幅值就等于 Uq_ref其旋转角度由设定频率决定电角度 θ 随时间递增θ θ₀ ∫ω dt其中 ω 2πf。Uq_ref 按一定比例随转速增大避免低速时电流过大、高速时电压不足。输出电压矢量始终超前或同步于转子位置依赖于负载角。V/F 开环的优点实现简单不需要电流采样。稳态运行时力矩输出平稳。对负载变化敏感度较低只要不超出极限。V/F 开环的缺点低速时定子压降不可忽略恒定 V/F 会导致励磁不足必须做电压补偿。突加负载时可能失步。无法精确控制转矩。2.2 I/F 开环控制电流-频率控制I/F 控制全称 Current-Frequency Control也叫“电流频率控制”。核心思想是保持电流矢量幅值恒定通过控制电流矢量的旋转速度来驱动转子。在 FOC 算法中通常做法是给定 Iq_ref 为额定电流或某个设定值Id_ref 0。电流环 PI 仍然工作确保实际 Iq 跟踪 Iq_ref。电流矢量的电角度由程序自动递增斜坡给定不依赖反馈位置。电机在电流矢量的牵引下旋转。这里有一个细节I/F 控制中电流环是闭环的但位置环角度是开环的所以整体仍属于开环控制。为什么电流环闭环了还算开环因为角度是程序预估的不是实际转子位置。如果转子位置和电流矢量位置偏差过大电机会失步。电流环只是保证电流幅值按给定值但不能保证转子跟随电流矢量旋转。I/F 控制的优点启动过程可控性强电流幅值限制方便。不容易过流保护效果好。是很多无感 FOC 算法低速启动阶段的标准方案。I/F 控制的缺点需要电流采样和电流环。负载扰动较大时可能失步。从开环切换到闭环时需要处理角度平滑切换的问题。2.3 本文选择哪种方案为照顾零基础读者本文先用V/F 开环控制演示完整代码流程因为代码最少、最容易理解。在此基础上补充 I/F 开环的升级思路。在后面的篇幅中我会按这个顺序展开手写一个最简 V/F 开环控制只靠 SVPWM 定时器中断。结合电流采样实现 I/F 开环。给出常见问题排查表和调试建议。3. 环境准备与硬件基础在写代码之前先说清楚运行环境。3.1 硬件清单本文示例需要以下硬件STM32 开发板F103 系列即可满足教学需求建议使用 F103C8T6 最小系统板三相全桥逆变电路可以使用集成的驱动芯片如 DRV8301、EG2134、IR2101 等直流无刷电机PMSM带霍尔或不带都可以开环阶段不需要霍尔没有电机时用三相电阻负载也能测试 SVPWM 波形直流稳压电源建议电压 12V~24V电流至少 2AUSB-TTL 串口模块用于日志输出逻辑分析仪或示波器推荐用于观察 PWM 波形和相电流波形3.2 软件环境Keil MDK 或 STM32CubeIDESTM32CubeMX用于初始化工程也可以手写寄存器串口调试助手3.3 核心概念复习电角度与机械角度在 FOC 中我们处理的电角度 θ 与电机的机械角度之间满足θe θm * 极对数其中 θe 是电角度θm 是机械角度极对数即电机转子上磁极的对数。对于开环控制电角度不是测出来的而是按照目标电角速度直接累加得到的。设定目标机械转速为speed_rpm极对数为pole_pairs则电角速度ωe 2π * (speed_rpm / 60) * pole_pairs每次控制周期例如 PWM 周期 10kHz更新一次电角度θe ωe * Ts下面这段代码就是整个开环 FOC 的“引擎”。版本说明不同 STM32 系列的外设库有所差异本文代码基于 HAL 库编写使用定时器更新中断作为控制周期重点代码可直接移植。4. 开环 FOC 算法详细拆解4.1 整体控制框图开环 FOC 的控制流程如下不需要编码器、不需要电流环目标转速 - 斜坡函数 - 电角速度 ωe | v 电角度累加 θe | v 给定 Uq_ref Ud_ref0 - 逆 Park 变换 - Uα/Uβ | v SVPWM 计算 | v 更新三个比较寄存器 - 三相桥臂输出如果加上电流采样和电流环则会变为 I/F 开环目标电流 Iq_ref Id_ref0 - 电流环 PI - Ud/Uq | v 电角度累加 θe - 逆 Park 变换 - SVPWM - 三相桥 ^ | 电流采样 Clark/Park4.2 电角度累加的实现在 FOC 中电角度的计算决定了电压矢量的旋转速度。使用一个 32 位变量累加电角度并做了归一化到[0, 2π)的处理。// 文件路径user/foc_openloop.h #ifndef __FOC_OPENLOOP_H #define __FOC_OPENLOOP_H #include main.h #define POLE_PAIRS 7 // 电机极对数按实际电机修改 #define CTRL_FREQ 10000 // 控制频率 10kHz与定时器中断周期一致 #define CTRL_PERIOD (1.0f / CTRL_FREQ) #define MATH_PI 3.14159265358979323846f #define TWO_PI (MATH_PI * 2.0f) typedef struct { float speed_rpm; // 目标转速 单位RPM float speed_ref_rpm; // 经过斜坡函数后的转速 float angle; // 当前电角度 单位rad float angle_speed; // 电角速度 单位rad/s float uq; // q 轴电压给定 float ud; // d 轴电压给定 } FOC_OpenLoop_Handle; void FOC_OpenLoop_Init(FOC_OpenLoop_Handle *h); void FOC_OpenLoop_SetSpeed(FOC_OpenLoop_Handle *h, float rpm); void FOC_OpenLoop_Run(FOC_OpenLoop_Handle *h); #endif对应的实现文件// 文件路径user/foc_openloop.c #include foc_openloop.h #include math.h static float ramp_speed 0.0f; static float target_speed 0.0f; // 初始化开环控制句柄 void FOC_OpenLoop_Init(FOC_OpenLoop_Handle *h) { h-speed_rpm 0.0f; h-speed_ref_rpm 0.0f; h-angle 0.0f; h-angle_speed 0.0f; h-uq 0.0f; h-ud 0.0f; } // 设置目标转速 void FOC_OpenLoop_SetSpeed(FOC_OpenLoop_Handle *h, float rpm) { target_speed rpm; } // 斜坡函数限制转速变化率防止加速度过大导致失步 static void SpeedRamp(void) { float max_acc 2000.0f; // 最大加速度 RPM/s float delta max_acc * CTRL_PERIOD; if (target_speed ramp_speed) { ramp_speed delta; if (ramp_speed target_speed) { ramp_speed target_speed; } } else if (target_speed ramp_speed) { ramp_speed - delta; if (ramp_speed target_speed) { ramp_speed target_speed; } } } // 开环 FOC 运行函数每个控制周期调用一次 void FOC_OpenLoop_Run(FOC_OpenLoop_Handle *h) { // 1. 斜坡更新实际参考转速 SpeedRamp(); h-speed_ref_rpm ramp_speed; // 2. 电角速度 2π * (rpm / 60) * 极对数 h-angle_speed TWO_PI * (h-speed_ref_rpm / 60.0f) * POLE_PAIRS; // 3. 电角度累加 h-angle h-angle_speed * CTRL_PERIOD; if (h-angle TWO_PI) { h-angle - TWO_PI; } if (h-angle 0.0f) { h-angle TWO_PI; } // 4. 开环电压给定低速时补偿定子压降简单实现为比例关系 // 本例中目标转速低于 300RPM 时Uq 最小为 0.5V高于后线性增加 float voltage_pc 0.12f; // 每 RPM 电压增益需要根据母线电压和电机参数调整 h-uq 0.5f h-speed_ref_rpm * voltage_pc; h-ud 0.0f; if (h-speed_ref_rpm 1.0f) { h-uq 0.0f; } }这段代码做了三件事通过斜坡函数让电机缓慢加速。将目标转速换算成电角速度累加电角度。根据转速生成 q 轴电压给定。ramp_speed和target_speed使用静态变量简单起见不再封装进结构体。实际工程中建议都放入结构体以避免多个电机实例冲突。4.3 逆 Park 变换实现有了电角度 θe 和 Ud/Uq 给定值之后我们需要将旋转坐标系下的电压转换到静止两相坐标系下Uα Ud * cosθ - Uq * sinθ Uβ Ud * sinθ Uq * cosθ逆 Park 变换在 FOC 中的作用是把人为给定的旋转电压矢量投影到两相静止坐标系上方便后续 SVPWM 生成三相占空比。// 文件路径user/park.c #include park.h #include math.h void InvParkTransform(float angle, float ud, float uq, float *ualpha, float *ubeta) { float sin_a sinf(angle); float cos_a cosf(angle); *ualpha ud * cos_a - uq * sin_a; *ubeta ud * sin_a uq * cos_a; }小提示在嵌入式环境中sinf和cosf比sin/cos更快。如果对性能要求极高可以用查表法替代三角运算。角度需要保证在[0, 2π)范围内避免浮点精度问题。4.4 SVPWM 生成与输出SVPWM 是 FOC 最终输出三相 PWM 波形的方法。这里直接给出常用的七段式 SVPWM 实现。需要注意的是不同 MCU 的定时器排列方式不同需要将三个比较值映射到对应的通道上。// 文件路径user/svpwm.c #include svpwm.h #define SECTOR_1 1 #define SECTOR_2 2 #define SECTOR_3 3 #define SECTOR_4 4 #define SECTOR_5 5 #define SECTOR_6 6 #define SQRT3 1.73205080756887729352f static float NormalizeSVPWM(float x, float min_val, float max_val) { return (x - min_val) / (max_val - min_val); } void SVPWM_Calc(float ualpha, float ubeta, float ubus, SVPWM_Handle *out) { float u1 ubeta; float u2 -0.5f * ubeta 0.8660254f * ualpha; float u3 -0.5f * ubeta - 0.8660254f * ualpha; uint8_t sector 0; if (u1 0) sector | (1 0); if (u2 0) sector | (1 1); if (u3 0) sector | (1 2); float x ubeta; float y 0.5f * ubeta 0.8660254f * ualpha; float z 0.5f * ubeta - 0.8660254f * ualpha; float t1 0.0f, t2 0.0f; switch (sector) { case 3: t1 z; t2 y; break; case 1: t1 y; t2 -x; break; case 5: t1 -z; t2 x; break; case 4: t1 -x; t2 z; break; case 6: t1 x; t2 -y; break; case 2: t1 -y; t2 -z; break; default: break; } float ts 1.0f / 10000.0f; // PWM 周期 100us对应 10kHz t1 t1 / ubus * ts; t2 t2 / ubus * ts; // 限制占空比在安全范围内 float t_min 0.0005f * ts; float t_max 0.9995f * ts; if (t1 0.0f) t1 0.0f; if (t2 0.0f) t2 0.0f; if (t1 t_max) t1 t_max; if (t2 t_max) t2 t_max; float t0 ts - t1 - t2; if (t0 0.0f) t0 0.0f; float ta t0 * 0.5f; float tb ta t1 * 0.5f; float tc tb t2 * 0.5f; if (sector 3) { out-duty_a ta; out-duty_b tb; out-duty_c tc; } else if (sector 1) { out-duty_a tb; out-duty_b ta; out-duty_c tc; } else if (sector 5) { out-duty_a tc; out-duty_b ta; out-duty_c tb; } else if (sector 4) { out-duty_a tc; out-duty_b tb; out-duty_c ta; } else if (sector 6) { out-duty_a tb; out-duty_b tc; out-duty_c ta; } else if (sector 2) { out-duty_a ta; out-duty_b tc; out-duty_c tb; } }这里对几个关键参数做解释ubus母线电压。SVPWM 计算周期时间时要把输出电压标幺化到开关周期上。tsPWM 周期。它必须与控制周期一致否则电流波形异常。t_min和t_max防止占空比过小或过大导致采样窗口死区。4.5 更新 PWM 比较寄存器在 STM32 HAL 库中通常使用高级定时器 TIM1 或 TIM8 输出互补 PWM。可以在中断中直接修改寄存器// 文件路径user/motor_pwm.c #include motor_pwm.h #include svpwm.h static TIM_HandleTypeDef *pwm_tim; void MotorPWM_Init(TIM_HandleTypeDef *htim) { pwm_tim htim; HAL_TIM_PWM_Start_IT(htim, TIM_CHANNEL_1); HAL_TIM_PWM_Start_IT(htim, TIM_CHANNEL_2); HAL_TIM_PWM_Start_IT(htim, TIM_CHANNEL_3); } void MotorPWM_Update(SVPWM_Handle *h) { uint32_t ccr1 (uint32_t)(h-duty_a * (pwm_tim-Instance-ARR 1)); uint32_t ccr2 (uint32_t)(h-duty_b * (pwm_tim-Instance-ARR 1)); uint32_t ccr3 (uint32_t)(h-duty_c * (pwm_tim-Instance-ARR 1)); __HAL_TIM_SET_COMPARE(pwm_tim, TIM_CHANNEL_1, ccr1); __HAL_TIM_SET_COMPARE(pwm_tim, TIM_CHANNEL_2, ccr2); __HAL_TIM_SET_COMPARE(pwm_tim, TIM_CHANNEL_3, ccr3); }在开环控制的整个调用链中控制周期的任务非常简单// 定时器更新中断回调 void HAL_TIM_PeriodElapsedCallback(TIM_HandleTypeDef *htim) { if (htim-Instance TIM1) { static FOC_OpenLoop_Handle foc {0}; static SVPWM_Handle svpwm {0}; static uint32_t cnt 0; float ualpha 0.0f, ubeta 0.0f; // 开环 FOC 核心计算 FOC_OpenLoop_Run(foc); // 逆 Park 变换 InvParkTransform(foc.angle, foc.ud, foc.uq, ualpha, ubeta); // SVPWM SVPWM_Calc(ualpha, ubeta, VBUS_VOLTAGE, svpwm); // 更新比较寄存器 MotorPWM_Update(svpwm); } }到此一个最简的开环 FOC 已经可以驱动电机旋转了。只要电源、驱动板、电机连接正确当程序运行后电机会按照设定转速缓慢启动并保持旋转。5. 实战跑通开环控制接下来我们从零搭建一个完整可运行的示例以 STM32F103 为例演示从初始化到电机转动的全过程。5.1 创建项目结构推荐在 STM32CubeMX 中初始化定时器和 GPIO然后手动添加以下文件User/ ├── main.c ├── foc_openloop.c ├── foc_openloop.h ├── park.c ├── park.h ├── svpwm.c ├── svpwm.h └── motor_pwm.c └── motor_pwm.hSTM32CubeMX 配置要点TIM1 输出三相互补 PWM频率 10kHz。启用 TIM1 更新中断。ADC1 三通道采集相电流I/F 开环需要V/F 阶段可以先不接。串口 1 用于变量调试输出转速、电角度、电流等。5.2 完整主程序示例下面给出一个精简可运行版本方便快速验证。// 文件路径main.c 核心片段 #include main.h #include foc_openloop.h #include park.h #include svpwm.h #include motor_pwm.h TIM_HandleTypeDef htim1; UART_HandleTypeDef huart1; FOC_OpenLoop_Handle foc; uint8_t start_flag 0; void SystemClock_Config(void); static void MX_GPIO_Init(void); static void MX_TIM1_Init(void); static void MX_USART1_UART_Init(void); int main(void) { HAL_Init(); SystemClock_Config(); MX_GPIO_Init(); MX_TIM1_Init(); MX_USART1_UART_Init(); FOC_OpenLoop_Init(foc); MotorPWM_Init(htim1); // 设定目标转速为 300RPM开环启动 FOC_OpenLoop_SetSpeed(foc, 300.0f); HAL_TIM_Base_Start_IT(htim1); while (1) { // 串口打印调试信息10Hz uint8_t msg[64]; int len snprintf((char *)msg, sizeof(msg), speed%.1f ang%.3f uq%.2f\r\n, foc.speed_ref_rpm, foc.angle, foc.uq); HAL_UART_Transmit(huart1, msg, len, 100); HAL_Delay(100); } }这里使用了更合理的命名控制频率通过定时器更新中断保证主循环中只做串口打印和系统任务。5.3 如何验证开环控制是否正确方法一电机旋转测试把目标转速设为 200 RPM上电后观察电机是否缓慢旋转。如果电机不转检查三相接线是否松动母线电压是否过低。如果电机振动或抖动说明三相 PWM 波形有问题重点检查 SVPWM 的扇区计算和比较值映射顺序。方法二示波器观察相电压用示波器探头测量电机任一相相对于直流母线负极的波形正常情况应看到一系列宽度变化的 PWM 脉冲频率为 10kHz脉冲宽度呈正弦变化规律。方法三测量相电流在 V/F 开环阶段如果已经并联采样电阻可以观察相电流波形。正常情况应为近似正弦波频率与电角速度对应。如果电流为零或严重畸变说明 PWM 输出策略有问题。5.4 开环控制预期波形当目标转速为 600 RPM、极对数为 7 时电角速度2π * (600/60) * 7 ≈ 439.8 rad/s对应电频率439.8 / (2π) ≈ 70 HzSVPWM 输出基波频率约为 70Hz相电流波形的频率也为 70Hz通过这个现象可以反向验证程序中的极对数配置是否正确。6. 进阶I/F 开环的实现思路当 V/F 开环跑通之后下一步可以尝试 I/F 开环。I/F 开环与 V/F 开环的差异在于I/F 需要电流环参与控制电流给定值由外部指定而不是由电压直接决定。6.1 I/F 开环的控制结构I/F 开环在本质上是一个“电流闭环 角度开环”的混合控制方式。控制框图如下给定 Iq_ref Id_ref0 - 电流环 PI - Ud/Uq | v 程序累加电角度 θe - 逆 Park 变换 - SVPWM - 三相桥 ^ | 电流采样 Clark/Park注意此时角度不是来自编码器或观测器而是程序强制生成的。因此控制系统对负载扰动没有直接抵抗能力需要限制加速度和最大负载。6.2 I/F 开环的电流环设计在电流环中Id 和 Iq 两个轴分别使用 PI 控制器Id 轴目标是 0用于维持磁链方向与 d 轴一致。Iq 轴目标是给定电流值用于产生转矩。其中电流采样和 Clark/Park 变换是关键。Clark 变换需要采集至少两相电流通过I_c -I_a - I_b求第三相Park 变换则需要使用当前的程序电角度 θe。// 电流环 PI 计算示例 void CurrentLoop_PI(CurrentLoop_Handle *h) { // Id 轴 float err_d h-id_ref - h-id_fb; h-ud h-kd_p * err_d h-ki_d * h-integral_d; // 积分限幅 if (h-ud h-max_ud) h-ud h-max_ud; if (h-ud -h-max_ud) h-ud -h-max_ud; h-integral_d err_d * h-ki_d * CTRL_PERIOD; // Iq 轴同理 float err_q h-iq_ref - h-iq_fb; h-uq h-kq_p * err_q h-ki_q * h-integral_q; if (h-uq h-max_uq) h-uq h-max_uq; if (h-uq -h-max_uq) h-uq -h-max_uq; h-integral_q err_q * h-ki_q * CTRL_PERIOD; }6.3 I/F 开环中的电角度更新电角度的更新方式与 V/F 类似但有一个重要区别在 I/F 开环中我们既可以说“角度是预估的”也可以说“电流矢量始终超前或滞后转子一个功率角”。由于没有反馈功率角不可控。如果负载力矩过大功率角增大超过 90° 后电机就会失步。因此 I/F 开环一般用于空载或轻载启动阶段在进入中高速后必须无缝切换到闭环控制。6.4 I/F 开环的调试建议开始时将 Iq_ref 设为 0.2 倍额定电流观察电机是否平稳旋转。逐渐增大 Iq_ref如果电机抖动加剧说明电流环参数不合适。电角度的递增速率应平缓建议搭配斜坡函数。从工程角度看I/F 开环可以看成是无感 FOC 低速启动的一种落地方式。7. 常见问题与排查方法在实际调试开环 FOC 的过程中大家经常遇到的问题基本集中在下面几个方向。这里整理成一张排查表便于快速定位。问题现象常见原因解决思路电机不转母线电压未建立或使能信号异常测量母线电压检查驱动芯片使能引脚电机不转PWM 频率设置不当MOS 管未正常开关用示波器检查 PWM 输出波形确认频率为 10kHz 左右电机不转SVPWM 比较值映射通道错误检查扇区到占空比的映射顺序是否与三相接线一致电机振动且电流大三相接线相序错误交换任意两相相序测试电机启动时抖动后来停转目标转速设置过低初始电压不足提高 V/F 曲线中的最低电压补偿电机高速时失步加速度过大或负载超过转矩上限降低斜坡加速度或增大输出电流限制电机突然反转SVPWM 扇区计算错误检查坐标系定义是否一致确认 Uα/Uβ 符号正确相电流波形畸变采样电阻信号有噪声或采样时刻不对检查 PWM 中心对齐采样确保在低边导通时采样以下对几个高频问题做扩展说明。7.1 电机不转但 PWM 正常输出如果示波器上可以看到三相 PWM 波形但电机仍不转很大概率是母线电压没有到达电机端。例如驱动芯片没有使能或者 MOSFET 栅极驱动电压不足。此外还需要确认电机三相是否已经连接到驱动板的 U、V、W 输出端而不是直接接了电源和地。7.2 电机抖动但电流不大这种现象通常说明电压矢量已经在旋转但电机定子磁场与转子之间没有建立起有效的同步关系。可能原因包括极对数设置错误。例如电机实际为 7 对极代码配置成了 4 对极电角度转速不正确。初始电压太小无法克服齿槽转矩。相序错误导致磁场方向与预期相反。解决方法是确认电机极对数可以通过反电动势测量法合理设置最低启动电压然后依次交换两相测试。7.3 开环控制时 Uq 如何计算V/F 开环中Uq 不能一直固定否则低速时电流过大、高速时输出不足。比较常用的方式是Uq Uq_min speed_rpm * K_v其中Uq_min 为克服定子电阻压降和齿槽转矩的最小电压一般在 0.3V~1V 之间。K_v 为电压增益与母线电压、电机额定电压有关。实际调试时可以通过小步长增加 K_v 并观察相电流是否平滑来标定。7.4 开环 FOC 的电流采样很多初学者在开环阶段就想把电流采样接上这个方向是对的。开环阶段做电流采样可以为后续闭环打基础。但要注意FOC 电流采样通常是在 PWM 周期的中心点附近进行因为此时下桥臂导通采样电阻上的电压最稳定。如果采样时刻不对波形会严重畸变。这也是热搜词“FOC 电流采集为什么要设置在下桥”对应的核心问题下桥采样与 PWM 中心对齐能保证在一个周期内采样到真实的相电流瞬时值。8. 从开环控制走向闭环控制开环控制是 FOC 学习路径上重要的里程碑但它并不是终点。从工程实践角度来看我建议按以下路线过渡到闭环。8.1 第一步硬件与采样链路验证在开环控制阶段务必确认以下事项正常三相 PWM 波形正常互补信号无直通。ADC 采样链路正常可以读到稳定的相电流值。Clark/Park 变换在给定电角度下能正确还原电流值。8.2 第二步调试电流环开环控制跑通后先不要急着切速度环而是优先调试电流环。具体做法将 Id_ref 设为 0Iq_ref 设为一个小电流。给定一个固定的程序电角度手动旋转电机转子。观察电流环输出的 Ud/Uq 波形是否平稳。当定子电流能稳定跟踪给定值时再考虑加入速度环和位置估算。8.3 第三步学习无感 FOC 的启动策略在无感 FOC 中转速为零或较低时通常无法获得可靠的反电动势信息所以需要采用开环启动。这一阶段往往使用 I/F 或 V/F 开环将电机拉到一个可观测反电动势的速度如额定转速的 5%~10%然后切入状态观测器如滑模观测器 SMO、龙伯格观测器或模型参考自适应 MRAS闭环。本文写的开环控制正是这个“拉高速”动作的实现基础。8.4 第四步处理开环到闭环的切换从开环切换到闭环时如果角度和电流突变会引起力矩波动严重时导致过流或失步。工程上通常有以下处理办法在切换前保持电压矢量角度连续平滑过渡。切换瞬间将速度环积分清零。先切换到电流闭环再投入速度环。使用“软切换”策略让开环角度与观测器角度之间的差值逐渐收敛。这些内容属于 FOC 进阶难点在后续文章中会详细展开本期先做到“跑通开环”后续逐步深化。9. 总结与下一步学习建议开环控制看起来简单但它涉及的知识链条一点都不短SVPWM、逆 Park 变换、电角度累加、V/F 与 I/F 控制策略、PWM 更新机制等。任何一个环节出错电机都无法正常旋转。通过本期内容大家应当掌握以下关键能力理解 V/F 开环控制与 I/F 开环控制的核心差异。能在 STM32 上实现最简单的 V/F 开环 FOC从设定目标转速到输出三相 PWM。能利用示波器、串口、相电流波形判断开环控制是否正常。知道开环控制在无感 FOC 体系中的意义为后续切入电流环、速度环、观测器打好基础。接下来的学习路线建议补充电流采样电路的学习弄懂单电阻、双电阻、三电阻采样的差异。动手调通电流环 PI 参数掌握 Id0 控制模式。理解 Clarke 变换中为什么只需要两相电流以及具体选择哪两相。深入了解无感 FOC 堵转检测、转子初始位置检测、弱磁控制等进阶方案。如果你已经可以做到开环电机稳定旋转说明 SVPWM 和定时器中断链路已经通了接下来就是在这个基础上叠加采样、Clark/Park、PI 调节、观测器逐步把“开环”升级成“闭环”。代码调试中如果遇到问题欢迎对照本文的排查表一步步定位。电机控制没有捷径但每排除一个异常都会对整体原理有更深的理解。如果这篇文章对你有帮助建议收藏备用后续我会继续更新 FOC 系列逐步深入无感控制的核心算法与工程实现。
FOC开环控制从入门到实战：V/F、I/F实现与调试指南
大家好欢迎来到《手把手带你学 FOC》系列第十二期。前面的章节中我们花了不少篇幅介绍 Clark 变换、Park 变换、SVPWM、PID 电流环、速度环等核心概念。不少同学反馈理论看了不少公式也推了很多但是一到写代码就不知道从哪里下手更不知道如何让电机真正转起来。这一期我们换一个思路先不追求“完美的磁场定向控制”而是从 FOC 中一个非常基础但极其重要的环节入手——电机开环控制。通过本文你将理解什么是电机开环控制它的本质是什么。开环控制在 FOC 体系中处于什么位置。如何手写一个最简单的 FOC 开环控制代码V/F 开环与 I/F 开环。为什么开环控制是学习无感 FOC 的必经之路。开环控制常见问题与排查方法。这篇内容适合刚接触 FOC、对电机控制感兴趣的同学也适合那些已经能跑通 SVPWM 但不知道怎么生成旋转磁场的嵌入式开发者。代码以 STM32 平台为例但思路完全通用。1. 什么是电机开环控制1.1 开环控制的基本概念控制领域谈到“开环”与“闭环”最直观的区别是系统是否存在反馈通道。开环控制是指系统的输出不会影响控制作用即给定一个输入控制器按预设的规律执行不关心实际执行结果是否与期望一致。举个例子开环控制你设定电机转速 1000 RPM控制器输出一个对应占空比的 PWM电机的实际转速可能只有 800 RPM也可能因为负载变化降到 500 RPM但控制器不会感知这一点。闭环控制控制器通过编码器或观测器获取实际转速与目标值比较再调整输出使转速稳定在 1000 RPM 附近。对于直流有刷电机开环控制只是输出一个固定的 PWM 占空比非常简单。但对于无刷电机BLDC/PMSM尤其是采用 FOC 控制的电机开环控制却不那么直观——你不仅要给定电压大小还要给定电压矢量的方向而且这个方向要随着转子位置或时间变化。1.2 FOC 中的开环控制是什么在 FOC 中电流矢量由直轴电流 Id 和交轴电流 Iq 构成。正常闭环运行时Id 和 Iq 是通过电流采样与 Clark/Park 变换获得的实际值再经过 PI 调节得到 Ud 和 Uq。而开环控制下我们直接给定 Ud 和 Uq不依赖电流反馈也不依赖转子位置反馈。为了让电机旋转起来我们需要让电压矢量在空间中旋转。在 FOC 的坐标系中这意味着需要让 Uq 对应的电角度 θ 随时间线性增加。这个过程可以理解为给定一个恒定的电压幅值。让电压矢量的角度按照设定的速度增量递增。将旋转的电压矢量通过逆 Park 变换、SVPWM 输出到三相桥臂。这里要特别注意开环 FOC 并不需要对转子实际位置进行检测而是“假设”转子处于一个预设的电角度位置。这是一种典型的 V/F电压/频率控制思路在异步电机调速中很常见在同步电机PMSM中也有应用但前提是负载不能太大、加减速不能太激进否则会失步。1.3 为什么要学习开环控制很多初学者会觉得FOC 不就是要闭环吗学开环有什么意义实际上开环控制是 FOC 调试过程中一个非常实用的中间步骤验证硬件链路开环控制不需要编码器和电流环参与可以快速确认逆变器、驱动芯片、MOS 管、电机三相接线是否正常。验证 SVPWM 输出在开环控制中SVPWM 输出的相电压波形直接影响电机旋转如果三相波形有问题会直接影响后续闭环调试。验证采样电路虽然开环不需要电流环参与输出电压但要想后续闭环必须确认电流采样电路是否正常。开环运行期间可以通过采样电流波形判断采样电路是否良好。摸清电机参数通过开环运行可以估算电机极对数、相电阻、反电动势系数等基础参数。无感 FOC 启动的前置环节无感 FOC 在零速或低速阶段通常采用 I/F 开环启动强制换相把转子拉到一定转速后再切入无感观测器闭环。所以开环控制不是“不重要的过渡方案”而是 FOC 工程实践中不可缺少的调试工具。2. 开环控制分类V/F 开环与 I/F 开环在 FOC 实际工程中开环控制通常有两种实现思路它们对应的控制量和适用场景不同。2.1 V/F 开环控制电压-频率控制V/F 控制又称恒压频比控制是最传统的开环调速方式。核心思想是保持电压幅值 V 与输出频率 f 的比值恒定。在 FOC 表达中假设我们不给 Id只给 Iq 对应的电压 Uq_ref同时保持 Ud_ref 0那么施加到电机上的合成电压矢量的幅值就等于 Uq_ref其旋转角度由设定频率决定电角度 θ 随时间递增θ θ₀ ∫ω dt其中 ω 2πf。Uq_ref 按一定比例随转速增大避免低速时电流过大、高速时电压不足。输出电压矢量始终超前或同步于转子位置依赖于负载角。V/F 开环的优点实现简单不需要电流采样。稳态运行时力矩输出平稳。对负载变化敏感度较低只要不超出极限。V/F 开环的缺点低速时定子压降不可忽略恒定 V/F 会导致励磁不足必须做电压补偿。突加负载时可能失步。无法精确控制转矩。2.2 I/F 开环控制电流-频率控制I/F 控制全称 Current-Frequency Control也叫“电流频率控制”。核心思想是保持电流矢量幅值恒定通过控制电流矢量的旋转速度来驱动转子。在 FOC 算法中通常做法是给定 Iq_ref 为额定电流或某个设定值Id_ref 0。电流环 PI 仍然工作确保实际 Iq 跟踪 Iq_ref。电流矢量的电角度由程序自动递增斜坡给定不依赖反馈位置。电机在电流矢量的牵引下旋转。这里有一个细节I/F 控制中电流环是闭环的但位置环角度是开环的所以整体仍属于开环控制。为什么电流环闭环了还算开环因为角度是程序预估的不是实际转子位置。如果转子位置和电流矢量位置偏差过大电机会失步。电流环只是保证电流幅值按给定值但不能保证转子跟随电流矢量旋转。I/F 控制的优点启动过程可控性强电流幅值限制方便。不容易过流保护效果好。是很多无感 FOC 算法低速启动阶段的标准方案。I/F 控制的缺点需要电流采样和电流环。负载扰动较大时可能失步。从开环切换到闭环时需要处理角度平滑切换的问题。2.3 本文选择哪种方案为照顾零基础读者本文先用V/F 开环控制演示完整代码流程因为代码最少、最容易理解。在此基础上补充 I/F 开环的升级思路。在后面的篇幅中我会按这个顺序展开手写一个最简 V/F 开环控制只靠 SVPWM 定时器中断。结合电流采样实现 I/F 开环。给出常见问题排查表和调试建议。3. 环境准备与硬件基础在写代码之前先说清楚运行环境。3.1 硬件清单本文示例需要以下硬件STM32 开发板F103 系列即可满足教学需求建议使用 F103C8T6 最小系统板三相全桥逆变电路可以使用集成的驱动芯片如 DRV8301、EG2134、IR2101 等直流无刷电机PMSM带霍尔或不带都可以开环阶段不需要霍尔没有电机时用三相电阻负载也能测试 SVPWM 波形直流稳压电源建议电压 12V~24V电流至少 2AUSB-TTL 串口模块用于日志输出逻辑分析仪或示波器推荐用于观察 PWM 波形和相电流波形3.2 软件环境Keil MDK 或 STM32CubeIDESTM32CubeMX用于初始化工程也可以手写寄存器串口调试助手3.3 核心概念复习电角度与机械角度在 FOC 中我们处理的电角度 θ 与电机的机械角度之间满足θe θm * 极对数其中 θe 是电角度θm 是机械角度极对数即电机转子上磁极的对数。对于开环控制电角度不是测出来的而是按照目标电角速度直接累加得到的。设定目标机械转速为speed_rpm极对数为pole_pairs则电角速度ωe 2π * (speed_rpm / 60) * pole_pairs每次控制周期例如 PWM 周期 10kHz更新一次电角度θe ωe * Ts下面这段代码就是整个开环 FOC 的“引擎”。版本说明不同 STM32 系列的外设库有所差异本文代码基于 HAL 库编写使用定时器更新中断作为控制周期重点代码可直接移植。4. 开环 FOC 算法详细拆解4.1 整体控制框图开环 FOC 的控制流程如下不需要编码器、不需要电流环目标转速 - 斜坡函数 - 电角速度 ωe | v 电角度累加 θe | v 给定 Uq_ref Ud_ref0 - 逆 Park 变换 - Uα/Uβ | v SVPWM 计算 | v 更新三个比较寄存器 - 三相桥臂输出如果加上电流采样和电流环则会变为 I/F 开环目标电流 Iq_ref Id_ref0 - 电流环 PI - Ud/Uq | v 电角度累加 θe - 逆 Park 变换 - SVPWM - 三相桥 ^ | 电流采样 Clark/Park4.2 电角度累加的实现在 FOC 中电角度的计算决定了电压矢量的旋转速度。使用一个 32 位变量累加电角度并做了归一化到[0, 2π)的处理。// 文件路径user/foc_openloop.h #ifndef __FOC_OPENLOOP_H #define __FOC_OPENLOOP_H #include main.h #define POLE_PAIRS 7 // 电机极对数按实际电机修改 #define CTRL_FREQ 10000 // 控制频率 10kHz与定时器中断周期一致 #define CTRL_PERIOD (1.0f / CTRL_FREQ) #define MATH_PI 3.14159265358979323846f #define TWO_PI (MATH_PI * 2.0f) typedef struct { float speed_rpm; // 目标转速 单位RPM float speed_ref_rpm; // 经过斜坡函数后的转速 float angle; // 当前电角度 单位rad float angle_speed; // 电角速度 单位rad/s float uq; // q 轴电压给定 float ud; // d 轴电压给定 } FOC_OpenLoop_Handle; void FOC_OpenLoop_Init(FOC_OpenLoop_Handle *h); void FOC_OpenLoop_SetSpeed(FOC_OpenLoop_Handle *h, float rpm); void FOC_OpenLoop_Run(FOC_OpenLoop_Handle *h); #endif对应的实现文件// 文件路径user/foc_openloop.c #include foc_openloop.h #include math.h static float ramp_speed 0.0f; static float target_speed 0.0f; // 初始化开环控制句柄 void FOC_OpenLoop_Init(FOC_OpenLoop_Handle *h) { h-speed_rpm 0.0f; h-speed_ref_rpm 0.0f; h-angle 0.0f; h-angle_speed 0.0f; h-uq 0.0f; h-ud 0.0f; } // 设置目标转速 void FOC_OpenLoop_SetSpeed(FOC_OpenLoop_Handle *h, float rpm) { target_speed rpm; } // 斜坡函数限制转速变化率防止加速度过大导致失步 static void SpeedRamp(void) { float max_acc 2000.0f; // 最大加速度 RPM/s float delta max_acc * CTRL_PERIOD; if (target_speed ramp_speed) { ramp_speed delta; if (ramp_speed target_speed) { ramp_speed target_speed; } } else if (target_speed ramp_speed) { ramp_speed - delta; if (ramp_speed target_speed) { ramp_speed target_speed; } } } // 开环 FOC 运行函数每个控制周期调用一次 void FOC_OpenLoop_Run(FOC_OpenLoop_Handle *h) { // 1. 斜坡更新实际参考转速 SpeedRamp(); h-speed_ref_rpm ramp_speed; // 2. 电角速度 2π * (rpm / 60) * 极对数 h-angle_speed TWO_PI * (h-speed_ref_rpm / 60.0f) * POLE_PAIRS; // 3. 电角度累加 h-angle h-angle_speed * CTRL_PERIOD; if (h-angle TWO_PI) { h-angle - TWO_PI; } if (h-angle 0.0f) { h-angle TWO_PI; } // 4. 开环电压给定低速时补偿定子压降简单实现为比例关系 // 本例中目标转速低于 300RPM 时Uq 最小为 0.5V高于后线性增加 float voltage_pc 0.12f; // 每 RPM 电压增益需要根据母线电压和电机参数调整 h-uq 0.5f h-speed_ref_rpm * voltage_pc; h-ud 0.0f; if (h-speed_ref_rpm 1.0f) { h-uq 0.0f; } }这段代码做了三件事通过斜坡函数让电机缓慢加速。将目标转速换算成电角速度累加电角度。根据转速生成 q 轴电压给定。ramp_speed和target_speed使用静态变量简单起见不再封装进结构体。实际工程中建议都放入结构体以避免多个电机实例冲突。4.3 逆 Park 变换实现有了电角度 θe 和 Ud/Uq 给定值之后我们需要将旋转坐标系下的电压转换到静止两相坐标系下Uα Ud * cosθ - Uq * sinθ Uβ Ud * sinθ Uq * cosθ逆 Park 变换在 FOC 中的作用是把人为给定的旋转电压矢量投影到两相静止坐标系上方便后续 SVPWM 生成三相占空比。// 文件路径user/park.c #include park.h #include math.h void InvParkTransform(float angle, float ud, float uq, float *ualpha, float *ubeta) { float sin_a sinf(angle); float cos_a cosf(angle); *ualpha ud * cos_a - uq * sin_a; *ubeta ud * sin_a uq * cos_a; }小提示在嵌入式环境中sinf和cosf比sin/cos更快。如果对性能要求极高可以用查表法替代三角运算。角度需要保证在[0, 2π)范围内避免浮点精度问题。4.4 SVPWM 生成与输出SVPWM 是 FOC 最终输出三相 PWM 波形的方法。这里直接给出常用的七段式 SVPWM 实现。需要注意的是不同 MCU 的定时器排列方式不同需要将三个比较值映射到对应的通道上。// 文件路径user/svpwm.c #include svpwm.h #define SECTOR_1 1 #define SECTOR_2 2 #define SECTOR_3 3 #define SECTOR_4 4 #define SECTOR_5 5 #define SECTOR_6 6 #define SQRT3 1.73205080756887729352f static float NormalizeSVPWM(float x, float min_val, float max_val) { return (x - min_val) / (max_val - min_val); } void SVPWM_Calc(float ualpha, float ubeta, float ubus, SVPWM_Handle *out) { float u1 ubeta; float u2 -0.5f * ubeta 0.8660254f * ualpha; float u3 -0.5f * ubeta - 0.8660254f * ualpha; uint8_t sector 0; if (u1 0) sector | (1 0); if (u2 0) sector | (1 1); if (u3 0) sector | (1 2); float x ubeta; float y 0.5f * ubeta 0.8660254f * ualpha; float z 0.5f * ubeta - 0.8660254f * ualpha; float t1 0.0f, t2 0.0f; switch (sector) { case 3: t1 z; t2 y; break; case 1: t1 y; t2 -x; break; case 5: t1 -z; t2 x; break; case 4: t1 -x; t2 z; break; case 6: t1 x; t2 -y; break; case 2: t1 -y; t2 -z; break; default: break; } float ts 1.0f / 10000.0f; // PWM 周期 100us对应 10kHz t1 t1 / ubus * ts; t2 t2 / ubus * ts; // 限制占空比在安全范围内 float t_min 0.0005f * ts; float t_max 0.9995f * ts; if (t1 0.0f) t1 0.0f; if (t2 0.0f) t2 0.0f; if (t1 t_max) t1 t_max; if (t2 t_max) t2 t_max; float t0 ts - t1 - t2; if (t0 0.0f) t0 0.0f; float ta t0 * 0.5f; float tb ta t1 * 0.5f; float tc tb t2 * 0.5f; if (sector 3) { out-duty_a ta; out-duty_b tb; out-duty_c tc; } else if (sector 1) { out-duty_a tb; out-duty_b ta; out-duty_c tc; } else if (sector 5) { out-duty_a tc; out-duty_b ta; out-duty_c tb; } else if (sector 4) { out-duty_a tc; out-duty_b tb; out-duty_c ta; } else if (sector 6) { out-duty_a tb; out-duty_b tc; out-duty_c ta; } else if (sector 2) { out-duty_a ta; out-duty_b tc; out-duty_c tb; } }这里对几个关键参数做解释ubus母线电压。SVPWM 计算周期时间时要把输出电压标幺化到开关周期上。tsPWM 周期。它必须与控制周期一致否则电流波形异常。t_min和t_max防止占空比过小或过大导致采样窗口死区。4.5 更新 PWM 比较寄存器在 STM32 HAL 库中通常使用高级定时器 TIM1 或 TIM8 输出互补 PWM。可以在中断中直接修改寄存器// 文件路径user/motor_pwm.c #include motor_pwm.h #include svpwm.h static TIM_HandleTypeDef *pwm_tim; void MotorPWM_Init(TIM_HandleTypeDef *htim) { pwm_tim htim; HAL_TIM_PWM_Start_IT(htim, TIM_CHANNEL_1); HAL_TIM_PWM_Start_IT(htim, TIM_CHANNEL_2); HAL_TIM_PWM_Start_IT(htim, TIM_CHANNEL_3); } void MotorPWM_Update(SVPWM_Handle *h) { uint32_t ccr1 (uint32_t)(h-duty_a * (pwm_tim-Instance-ARR 1)); uint32_t ccr2 (uint32_t)(h-duty_b * (pwm_tim-Instance-ARR 1)); uint32_t ccr3 (uint32_t)(h-duty_c * (pwm_tim-Instance-ARR 1)); __HAL_TIM_SET_COMPARE(pwm_tim, TIM_CHANNEL_1, ccr1); __HAL_TIM_SET_COMPARE(pwm_tim, TIM_CHANNEL_2, ccr2); __HAL_TIM_SET_COMPARE(pwm_tim, TIM_CHANNEL_3, ccr3); }在开环控制的整个调用链中控制周期的任务非常简单// 定时器更新中断回调 void HAL_TIM_PeriodElapsedCallback(TIM_HandleTypeDef *htim) { if (htim-Instance TIM1) { static FOC_OpenLoop_Handle foc {0}; static SVPWM_Handle svpwm {0}; static uint32_t cnt 0; float ualpha 0.0f, ubeta 0.0f; // 开环 FOC 核心计算 FOC_OpenLoop_Run(foc); // 逆 Park 变换 InvParkTransform(foc.angle, foc.ud, foc.uq, ualpha, ubeta); // SVPWM SVPWM_Calc(ualpha, ubeta, VBUS_VOLTAGE, svpwm); // 更新比较寄存器 MotorPWM_Update(svpwm); } }到此一个最简的开环 FOC 已经可以驱动电机旋转了。只要电源、驱动板、电机连接正确当程序运行后电机会按照设定转速缓慢启动并保持旋转。5. 实战跑通开环控制接下来我们从零搭建一个完整可运行的示例以 STM32F103 为例演示从初始化到电机转动的全过程。5.1 创建项目结构推荐在 STM32CubeMX 中初始化定时器和 GPIO然后手动添加以下文件User/ ├── main.c ├── foc_openloop.c ├── foc_openloop.h ├── park.c ├── park.h ├── svpwm.c ├── svpwm.h └── motor_pwm.c └── motor_pwm.hSTM32CubeMX 配置要点TIM1 输出三相互补 PWM频率 10kHz。启用 TIM1 更新中断。ADC1 三通道采集相电流I/F 开环需要V/F 阶段可以先不接。串口 1 用于变量调试输出转速、电角度、电流等。5.2 完整主程序示例下面给出一个精简可运行版本方便快速验证。// 文件路径main.c 核心片段 #include main.h #include foc_openloop.h #include park.h #include svpwm.h #include motor_pwm.h TIM_HandleTypeDef htim1; UART_HandleTypeDef huart1; FOC_OpenLoop_Handle foc; uint8_t start_flag 0; void SystemClock_Config(void); static void MX_GPIO_Init(void); static void MX_TIM1_Init(void); static void MX_USART1_UART_Init(void); int main(void) { HAL_Init(); SystemClock_Config(); MX_GPIO_Init(); MX_TIM1_Init(); MX_USART1_UART_Init(); FOC_OpenLoop_Init(foc); MotorPWM_Init(htim1); // 设定目标转速为 300RPM开环启动 FOC_OpenLoop_SetSpeed(foc, 300.0f); HAL_TIM_Base_Start_IT(htim1); while (1) { // 串口打印调试信息10Hz uint8_t msg[64]; int len snprintf((char *)msg, sizeof(msg), speed%.1f ang%.3f uq%.2f\r\n, foc.speed_ref_rpm, foc.angle, foc.uq); HAL_UART_Transmit(huart1, msg, len, 100); HAL_Delay(100); } }这里使用了更合理的命名控制频率通过定时器更新中断保证主循环中只做串口打印和系统任务。5.3 如何验证开环控制是否正确方法一电机旋转测试把目标转速设为 200 RPM上电后观察电机是否缓慢旋转。如果电机不转检查三相接线是否松动母线电压是否过低。如果电机振动或抖动说明三相 PWM 波形有问题重点检查 SVPWM 的扇区计算和比较值映射顺序。方法二示波器观察相电压用示波器探头测量电机任一相相对于直流母线负极的波形正常情况应看到一系列宽度变化的 PWM 脉冲频率为 10kHz脉冲宽度呈正弦变化规律。方法三测量相电流在 V/F 开环阶段如果已经并联采样电阻可以观察相电流波形。正常情况应为近似正弦波频率与电角速度对应。如果电流为零或严重畸变说明 PWM 输出策略有问题。5.4 开环控制预期波形当目标转速为 600 RPM、极对数为 7 时电角速度2π * (600/60) * 7 ≈ 439.8 rad/s对应电频率439.8 / (2π) ≈ 70 HzSVPWM 输出基波频率约为 70Hz相电流波形的频率也为 70Hz通过这个现象可以反向验证程序中的极对数配置是否正确。6. 进阶I/F 开环的实现思路当 V/F 开环跑通之后下一步可以尝试 I/F 开环。I/F 开环与 V/F 开环的差异在于I/F 需要电流环参与控制电流给定值由外部指定而不是由电压直接决定。6.1 I/F 开环的控制结构I/F 开环在本质上是一个“电流闭环 角度开环”的混合控制方式。控制框图如下给定 Iq_ref Id_ref0 - 电流环 PI - Ud/Uq | v 程序累加电角度 θe - 逆 Park 变换 - SVPWM - 三相桥 ^ | 电流采样 Clark/Park注意此时角度不是来自编码器或观测器而是程序强制生成的。因此控制系统对负载扰动没有直接抵抗能力需要限制加速度和最大负载。6.2 I/F 开环的电流环设计在电流环中Id 和 Iq 两个轴分别使用 PI 控制器Id 轴目标是 0用于维持磁链方向与 d 轴一致。Iq 轴目标是给定电流值用于产生转矩。其中电流采样和 Clark/Park 变换是关键。Clark 变换需要采集至少两相电流通过I_c -I_a - I_b求第三相Park 变换则需要使用当前的程序电角度 θe。// 电流环 PI 计算示例 void CurrentLoop_PI(CurrentLoop_Handle *h) { // Id 轴 float err_d h-id_ref - h-id_fb; h-ud h-kd_p * err_d h-ki_d * h-integral_d; // 积分限幅 if (h-ud h-max_ud) h-ud h-max_ud; if (h-ud -h-max_ud) h-ud -h-max_ud; h-integral_d err_d * h-ki_d * CTRL_PERIOD; // Iq 轴同理 float err_q h-iq_ref - h-iq_fb; h-uq h-kq_p * err_q h-ki_q * h-integral_q; if (h-uq h-max_uq) h-uq h-max_uq; if (h-uq -h-max_uq) h-uq -h-max_uq; h-integral_q err_q * h-ki_q * CTRL_PERIOD; }6.3 I/F 开环中的电角度更新电角度的更新方式与 V/F 类似但有一个重要区别在 I/F 开环中我们既可以说“角度是预估的”也可以说“电流矢量始终超前或滞后转子一个功率角”。由于没有反馈功率角不可控。如果负载力矩过大功率角增大超过 90° 后电机就会失步。因此 I/F 开环一般用于空载或轻载启动阶段在进入中高速后必须无缝切换到闭环控制。6.4 I/F 开环的调试建议开始时将 Iq_ref 设为 0.2 倍额定电流观察电机是否平稳旋转。逐渐增大 Iq_ref如果电机抖动加剧说明电流环参数不合适。电角度的递增速率应平缓建议搭配斜坡函数。从工程角度看I/F 开环可以看成是无感 FOC 低速启动的一种落地方式。7. 常见问题与排查方法在实际调试开环 FOC 的过程中大家经常遇到的问题基本集中在下面几个方向。这里整理成一张排查表便于快速定位。问题现象常见原因解决思路电机不转母线电压未建立或使能信号异常测量母线电压检查驱动芯片使能引脚电机不转PWM 频率设置不当MOS 管未正常开关用示波器检查 PWM 输出波形确认频率为 10kHz 左右电机不转SVPWM 比较值映射通道错误检查扇区到占空比的映射顺序是否与三相接线一致电机振动且电流大三相接线相序错误交换任意两相相序测试电机启动时抖动后来停转目标转速设置过低初始电压不足提高 V/F 曲线中的最低电压补偿电机高速时失步加速度过大或负载超过转矩上限降低斜坡加速度或增大输出电流限制电机突然反转SVPWM 扇区计算错误检查坐标系定义是否一致确认 Uα/Uβ 符号正确相电流波形畸变采样电阻信号有噪声或采样时刻不对检查 PWM 中心对齐采样确保在低边导通时采样以下对几个高频问题做扩展说明。7.1 电机不转但 PWM 正常输出如果示波器上可以看到三相 PWM 波形但电机仍不转很大概率是母线电压没有到达电机端。例如驱动芯片没有使能或者 MOSFET 栅极驱动电压不足。此外还需要确认电机三相是否已经连接到驱动板的 U、V、W 输出端而不是直接接了电源和地。7.2 电机抖动但电流不大这种现象通常说明电压矢量已经在旋转但电机定子磁场与转子之间没有建立起有效的同步关系。可能原因包括极对数设置错误。例如电机实际为 7 对极代码配置成了 4 对极电角度转速不正确。初始电压太小无法克服齿槽转矩。相序错误导致磁场方向与预期相反。解决方法是确认电机极对数可以通过反电动势测量法合理设置最低启动电压然后依次交换两相测试。7.3 开环控制时 Uq 如何计算V/F 开环中Uq 不能一直固定否则低速时电流过大、高速时输出不足。比较常用的方式是Uq Uq_min speed_rpm * K_v其中Uq_min 为克服定子电阻压降和齿槽转矩的最小电压一般在 0.3V~1V 之间。K_v 为电压增益与母线电压、电机额定电压有关。实际调试时可以通过小步长增加 K_v 并观察相电流是否平滑来标定。7.4 开环 FOC 的电流采样很多初学者在开环阶段就想把电流采样接上这个方向是对的。开环阶段做电流采样可以为后续闭环打基础。但要注意FOC 电流采样通常是在 PWM 周期的中心点附近进行因为此时下桥臂导通采样电阻上的电压最稳定。如果采样时刻不对波形会严重畸变。这也是热搜词“FOC 电流采集为什么要设置在下桥”对应的核心问题下桥采样与 PWM 中心对齐能保证在一个周期内采样到真实的相电流瞬时值。8. 从开环控制走向闭环控制开环控制是 FOC 学习路径上重要的里程碑但它并不是终点。从工程实践角度来看我建议按以下路线过渡到闭环。8.1 第一步硬件与采样链路验证在开环控制阶段务必确认以下事项正常三相 PWM 波形正常互补信号无直通。ADC 采样链路正常可以读到稳定的相电流值。Clark/Park 变换在给定电角度下能正确还原电流值。8.2 第二步调试电流环开环控制跑通后先不要急着切速度环而是优先调试电流环。具体做法将 Id_ref 设为 0Iq_ref 设为一个小电流。给定一个固定的程序电角度手动旋转电机转子。观察电流环输出的 Ud/Uq 波形是否平稳。当定子电流能稳定跟踪给定值时再考虑加入速度环和位置估算。8.3 第三步学习无感 FOC 的启动策略在无感 FOC 中转速为零或较低时通常无法获得可靠的反电动势信息所以需要采用开环启动。这一阶段往往使用 I/F 或 V/F 开环将电机拉到一个可观测反电动势的速度如额定转速的 5%~10%然后切入状态观测器如滑模观测器 SMO、龙伯格观测器或模型参考自适应 MRAS闭环。本文写的开环控制正是这个“拉高速”动作的实现基础。8.4 第四步处理开环到闭环的切换从开环切换到闭环时如果角度和电流突变会引起力矩波动严重时导致过流或失步。工程上通常有以下处理办法在切换前保持电压矢量角度连续平滑过渡。切换瞬间将速度环积分清零。先切换到电流闭环再投入速度环。使用“软切换”策略让开环角度与观测器角度之间的差值逐渐收敛。这些内容属于 FOC 进阶难点在后续文章中会详细展开本期先做到“跑通开环”后续逐步深化。9. 总结与下一步学习建议开环控制看起来简单但它涉及的知识链条一点都不短SVPWM、逆 Park 变换、电角度累加、V/F 与 I/F 控制策略、PWM 更新机制等。任何一个环节出错电机都无法正常旋转。通过本期内容大家应当掌握以下关键能力理解 V/F 开环控制与 I/F 开环控制的核心差异。能在 STM32 上实现最简单的 V/F 开环 FOC从设定目标转速到输出三相 PWM。能利用示波器、串口、相电流波形判断开环控制是否正常。知道开环控制在无感 FOC 体系中的意义为后续切入电流环、速度环、观测器打好基础。接下来的学习路线建议补充电流采样电路的学习弄懂单电阻、双电阻、三电阻采样的差异。动手调通电流环 PI 参数掌握 Id0 控制模式。理解 Clarke 变换中为什么只需要两相电流以及具体选择哪两相。深入了解无感 FOC 堵转检测、转子初始位置检测、弱磁控制等进阶方案。如果你已经可以做到开环电机稳定旋转说明 SVPWM 和定时器中断链路已经通了接下来就是在这个基础上叠加采样、Clark/Park、PI 调节、观测器逐步把“开环”升级成“闭环”。代码调试中如果遇到问题欢迎对照本文的排查表一步步定位。电机控制没有捷径但每排除一个异常都会对整体原理有更深的理解。如果这篇文章对你有帮助建议收藏备用后续我会继续更新 FOC 系列逐步深入无感控制的核心算法与工程实现。