ST双电机FOC与霍尔控制解析

ST FOC双电机控制与霍尔位置检测驱动技术深度解析

在电动滑板车、AGV小车或协作机器人这类设备中，你是否曾思考过：为什么两个轮子能如此协调地加速、转弯甚至原地旋转？背后的关键，往往是一套精巧的 双电机同步控制系统 。而当成本敏感、环境恶劣、空间受限时，工程师们越来越倾向于选择一种既经济又可靠的方案——基于意法半导体（ST）平台，采用霍尔传感器实现的FOC双电机驱动系统。

这不仅仅是一个“省掉编码器”的简单替代方案，而是一整套融合了控制理论、嵌入式架构和信号处理的综合性设计。今天我们就来拆解这个名为“ST FOC-双电机控制-霍尔驱动.rar”压缩包背后的完整技术逻辑，看看它是如何用一颗STM32芯片，同时驾驭两台永磁同步电机（PMSM），并在没有高精度传感器的情况下依然保持稳定运行的。

---

说到高性能电机控制，绕不开的就是FOC——磁场定向控制。它之所以被称为“交流电机中的直流控制魔法”，是因为它通过坐标变换，把复杂的三相交流电流分解成两个独立变量：一个负责建立磁场（Id），另一个直接决定输出转矩（Iq）。这样一来，就像控制直流电机一样，可以精准调节转速和力矩。

但这一切的前提是：必须知道转子当前精确的电角度θ。否则Park变换就失去了参考系，整个闭环控制就会崩溃。传统做法是加装编码器或旋变，但这不仅增加成本，还带来布线复杂性和可靠性隐患。于是，很多实际应用转向了更务实的选择： 霍尔传感器 。

霍尔本身只能提供6个离散状态，每60°电角度切换一次，原始分辨率显然不够用于连续的FOC运算。但聪明的做法是结合速度估算与角度插值——比如在一个PWM中断周期内，根据上一时刻的角度差推算出转速，再积分得到当前角度。虽然听起来粗糙，但在中低速场景下，配合简单的滤波算法（如一阶IIR或锁相环PLL），完全可以生成足够平滑的电角度轨迹。

下面这段代码就是一个典型的霍尔角度重建过程：

uint8_t Get_Hall_Sector(void) {
    uint8_t hall = 0;
    hall |= HAL_GPIO_ReadPin(HALL_U_PORT, HALL_U_PIN) << 2;
    hall |= HAL_GPIO_ReadPin(HALL_V_PORT, HALL_V_PIN) << 1;
    hall |= HAL_GPIO_ReadPin(HALL_W_PORT, HALL_W_PIN);

    const uint8_t hall_to_sector[8] = {0xFF, 5, 3, 4, 1, 0, 2, 0xFF};
    return hall_to_sector[hall];
}

void Hall_Electrical_Angle_Update(Motor_TypeDef *motor) {
    uint8_t sector = Get_Hall_Sector();
    float base_angle = (sector + 0.5f) * M_PI / 3.0f;

    float delta_t = 0.0001f; // 100μs
    float speed_est = (base_angle - motor->prev_base_angle) / delta_t;
    motor->prev_base_angle = base_angle;

    motor->speed_rps = 0.8f * motor->speed_rps + 0.2f * speed_est;
    motor->electrical_angle += motor->speed_rps * delta_t;

    if (motor->electrical_angle >= 2*M_PI)
        motor->electrical_angle -= 2*M_PI;
}

这里的关键在于“动态预测”。即使霍尔跳变存在延迟或抖动，只要电机转速变化不剧烈，积分后的角度仍然具有良好的连续性。当然，在极端低速或启停瞬间，这种方法会暴露出局限性，这也是为什么许多厂商会在启动阶段加入短时开环强励，确保顺利跨过第一个换相区。

那么问题来了：如果单个电机的角度估算已经需要精细调参， 两个电机同时运行怎么办 ？难道要用两颗MCU？

答案是否定的。ST的STM32系列中，像G474、H743这样的型号配备了双ADC模块、多路高级定时器（TIM1/TIM8）以及独立DMA通道，完全支持在一个核心上并行处理双通道FOC任务。典型做法是在PWM更新中断中采用时间分片调度：

typedef enum {
    MOTOR1_PROCESSING,
    MOTOR2_PROCESSING,
} ControlState_e;

ControlState_e control_state = MOTOR1_PROCESSING;

