企业官网建设流程全解析

之前在调试 STM32 无刷电机驱动时，我在双电阻电流采样与无感角度估算上反复折腾了很久。网上的 FOC 资料虽然多，但大多数要么只讲控制理论，要么只给一套闭源库的调用方法，真正能照着搭起来、看到波形、跑起来转场的完整教程并不多。这段时间把 FOC 从算法原理到板级调试重新梳理了一遍，也结合项目中双电机同步驱动的经验做了一次系统复盘。如果你正准备入门无刷电机 FOC 控制，或者在用 STM32G4、STM32H7 做无感 FOC 项目，可以参考这篇文章的完整路径。

FOC 全称是 Field-Oriented Control，即磁场定向控制，也叫矢量控制。它解决的核心问题是：让无刷电机像直流电机一样“好控制”。直流电机只需要控制电枢电压或电流，就能线性调节转矩和转速；而无刷电机的三相绕组电流是交流量，转矩和电流之间的关系并不直观。FOC 的做法是通过坐标变换，把三相交流量转换成与转子磁场同步旋转的 d-q 轴直流分量，从而用类似直流电机的思路去控制转矩和励磁。

本文会从 FOC 的基础概念讲起，然后拆解核心算法变换、硬件采样结构、无感角度估算，最后给出基于 STM32 的从零实现流程和常见调试排错方法，适合有 STM32 基础、想深入电机控制的开发者阅读。

1. FOC 是什么，解决什么问题

1.1 为什么无刷电机需要 FOC

无刷直流电机（BLDC）和永磁同步电机（PMSM）在结构上非常相似，定子都是三相绕组，转子都是永磁体，但驱动方式差异很大。

常见的六步换相法（方波驱动）只是一段时间内给两相绕组通电，利用转子位置信号按 60° 电角度逐步换相。这种方式简单，但会产生明显的转矩脉动，高速时噪声大，低速动态响应也一般。

FOC 则是对三相电流做连续正弦控制，让定子电流矢量始终与转子磁场保持理想角度。这样从电磁转矩公式来看：

[ T_e = \frac{3}{2} p \psi_f i_q ]

转矩只与 q 轴电流成正比（在 ( i_d = 0 ) 控制策略下）。这意味着，我们可以像控制直流电机一样实时控制转矩，动态响应和稳态精度都远好于六步换相。

通俗地说，FOC 让电机的“每一刻”都处于最佳出力角度，而不是“每 60° 换一次”。

1.2 有感与无感 FOC 的区别

有感 FOC 依赖编码器或霍尔传感器获取转子位置。位置信息直接参与 Park 变换和速度反馈，控制实现相对简单，启动和低速表现好。

无感 FOC 不依赖位置传感器，通过电机模型和相电流、母线电压等信息估算转子位置与速度。常见方法有：

• 反电动势过零检测：适用于方波驱动，简单但低速效果差。
• 扩展卡尔曼滤波器（EKF）：精度高，计算量大。
• 滑模观测器（SMO）：对参数变化鲁棒性好，是工程中常用的无感方案。
• 磁链观测器：通过定子磁链估算转子位置，对中高速效果较好。

无感 FOC 的难点集中在低速启动和零速带载。因为静止时反电动势为零，无法通过反电动势获得角度，需要采用 I/F 开环启动、高频注入等方法完成初始定位和加速。

1.3 FOC 完整控制链路

无论有感还是无感，FOC 的控制流程都可以用下面的链路概括：

三相电流采样 -> Clark 变换 -> Park 变换 -> d/q 轴电流 PI -> 逆 Park 变换 -> SVPWM -> 三相逆变器 -> 电机 ^ | +---------- 位置/速度反馈 --------------+

电流环是内环，速度环是外环，部分应用还会增加位置环。

整个系统里，最关键的两个环节是：

1. 电流采样是否准确：直接影响变换结果和 PI 输出。
2. 转子角度是否可靠：Park 变换和逆 Park 变换都依赖角度，角度误差会造成 d-q 轴耦合，严重时会导致失控。

2. FOC 算法核心原理拆解

2.1 Clark 变换与 Park 变换

先从电流说起。假设采样得到三相电流 ( i_a )、( i_b )、( i_c )，由于电机绕组通常为星形连接，有：

