从零构建基于STM32的伺服电机FOC驱动系统
1. 伺服电机与FOC控制基础
伺服电机作为精密运动控制的核心部件，在工业自动化、机器人、数控机床等领域发挥着关键作用。永磁同步电机（PMSM）因其高效率、高功率密度和优异的动态性能，成为伺服驱动的主流选择。与传统的有刷直流电机不同，PMSM需要通过电子换相来实现转子位置跟踪，这就离不开磁场定向控制（Field Oriented Control, FOC）这项关键技术。
我第一次接触FOC是在一个机械臂项目中，当时被其复杂的数学推导吓退，直到实际动手搭建系统才发现，只要掌握几个关键要点，就能让电机平稳运转起来。FOC的本质可以理解为"电子换向器"，它通过坐标变换将三相交流量转换为直流量进行控制，就像把交流电"整流"一样简单直观。这种控制方式最大的优势是能让电机在全速度范围内保持最佳扭矩输出，实现类似直流电机的控制特性。
在实际项目中，我们通常会遇到两种PMSM：表贴式（SPM）和内置式（IPM）。前者结构简单、成本低，适合大多数通用场景；后者磁阻转矩占比高，更适合需要宽调速范围的场合。选择电机时除了关注额定功率和转速，更要留意几个关键参数：反电动势常数（Ke）、转矩常数（Kt）、相电阻（R）和电感（L），这些参数直接影响控制算法的实现效果。
2. STM32硬件平台选型与配置
STM32系列MCU凭借其丰富的外设和出色的实时性能，成为电机控制领域的明星产品。我在多个项目中对比测试后发现，STM32F4系列在性价比和性能上达到了很好的平衡。以F407为例，其168MHz主频配合硬件FPU，可以轻松应对FOC算法的计算需求，内置的高级定时器更是为电机控制量身定制。
硬件设计中最容易踩坑的是电源电路。有一次我设计的驱动板在电机启动瞬间频繁重启，后来发现是电源芯片的瞬态响应不足。现在我的标准配置是采用TPS54360这类宽输入范围的DC-DC芯片，配合低ESR的陶瓷电容，确保在电机大电流突变时电压依然稳定。具体电路设计中要注意几点：
- 输入电容要靠近芯片引脚放置
- 反馈电阻分压网络走线要短
- 电感选型要考虑饱和电流余量
电流采样是FOC系统的"眼睛"，常见的有三电阻、单电阻和霍尔传感器三种方案。新手我建议从三电阻开始，虽然多占用两个ADC通道，但信号处理简单可靠。关键点在于：
- 采样电阻要选用低温度系数的合金电阻（如10mΩ/2W）
- 运放电路需提供1.65V偏置电压（3.3V供电时）
- PCB布局要避免功率回路对采样信号的干扰
3. 逆变器与驱动电路设计
逆变器相当于电机的"咽喉"，其性能直接决定系统可靠性。我早期项目中最惨痛的教训就是MOS管炸机，后来总结出几个设计要点：
- 栅极驱动电阻要精心调整（通常10-100Ω）
- 自举电容容量需足够（一般0.1-1μF）
- 功率回路面积要最小化
驱动芯片选型上，IR2110是经典型号，但新设计的项目我更推荐使用ST的L6390这类智能驱动IC。它们集成了死区控制、欠压锁定等保护功能，大大简化了外围电路。一个实用的技巧是在每个MOS管栅极并联12V稳压管，防止栅源极电压超标。
保护电路是容易被忽视的关键环节。过流保护建议采用硬件比较器+软件判断的双重机制：比较器提供ns级快速关断，软件算法实现精确阈值控制。具体实现时，将采样电压与参考电压比较，输出信号连接到MCU的刹车引脚和PWM使能端。
4. 软件架构与关键算法实现
STM32的电机控制软件开发可以基于HAL库或直接寄存器操作。对于初学者，我建议先用STM32CubeMX生成基础代码框架，再逐步深入底层优化。系统初始化要特别注意时钟配置，错误的时钟分配会导致PWM频率偏差或ADC采样不准。
PWM生成是软件的核心，配置高级定时器时重点关注：
// 定时器基础配置示例 htim1.Instance = TIM1; htim1.Init.Prescaler = 0; htim1.Init.CounterMode = TIM_COUNTERMODE_CENTERALIGNED3; htim1.Init.Period = PWM_PERIOD; htim1.Init.ClockDivision = TIM_CLOCKDIVISION_DIV1; htim1.Init.RepetitionCounter = 0; htim1.Init.AutoReloadPreload = TIM_AUTORELOAD_PRELOAD_ENABLE;电流采样时机对FOC性能影响巨大。我的经验是在PWM周期中点采样最稳定，此时功率管导通状态明确，电流纹波最小。ADC配置要开启注入通道和规则通道的同步采样，确保三相电流采样的时间一致性。
SVPWM算法实现其实没有想象中复杂，核心步骤包括：
- Clarke变换（3相→2相）
- Park变换（静止→旋转坐标系）
- PI调节器输出Vd/Vq
- 反Park变换
- 扇区判断和占空比计算
调试时常见的问题是电机抖动或异响，这通常是因为：
- 电流采样相位不准
- PI参数不合适
- PWM死区时间设置不当
5. 系统调试与性能优化
搭建好硬件和基础软件后，调试要分步进行。我习惯的流程是：
- 先验证电源电路（空载测试各电压）
- 检查PWM输出（用示波器观察六路波形）
- 测试电流采样（给固定占空比观察ADC值）
- 开环运行（固定角度增量观察电机转动）
- 闭环调试（逐步增加速度环、电流环）
PID参数整定是个经验活，我的入门技巧是：
- 先调电流环（响应要快）
- 再调速度环（避免超调）
- 最后位置环（注重稳态精度）
一个实用的调试工具是ST的MotorControl Workbench，它可以实时监控电机参数，自动生成PID参数。但在量产项目中，还是需要根据实际负载特性进行手动微调。
在完成基础功能后，还可以进一步优化：
- 注入高频信号实现无传感器控制
- 添加前馈补偿提高动态响应
- 实现MTPA控制提升效率
记得在一次无人机电调项目中，通过优化SVPWM的零矢量分配，将系统效率提升了5%，这说明细节优化往往能带来意想不到的收获。