void TIM1_UP_IRQHandler(void) {
    if (control_state == MOTOR1_PROCESSING) {
        FOC_Control_Loop(&motor1);
        control_state = MOTOR2_PROCESSING;
    } else {
        FOC_Control_Loop(&motor2);
        control_state = MOTOR1_PROCESSING;
    }
    HAL_TIM_IRQHandler(&htim1);
}

这种交替执行的方式看似简单，实则对系统实时性提出了严格要求：每个FOC循环的计算时间必须远小于中断周期（通常为50~100μs）。幸运的是，STM32的FPU单元和优化过的数学库（如CORDIC、SIMD指令支持）大大减轻了三角函数运算负担；再加上ST官方提供的Motor Control SDK内置了高度优化的FOC函数集，开发者可以直接调用成熟模块，避免从零造轮子。

更进一步，SDK还提供了“Dual Drive”配置模板，允许用户为每台电机独立设置PID参数、电流限幅、加减速曲线等，从而灵活应对差速转向、主从跟随等复杂工况。例如在平衡车上，左电机加速的同时右电机减速，系统只需修改 Iq_ref 目标值即可实现原地转弯，无需额外通信协议协调。

硬件层面的设计也同样讲究。为了防止资源冲突，推荐使用以下外设分配策略：

• ADC1 → Motor1三相电流采样
• ADC2 → Motor2三相电流采样
• TIM1 → Motor1 PWM输出（互补通道+死区）
• TIM8 → Motor2 PWM输出
• GPIOA/B/C → 双组霍尔输入（注意电平兼容与去抖）
• CAN/USART → 上位机指令下发或状态上报

特别是电流采样部分，建议采用隔离放大器（如AMC1306）而非普通运放，既能提高共模抑制比，又能保护MCU免受功率侧噪声干扰。PWM开关频率一般设定在10~20kHz之间，太低会产生明显电磁噪音，太高则导致MOSFET温升加剧。

软件结构上，强烈建议为每台电机维护独立的控制句柄（ Motor_Handle ），包含各自的PI控制器、观测器状态、故障标志等。这样不仅便于单独调试，还能在异常情况下快速定位问题源。此外，非实时任务（如蓝牙通信、LCD显示）应交由RTOS管理，避免阻塞主控中断。

值得一提的是，这套方案最大的优势之一就是 天然同步性 。由于两套FOC算法共享同一个时钟源和中断节拍，不存在主从控制器之间的通信延迟，因此在动态响应一致性方面远超双MCU架构。这对于需要精密协同的应用——比如双轴云台、并联机械臂——尤为重要。

当然，任何技术都有其边界。霍尔FOC在高速下表现尚可，但在极低速或静止状态下容易因信号缺失而导致失步。对此，一些进阶方案开始尝试“混合传感”策略：正常运行时依赖霍尔+PLL提供角度反馈，而在启动或爬坡阶段临时切换至无感观测器（如滑模、EKF），待产生足够反电动势后再无缝切回。这类方法虽增加了算法复杂度，但也显著拓宽了工作范围。

回到最初的问题：为什么这套“ST + 双电机 + 霍尔”的组合如此受欢迎？因为它击中了工业落地的核心痛点—— 性价比与鲁棒性的平衡 。相比昂贵的编码器方案，它节省了至少30%的BOM成本；相比纯无感控制，它在粉尘、潮湿环境中更具稳定性；而单芯片双驱的设计，则让PCB面积和EMC设计都更加简洁可控。

对于初创团队或量产项目而言，这意味着更快的验证周期、更低的风险和更高的良率。事实上，ST Motor Control SDK中提供的示例工程已经涵盖了完整的霍尔FOC双电机框架，开发者只需根据电机参数调整PI增益、母线电压、极对数等配置项，就能在几天内完成原型搭建。

未来的发展方向也很清晰：一方面向更高集成度演进（如将栅极驱动、电流检测集成进智能功率模块），另一方面则是算法智能化——利用机器学习在线辨识电机参数，自适应调节控制策略。但在当下，这套经过千锤百炼的传统方案，依然是无数产品背后默默运转的“心脏”。

某种意义上，这正是嵌入式工程的魅力所在：不需要最前沿的技术，也不追求极致性能，而是用扎实的底层功底，在有限资源下做出最优取舍。当你骑着一辆轻便电动车平稳起步时，或许不会想到，那股柔和却有力的驱动力，正源自一段精心编排的SVPWM波形，和几个不断跳变的霍尔电平信号。