[ i_a + i_b + i_c = 0 ]

所以实际只需要采样两相电流即可。Clark 变换把三相静止坐标系（abc）变换到两相静止坐标系（αβ）：

[ i_{\alpha} = i_a ] [ i_{\beta} = \frac{i_a + 2i_b}{\sqrt{3}} ]

写成矩阵形式就是：

// Clark 变换核心代码 i_alpha = i_a; i_beta = (i_a + 2.0f * i_b) * 0.57735026919f; // 1/sqrt(3)

Park 变换把 αβ 静止坐标系变换到 d-q 旋转坐标系，需要转子电角度 θ：

[ i_d = i_{\alpha} \cos\theta + i_{\beta} \sin\theta ] [ i_q = -i_{\alpha} \sin\theta + i_{\beta} \cos\theta ]

// Park 变换核心代码 i_d = i_alpha * cos_theta + i_beta * sin_theta; i_q = -i_alpha * sin_theta + i_beta * cos_theta;

实际编程中，为了减少 CPU 开销，通常用查表或 CORDIC 硬件加速计算三角函数。STM32G4 系列内置 CORDIC 外设，可以大幅加快三角函数和开方运算。

2.2 SVPWM 调制

电流环 PI 的输出是 d-q 轴电压指令 ( u_d^* )、( u_q^* )，经过逆 Park 变换得到 αβ 轴电压 ( u_{\alpha}^* )、( u_{\beta}^* )：

u_alpha = u_d * cos_theta - u_q * sin_theta; u_beta = u_d * sin_theta + u_q * cos_theta;

接下来需要把 ( u_{\alpha} )、( u_{\beta} ) 转换成三相逆变器六个开关管的占空比。这就是 SVPWM（空间矢量脉宽调制）要做的事。

SVPWM 的基本思路是：8 个基本电压矢量（6 个非零矢量 + 2 个零矢量）可以在空间合成任意方向和幅值的电压矢量。通过判断目标电压所在的扇区，计算相邻两个基本矢量的作用时间，再分配到三个桥臂的占空比上。

扇区判断代码：

// 根据 u_alpha、u_beta 判断扇区 float v1 = u_beta; float v2 = (1.7320508f * u_alpha - u_beta) * 0.5f; float v3 = (-1.7320508f * u_alpha - u_beta) * 0.5f; int sector = 0; if (v1 > 0) sector = 1; if (v2 > 0) sector |= 2; if (v3 > 0) sector |= 4;

SVPWM 相比 SPWM 的优势是母线电压利用率更高，谐波更小，是目前 FOC 驱动的主流调制方式。

2.3 PID 调节器

FOC 的电流环和速度环都使用 PID（或 PI）调节器。电流环要求响应快，一般只用 PI，不加微分项，避免放大采样噪声。

离散 PID 位置式实现：

