从平衡车到无人机：手把手教你用STM32 CubeMX配置FOC驱动无刷电机（有感/无感模式切换）
从平衡车到无人机：STM32 CubeMX实战FOC无刷电机驱动（有感/无感双模式）
在智能硬件开发领域，无刷电机的精准控制一直是提升设备性能的关键。无论是平衡车的自稳定系统，还是无人机云台的防抖补偿，亦或是协作机器人的关节驱动，磁场定向控制（FOC）技术都能带来更高效的能源利用和更平滑的扭矩输出。本文将基于STM32F4硬件平台，通过CubeMX工具链和开源库实战演示如何快速构建支持有感/无感双模式切换的FOC驱动系统。
1. 硬件准备与开发环境搭建
1.1 硬件选型要点
- 主控芯片：STM32F405RG（Cortex-M4内核，带FPU浮点运算单元）
- 驱动板：DRV8305三相栅极驱动器（集成电流检测放大器）
- 无刷电机：2212 1000KV航模电机（测试用）
- 传感器：
- 增量式编码器（1000线）
- 霍尔传感器套件（可选）
提示：电机KV值需根据应用场景选择——平衡车推荐低KV高扭矩型号，无人机云台则需要高转速型号。
1.2 开发工具链配置
# 安装必备工具（Ubuntu示例） sudo apt install arm-none-eabi-gcc stlink-tools # CubeMX工程生成后编译命令 make -j4| 软件工具 | 版本要求 | 作用说明 |
|---|---|---|
| STM32CubeMX | ≥6.5.0 | 外设配置与代码生成 |
| STM32CubeIDE | 1.11.0 | 集成开发环境 |
| SimpleFOC库 | 2.2.1 | 开源FOC算法实现 |
| Saleae Logic | 2.3.52 | PWM波形与电流信号分析 |
2. CubeMX外设配置详解
2.1 定时器与PWM生成
在CubeMX中配置TIM1为中央对齐PWM模式，关键参数设置：
- 计数模式：中央对齐模式1
- PWM频率：20kHz（开关损耗与噪音的平衡点）
- 死区时间：500ns（根据MOSFET规格调整）
// 生成的PWM初始化代码片段 htim1.Instance = TIM1; htim1.Init.Prescaler = 0; htim1.Init.CounterMode = TIM_COUNTERMODE_CENTERALIGNED1; htim1.Init.Period = SystemCoreClock / 20000 - 1; // 20kHz htim1.Init.ClockDivision = TIM_CLOCKDIVISION_DIV1; htim1.Init.RepetitionCounter = 0; htim1.Init.AutoReloadPreload = TIM_AUTORELOAD_PRELOAD_ENABLE;2.2 ADC电流采样配置
采用双ADC交替采样模式提高采样率：
- 配置ADC1和ADC2为同步注入模式
- 设置采样时间为15个时钟周期
- 开启DMA传输至内存
注意：电流检测电阻应放置在低端，避免共模电压问题。推荐使用1mΩ/1%精度的采样电阻。
3. SimpleFOC库移植与配置
3.1 库结构概览
├── drivers/ │ ├── STM32F4_driver.cpp # 硬件抽象层 ├── sensors/ │ ├── Encoder.cpp # 编码器接口 │ ├── HallSensor.cpp # 霍尔传感器接口 ├── foc_utils/ │ ├── ClarkePark.cpp # 坐标变换 │ ├── SVM.cpp # 空间矢量调制3.2 电机参数校准
// 电机对象初始化示例 BLDCMotor motor = BLDCMotor(7); // 7对极电机 // 校准过程 motor.voltage_sensor_align = 3.0; // 对齐电压(V) motor.velocity_index_search = 2.0; // 无感启动搜索电压 motor.init(); motor.initFOC();| 参数类型 | 典型值范围 | 调节技巧 |
|---|---|---|
| PI电流环Kp | 0.5-3.0 | 从低值开始逐步增加 |
| PI电流环Ki | 50-300 | 观察电流波形过冲情况 |
| 速度环带宽 | 20-100Hz | 平衡车需更高带宽 |
4. 双模式切换实战
4.1 有感模式实现（编码器）
// 编码器配置实例 Encoder encoder = Encoder(ENC_A, ENC_B, 1000); void doA(){encoder.handleA();} void doB(){encoder.handleB();} encoder.enableInterrupts(doA, doB); motor.linkSensor(&encoder);4.2 无感模式实现（滑模观测器）
// 启用无感观测器 motor.controller = MotionControlType::velocity; motor.foc_modulation = FOCModulationType::SpaceVectorPWM; motor.sensor_direction = Direction::CCW; motor.voltage_limit = 12;4.3 运行时动态切换
通过串口指令触发模式切换：
# 上位机切换命令示例 import serial ser = serial.Serial('/dev/ttyACM0', 115200) ser.write(b'switch sensorless\n') # 切换到无感模式 ser.write(b'switch encoder\n') # 切换回编码器模式5. 应用场景调优指南
5.1 平衡车动量轮配置
- 速度环响应：≤5ms
- 电流限制：3倍额定电流（瞬时过载）
- 典型PID参数：
[velocity] P=0.15 I=2.0 D=0.0001
5.2 无人机云台优化
- 采用低通滤波器平滑指令：
motor.LPF_velocity.Tf = 0.05; // 50ms时间常数 - 机械共振抑制：
motor.P_angle.P = 10.0; motor.P_angle.D = 0.5;
在最近的一个四轴云台项目中，通过调整速度环积分项，成功将抖动幅度从±3°降低到±0.5°。关键发现是：过高的积分增益反而会引入高频振荡，这与传统PID调参经验有所不同。