别再死记硬背公式了！用Arduino+DRV8313手把手带你玩转FOC电机控制（附SVPWM核心代码）
用Arduino+DRV8313实现FOC电机控制的实战指南
当你第一次接触FOC（Field-Oriented Control，磁场定向控制）时，那些复杂的数学公式和理论推导可能会让你望而却步。但别担心，本文将带你绕过这些理论深坑，直接从硬件接线和代码实现入手，让你快速看到电机转起来的效果。我们将使用常见的Arduino开发板和DRV8313电机驱动芯片，通过实际的代码示例和接线图，一步步实现FOC控制中最核心的SVPWM（Space Vector Pulse Width Modulation，空间矢量脉宽调制）技术。
1. 硬件准备与基础概念
在开始之前，我们需要准备以下硬件组件：
- Arduino开发板：推荐使用Arduino Due或Teensy 4.0等高性能型号，因为它们具有更高的时钟频率和更多的PWM输出通道
- DRV8313电机驱动板：这是一款三相无刷电机驱动器，内置MOSFET和驱动电路
- 无刷电机：推荐使用带有霍尔传感器或编码器的电机，便于后续扩展
- 电源：根据电机规格选择合适的直流电源（通常12V-24V）
- 逻辑电平转换器（可选）：如果Arduino与DRV8313的电压不匹配
FOC控制的核心思想是将三相交流电机的控制简化为类似直流电机的控制方式。它通过Clarke和Park变换，将三相电流分解为直轴（Id）和交轴（Iq）分量，分别控制磁通和转矩。而SVPWM则是实现这一控制的关键技术，它能高效地利用直流母线电压，产生平滑的电机旋转磁场。
提示：初学者常犯的错误是直接跳入复杂的数学推导。实际上，你可以先通过开环控制让电机转起来，再逐步加入闭环控制环节。
2. DRV8313与Arduino的硬件连接
DRV8313是一款非常适合初学者使用的三相电机驱动器，它集成了以下关键功能：
- 三个半桥MOSFET驱动器
- 内置死区时间控制
- 过流、过热保护
- 可编程的PWM输入模式
下面是DRV8313与Arduino的典型连接方式：
| DRV8313引脚 | Arduino引脚 | 功能描述 |
|---|---|---|
| INH_A | 9 | A相PWM使能 |
| INH_B | 10 | B相PWM使能 |
| INH_C | 11 | C相PWM使能 |
| IN_A | 6 | A相PWM输入 |
| IN_B | 7 | B相PWM输入 |
| IN_C | 8 | C相PWM输入 |
| nFAULT | 2 | 故障中断输入 |
| VCC | 5V | 逻辑电源 |
| GND | GND | 公共地 |
// Arduino引脚定义 const int INH_A = 9; const int INH_B = 10; const int INH_C = 11; const int IN_A = 6; const int IN_B = 7; const int IN_C = 8; const int nFAULT = 2; void setup() { // 初始化所有PWM引脚为输出 pinMode(INH_A, OUTPUT); pinMode(INH_B, OUTPUT); pinMode(INH_C, OUTPUT); pinMode(IN_A, OUTPUT); pinMode(IN_B, OUTPUT); pinMode(IN_C, OUTPUT); pinMode(nFAULT, INPUT); // 设置PWM频率为20kHz analogWriteFrequency(IN_A, 20000); analogWriteFrequency(IN_B, 20000); analogWriteFrequency(IN_C, 20000); }3. SVPWM的核心算法实现
SVPWM的核心是将期望的电压矢量分解为两个相邻的非零矢量和零矢量，按照伏秒平衡原则计算各矢量的作用时间。以下是实现SVPWM的关键步骤：
3.1 扇区判断
首先需要根据电压矢量的位置确定所在的扇区（共6个扇区，每个60度）：
int getSector(float Ualpha, float Ubeta) { float U1 = Ubeta; float U2 = sqrt(3)*Ualpha - Ubeta; float U3 = -sqrt(3)*Ualpha - Ubeta; int A = (U1 > 0) ? 1 : 0; int B = (U2 > 0) ? 1 : 0; int C = (U3 > 0) ? 1 : 0; int N = 4*A + 2*B + C; const int sectorTable[8] = {0, 5, 3, 4, 1, 6, 2, 0}; return sectorTable[N]; }3.2 作用时间计算
根据扇区计算两个相邻非零矢量的作用时间：
void calcTimes(float Ualpha, float Ubeta, int sector, float* T1, float* T2) { float sqrt3 = sqrt(3); float Ts = 1.0 / PWM_FREQ; // PWM周期 switch(sector) { case 1: *T1 = (sqrt3*Ts/Udc) * ( sqrt3/2*Ualpha - 0.5*Ubeta); *T2 = (sqrt3*Ts/Udc) * Ubeta; break; case 2: *T1 = (sqrt3*Ts/Udc) * ( sqrt3/2*Ualpha + 0.5*Ubeta); *T2 = (sqrt3*Ts/Udc) * (-sqrt3/2*Ualpha + 0.5*Ubeta); break; // 其他扇区类似... } // 限制作用时间不超过Ts if(*T1 + *T2 > Ts) { float scale = Ts / (*T1 + *T2); *T1 *= scale; *T2 *= scale; } }3.3 PWM占空比生成
将作用时间转换为PWM占空比：
void setPWM(int sector, float T1, float T2) { float Ta, Tb, Tc; float Ts = 1.0 / PWM_FREQ; float T0 = (Ts - T1 - T2) / 2; switch(sector) { case 1: Ta = T1 + T2 + T0; Tb = T2 + T0; Tc = T0; break; case 2: Ta = T1 + T0; Tb = T1 + T2 + T0; Tc = T0; break; // 其他扇区类似... } // 设置PWM占空比 analogWrite(IN_A, Ta/Ts * 255); analogWrite(IN_B, Tb/Ts * 255); analogWrite(IN_C, Tc/Ts * 255); }4. 完整的FOC控制流程
现在我们将各个部分组合起来，实现一个完整的FOC控制流程：
- 电流采样：通过ADC读取三相电流（需要电流传感器）
- Clarke变换：将三相电流转换为静止坐标系下的Iα和Iβ
- Park变换：将Iα和Iβ转换为旋转坐标系下的Id和Iq
- PI调节器：计算控制电压Vq和Vd
- 反Park变换：将Vq和Vd转换回静止坐标系
- SVPWM生成：如前面所述
以下是主控制循环的简化代码：
void loop() { // 1. 电流采样 float Ia = readCurrentA(); float Ib = readCurrentB(); float Ic = readCurrentC(); // 2. Clarke变换 float Ialpha = Ia; float Ibeta = (Ia + 2*Ib) / sqrt(3); // 3. Park变换 float theta = getMotorAngle(); // 从编码器获取 float Id = Ialpha * cos(theta) + Ibeta * sin(theta); float Iq = -Ialpha * sin(theta) + Ibeta * cos(theta); // 4. PI调节器 float Vd = pidD.update(Id_ref - Id); float Vq = pidQ.update(Iq_ref - Iq); // 5. 反Park变换 float Valpha = Vd * cos(theta) - Vq * sin(theta); float Vbeta = Vd * sin(theta) + Vq * cos(theta); // 6. SVPWM生成 int sector = getSector(Valpha, Vbeta); float T1, T2; calcTimes(Valpha, Vbeta, sector, &T1, &T2); setPWM(sector, T1, T2); delayMicroseconds(100); // 控制周期 }5. 调试技巧与常见问题
在实际调试过程中，你可能会遇到以下问题：
电机不转或抖动：
- 检查PWM频率是否合适（通常10-20kHz）
- 确认电机相序是否正确
- 检查DRV8313的故障引脚状态
电流波形不理想：
- 调整PI调节器参数
- 检查电流采样是否准确
- 确保SVPWM作用时间计算正确
电机发热严重：
- 降低PWM频率
- 检查是否有短路或过流
- 优化SVPWM算法减少谐波
注意：初次调试时建议先使用开环控制，即直接给定Valpha和Vbeta值，而不使用电流反馈。这样可以先验证硬件连接和基本功能是否正常。
6. 性能优化与扩展
一旦基本功能正常工作，你可以考虑以下优化和扩展：
- 增加速度环控制：在电流环外增加速度PID控制
- 实现位置控制：最外环增加位置控制
- 磁场弱化控制：在高速运行时扩展速度范围
- 观测器设计：实现无传感器控制
以下是速度环的简单实现：
float speed_ref = 1000; // RPM float speed = getMotorSpeed(); // 从编码器计算 float Iq_ref = pidSpeed.update(speed_ref - speed); // 然后在主循环中使用这个Iq_ref通过本文的实践方法，你应该能够避开复杂的数学推导，快速建立起对FOC控制的直观理解。记住，最好的学习方式是动手实践——先让电机转起来，再逐步深入理解背后的原理。