typedef struct { float Kp; float Ki; float Kd; float integral; float prev_error; float limit; } PID_TypeDef; float PID_Update(PID_TypeDef *pid, float target, float current) { float error = target - current; pid->integral += error; // 积分限幅，防止积分饱和 if (pid->integral > pid->limit) pid->integral = pid->limit; if (pid->integral < -pid->limit) pid->integral = -pid->limit; float output = pid->Kp * error + pid->Ki * pid->integral + pid->Kd * (error - pid->prev_error); pid->prev_error = error; // 输出限幅 if (output > pid->limit) output = pid->limit; if (output < -pid->limit) output = -pid->limit; return output; }

工程中常见的坑是积分饱和。当电机堵转或启动瞬间，误差持续较大，积分项会不断累积，导致恢复时超调严重。因此积分限幅和输出限幅必须同时做。

2.4 磁链与有效磁链计算

“FOC 控制中有效磁链怎么计算？”这是很多人在无感 FOC 中遇到的疑问。

磁链观测的基本公式来自定子电压方程：

[ u_s = R_s i_s + \frac{d\psi_s}{dt} ]

所以定子磁链：

[ \psi_s = \int (u_s - R_s i_s) dt ]

在 αβ 坐标系下：

flux_alpha += (u_alpha - R_s * i_alpha) * dt; flux_beta += (u_beta - R_s * i_beta) * dt;

定子磁链包含两部分：永磁体磁链和电枢反应磁链。有效磁链（active flux）的定义是：

[ \psi_{active} = \psi_s - L_s i_s ]

它的方向与转子 d 轴一致，可以通过有效磁链直接在静止坐标系下估算转子角度：

theta_est = atan2f(flux_beta - L_s * i_beta, flux_alpha - L_s * i_alpha);

有效磁链法的优点是：

• 不需要知道永磁体磁链的精确值。
• 对电感饱和有一定鲁棒性。
• 实现比 EKF 简单，适合中高速运行。

缺点是低速时定子电阻压降占比大，积分漂移明显，需要配合补偿和启动策略。

2.5 无感角度估算：反电动势与观测器

无感 FOC 的中高速段最常用的是反电动势法。

PMSM 在 αβ 坐标系下的电压方程为：

[ u_{\alpha} = R_s i_{\alpha} + L_s \frac{di_{\alpha}}{dt} + e_{\alpha} ] [ u_{\beta} = R_s i_{\beta} + L_s \frac{di_{\beta}}{dt} + e_{\beta} ]

其中反电动势：

[ e_{\alpha} = -\psi_f \omega_e \sin\theta_e ] [ e_{\beta} = \psi_f \omega_e \cos\theta_e ]

所以反电动势包含转子位置和速度信息。如果能提取出反电动势，角度就自然得到了。

滑模观测器（SMO）的思路是构造一个电流观测器，用滑模面把反电动势项“逼”出来。实际工程中会配合锁相环（PLL）提取角度和速度，因为直接对反电动势做反正切计算容易受噪声和谐波影响。

PLL 角度提取示意：

// SMO 输出 e_alpha、e_beta // 用锁相环跟踪角度 error = e_alpha * cos_theta_est + e_beta * sin_theta_est; // 如果 error 被 PI 调节到 0，则 theta_est 收敛到真实电角度

需要注意的是，反电动势法在零速和极低速下无法工作，因为此时反电动势幅值接近零。工程上常见的做法是：

1. 零速定位：施加固定电压矢量，把转子拉到已知位置。
2. I/F 开环加速：用电流环控制电流幅值，按斜坡给定频率，强制转子跟随同步。
3. 切换到闭环观测器：当转速超过切换阈值（一般 5% 额定转速以上），反电动势足够大，切换到无感闭环。

这套流程是所有无感 FOC 都必须处理的核心工程问题。

3. FOC 硬件架构与采样方案

3.1 采样电阻与电流采样方案

FOC 需要实时获取三相电流，常见的电流采样方案有三种：

双电阻采样是工程中最常用的折中方案。因为三相电流满足基尔霍夫定律，采样两相电流后，第三相通过计算得到：

i_c = -i_a - i_b;

双电阻采样需要特别注意采样时刻。电流采样必须在 PWM 下桥臂导通、电流流过采样电阻时进行，一般选择在 PWM 计数器的中心点或特定边沿触发。

3.2 双电阻采样与定时器触发 ADC

STM32 做双电阻采样，经典做法是用高级定时器的 TRGO 事件触发 ADC 注入组采样。

在 PWM 中心对齐模式下，计数器向上计数到 ARR 再向下计数。下桥臂在计数值大于比较值时导通，因此定时器计数到 0（或 ARR）附近时，下桥臂导通时间最长，电流采样最可靠。

配置思路如下：

1. 高级定时器 TIM1 输出六路互补 PWM。
2. 配置 TIM1 的重复计数器和 TRGO 事件，在计数器上溢/下溢时触发 ADC。
3. ADC 注入组同时采样两路电流通道。

HAL 库中关键的触发配置：

// TIM1 配置 TRGO 为更新事件 sMasterConfig.MasterOutputTrigger = TIM_TRGO_UPDATE; HAL_TIMEx_MasterConfigSynchronization(&htim1, &sMasterConfig);

ADC 采样保持时间需要足够长。实际项目里常见问题是采样点太靠近 PWM 边沿，电流尚未稳定，导致采样值偏小或噪声大。建议使用示波器抓取采样电阻两端波形，确认采样窗口内的电流平台期。

3.3 双电机采样组扫描双触发

当项目需要同步控制两个电机（比如双轮机器人、双轴云台）时，两个电机的 PWM 和 ADC 采样需要协调。

“双电机采样组扫描双触发”可以理解为：两个电机共用或分时使用 ADC 采样组，通过扫描方式依次采集两路电机的相电流，并且依靠两次触发事件完成一轮完整采样。

常见实现方式有两种：

方案一：一个 ADC 扫描两个采样组

使用两个定时器（TIM1 和 TIM8）分别输出两路 PWM，各自产生 TRGO 触发 ADC 注入组。但同一个 ADC 同一时刻只能执行一个转换序列，因此需要错开触发时刻。

方案二：两个 ADC 分别采样

STM32 的 ADC1 和 ADC2 可以组成双重模式，也可以各自独立工作。每个电机使用独立的 ADC 和定时器触发，互不干扰，适合对实时性要求高的场景。

// 伪代码示意：双电机电流采样 void HAL_TIM_PeriodElapsedCallback(TIM_HandleTypeDef *htim) { if (htim->Instance == TIM1) { // 电机1电流采样完成，执行 FOC 计算 Motor1_FOC_Update(); } else if (htim->Instance == TIM8) { // 电机2电流采样完成，执行 FOC 计算 Motor2_FOC_Update(); } }

双电机 FOC 需要注意：

• 两个电机的 PWM 频率和死区时间尽量一致，便于调试。
• 如果共用一个母线，需要考虑母线电压跌落对两个环路的影响。
• 同步触发会导致瞬时电流过大，尽量错相 180° 触发。

3.4 芯片选型：STM32G4 与 STM32H7

当前做 FOC 主控，STM32G4 和 STM32H7 是两个热门选择。

STM32G4 系列的优势：

• 内置 CORDIC 硬件加速器，三角函数计算速度大幅提升。
• 内置数学加速器，支持除法、平方根等运算。
• 170MHz 主频，适合单电机乃至双电机 FOC。
• 内置比较器、运放（部分型号），可以简化电流采样电路。
• 有专用电机控制套件和参考代码。

STM32H7 系列的优势：

• 主频高（400MHz 以上），算力强，适合复杂观测器（EKF、非线性观测器）。
• 可以做多电机控制加其他复杂算法。
• 12 位 ADC 性能更好，支持高精度采样。

从性价比看，如果项目只做单电机或双电机 FOC，STM32G4 是更合适的选择，CORDIC 外设在实时控制中非常实用。如果需要在 FOC 基础上叠加机器人运动学、路径规划等重负载算法，可以考虑 STM32H7。

4. 从零开始实现 STM32 无刷电机 FOC

4.1 环境准备与工程结构

本文示例以 STM32G4 系列为主控，开发环境使用 STM32CubeIDE，HAL 库版本以你实际创建的工程为准。硬件上，需要一块带三相逆变桥和双电阻采样电路的驱动板，以及一个带霍尔或编码器的 PMSM 电机（调试无感算法时，有位置传感器做对比非常有用）。

工程目录建议按模块拆分：

FOC_Demo/ ├── Core/ │ ├── Inc/ │ └── Src/ │ ├── main.c │ ├── foc.c │ ├── foc.h │ ├── pid.c │ ├── pid.h │ ├── smo.c │ ├── smo.h │ └── motor_control.c ├── Drivers/ └── Debug/

模块职责划分：

• foc.c：坐标变换、SVPWM、FOC 主循环。
• pid.c：PID 控制器实现。
• smo.c：滑模观测器和锁相环。
• motor_control.c：根据电机状态执行启动、开环、闭环切换。

4.2 ADC 采样与坐标变换

先定义一个电机控制结构体：

// foc.h typedef struct { float i_a; float i_b; float i_c; float i_alpha; float i_beta; float i_d; float i_q; float v_alpha; float v_beta; float v_d; float v_q; float theta_elec; float theta_mech; float speed; } FOC_HandleTypeDef;

ADC 采样完成中断中读取两相电流：

// 文件路径：motor_control.c void HAL_ADCEx_InjectedConvCpltCallback(ADC_HandleTypeDef *hadc) { if (hadc->Instance == ADC1) { uint32_t raw_a = HAL_ADCEx_InjectedGetValue(&hadc1, ADC_INJECTED_RANK_1); uint32_t raw_b = HAL_ADCEx_InjectedGetValue(&hadc1, ADC_INJECTED_RANK_2); // 转换成实际电流值，需要根据采样电阻和运放增益标定 float i_a = (raw_a - ADC_MID_POINT) * CURRENT_SCALE; float i_b = (raw_b - ADC_MID_POINT) * CURRENT_SCALE; FOC.i_a = i_a; FOC.i_b = i_b; FOC.i_c = -i_a - i_b; // 触发 FOC 计算 FOC_Update(); } }

注意，ADC_MID_POINT是零电流时的 ADC 采样值，一般接近 2048（12 位 ADC）。CURRENT_SCALE由采样电阻阻值和运放放大倍数共同决定。这两个参数对 FOC 控制质量影响很大，建议用恒流源或高精度万用表标定。

4.3 开环代码实现

在闭环之前，先实现开环控制验证硬件和 PWM 输出是否正常。开环控制不依赖电流采样和角度反馈，而是按照给定的电频率直接输出电压矢量。

// foc.c void FOC_OpenLoop(float voltage, float frequency, float dt) { static float theta = 0.0f; float omega = 2.0f * 3.14159265f * frequency; theta += omega * dt; if (theta > 2.0f * 3.14159265f) { theta -= 2.0f * 3.14159265f; } // 在 d 轴施加电压，让转子跟随同步旋转 float u_alpha = -voltage * sinf(theta); float u_beta = voltage * cosf(theta); SVPWM_Update(u_alpha, u_beta); }

开环测试时，母线电压不要给太高，频率从低到高缓慢增加。需要注意：开环强行拖动，负载较大或加速度过快时，电机会失步。

4.4 闭环 FOC 代码实现

闭环 FOC 的主循环由电流采样中断触发，执行一次完整的电流环计算：

// foc.c void FOC_Update(void) { // 1. Clark 变换 FOC.i_alpha = FOC.i_a; FOC.i_beta = (FOC.i_a + 2.0f * FOC.i_b) * 0.57735026919f; // 2. Park 变换 float cos_theta = arm_cos_f32(FOC.theta_elec); float sin_theta = arm_sin_f32(FOC.theta_elec); FOC.i_d = FOC.i_alpha * cos_theta + FOC.i_beta * sin_theta; FOC.i_q = -FOC.i_alpha * sin_theta + FOC.i_beta * cos_theta; // 3. 电流 PI 控制（id=0 控制策略） float v_d_ref = PID_Update(&pid_d, 0.0f, FOC.i_d); float v_q_ref = PID_Update(&pid_q, speed_ref_to_iq, FOC.i_q); // 4. 逆 Park 变换 FOC.v_alpha = v_d_ref * cos_theta - v_q_ref * sin_theta; FOC.v_beta = v_d_ref * sin_theta + v_q_ref * cos_theta; // 5. SVPWM 输出 SVPWM_Update(FOC.v_alpha, FOC.v_beta); }

速度环可以放在主循环中低频执行：

// main.c 主循环 while (1) { if (speed_loop_ready) { speed_loop_ready = 0; // 速度 PI 输出作为 q 轴电流给定 float speed_error = speed_ref - FOC.speed; iq_ref = speed_pid.Kp * speed_error + speed_pid.integral; // 限制最大电流保护 if (iq_ref > MAX_CURRENT) iq_ref = MAX_CURRENT; if (iq_ref < -MAX_CURRENT) iq_ref = -MAX_CURRENT; } }

角度来源可以是编码器，也可以是无感观测器。有感调试时，直接读取编码器角度：

FOC.theta_elec = encoder_angle * POLE_PAIRS; FOC.speed = encoder_speed_filtered;

无感切换时，替换成观测器输出：

FOC.theta_elec = SMO_GetAngle(); FOC.speed = SMO_GetSpeed();

4.5 运行与波形验证

通过串口或 DAC 输出调试关键变量，建议至少观察以下波形：

• 三相电流波形：应该是平滑正弦波。
• ( i_d )、( i_q ) 波形：稳态时 ( i_d ) 应接近 0，( i_q ) 平稳。
• 角度估算值与真实编码器角度误差：无感模式下应保持在小范围内。

电流波形有明显畸变时，优先检查：

• ADC 采样时刻是否正确。
• 采样电阻电流平台是否稳定。
• 扇区切换点是否存在跳变。

5. 常见问题与排查思路

高频排查技巧：启动前把开环电压幅值设为 0，手动转动电机轴，观察 ADC 采样值是否随转子位置正弦变化。如果波形正常，说明电流采样链路基本没有问题。

无感 FOC 的启动失步问题是最常见的，也是最难排查的。建议按“定位 -> 开环拖动 -> 闭环切换”三步细化调试，每一步单独验证：

// 状态机伪代码 switch (motor_state) { case STATE_ALIGN: // 输出固定电压矢量定位 500ms SVPWM_Update(align_angle, align_voltage); if (align_timer >= 500ms) motor_state = STATE_OPENLOOP; break; case STATE_OPENLOOP: // 频率斜坡加速 freq += ramp_rate * dt; FOC_OpenLoop(voltage, freq, dt); if (freq >= SWITCH_SPEED) { // 记录当前角度为闭环初始角度 SMO_ResetAngle(openloop_theta); motor_state = STATE_CLOSEDLOOP; } break; case STATE_CLOSEDLOOP: FOC_CloseLoop(); break; }

切换时的关键是让开环角度与观测器角度尽量连续，否则会有冲击。可以先把观测器放在一旁实时运行，但不用它的角度控制，切换瞬间让观测器角度跟踪当前开环角度。

6. 工程最佳实践建议

6.1 电流采样标定

每次上电应执行 ADC 零点校准，把当前静止状态的采样值记录为偏移量。如果运放存在温漂，还需要定期校正。零点偏移是电流波形不对称、转矩脉动的常见来源。

6.2 母线电压保护

在 FOC 控制中增加母线电压监测。母线电压过低时，SVPWM 输出会进入过调制区，电流波形恶化；母线电压过高时，可能损坏功率器件。建议实现欠压、过压两级保护。

6.3 温度与过流保护

利用 MCU 内置比较器或 ADC 实现硬件过流保护。软件过流保护速度不够快，建议过流信号直接触发 PWM 刹车（Break）功能，同时进入故障状态，必须手动复位才能恢复。

6.4 观测器参数整定

无感观测器的参数整定需要和电机参数匹配。定子电阻 ( R_s ) 和电感 ( L_s ) 可以通过以下方式获取：

• 电阻：万用表测量两相间电阻，再除以 2。
• 电感：使用 LCR 表在 1kHz 左右频率测量。

电机参数不准时，无感角度会有系统性误差，表现为带载能力下降或高速时噪声增大。

6.5 调试和数据记录

将 FOC 内部变量按结构体集中管理，方便通过调试器或串口查看。推荐在代码中实现一个简单的变量监视接口，可以在线修改 PID 参数、电流限幅和切换速度，大幅提升调试效率。

// 简单的在线调参结构 typedef struct { float kp_current; float ki_current; float kp_speed; float ki_speed; float current_limit; float switch_speed; } MotorParams_TypeDef;

6.6 安全注意事项

调试点动电机前，确认机械机构固定可靠，避免旋转部件伤人。母线电容放电完成后才能触碰功率板，高压实验务必使用隔离电源和隔离探头。

7. 后续学习路线

掌握本文内容后，可以继续深入以下方向：

• 学习高频注入（HFI）方法，解决零速和低速无感控制问题。
• 研究模型预测控制（MPC）在电机控制中的应用，替代传统 PI + SVPWM。
• 学习 STM32G4 的 Cordic 和数学加速器的进一步用法，实现更高载波频率的 FOC。
• 尝试多电机同步控制，在双电机方案中对比同步触发与错相触发的实际效果。
• 研究弱磁控制，让 PMSM 在额定转速以上运行。

FOC 是一个理论与实践结合很强的领域。建议先在有感模式下把电流环调顺，再切换无感；先跑通开环，再切入闭环。每一步都保留可回退的测试节点，这样项目推进会更稳。如果这篇文章对你有帮助，可以收藏备用，后续我也会继续发布更多 FOC 驱动和 STM32 电机控制相关的实战记录。