当前位置：首页 > news >正文

基于STM32与滑模观测器的无感FOC算法工程实践

news 2026/3/26 19:33:06

1. 无感FOC与滑模观测器的核心原理

无感FOC（Field Oriented Control）控制的核心在于不依赖位置传感器，仅通过电流采样来估算转子位置。这就像蒙着眼睛骑自行车，需要通过身体感受的倾斜角度来调整平衡。滑模观测器（SMO）正是实现这种"感知"的关键算法。

滑模观测器的工作原理可以类比为玩"热冷"游戏：当估算角度偏离真实位置时，系统会通过电流误差给出"太热"或"太冷"的提示信号。SMO通过一个带有符号函数的反馈机制，强迫系统状态沿着预设的滑模面运动。具体实现时：

typedef struct { float i_alpha, i_beta; // 电流观测值 float v_alpha, v_beta; // 电压输入 float e_alpha, e_beta; // 误差项 float z_alpha, z_beta; // 滑模面变量 float theta_est; // 估算角度 float speed_est; // 估算速度(rad/s) } SMO_TypeDef;

在STM32中实现时，有三个关键参数需要特别注意：

滑模增益（K_SLIDE）：相当于游戏提示的强度，太大导致系统抖动，太小则响应迟钝
低通滤波截止频率：用于平滑估算角度，类似给摇晃的摄像头加防抖
电机电气参数（Rs/Ls）：相当于自行车的重量分布，参数不准会导致估算偏差

实测发现，当PWM频率设为10kHz时，对于极对数为7的电机，滑模增益在20-50范围内效果最佳。这个参数需要根据电机特性微调，就像不同体型的骑行者需要调整自行车把手灵敏度。

2. STM32硬件配置的工程细节

2.1 定时器与ADC的黄金组合

TIM1的配置是无感FOC的"心跳发生器"，需要特别注意三个要点：

中心对齐模式：选择模式1（TIM_COUNTERMODE_CENTERALIGNED1）可以减少电流纹波
死区时间计算：72MHz主频下，1us死区对应72个时钟周期
触发ADC的时机：利用CH4作为内部触发源，在PWM中点采样电流

// TIM1初始化关键代码 htim1.Init.CounterMode = TIM_COUNTERMODE_CENTERALIGNED1; htim1.Init.Period = 3600; // 72MHz/20kHz=3600（实际PWM频率10kHz） sBreakDeadTimeConfig.DeadTime = 72; // 1us死区 sMasterConfig.MasterOutputTrigger = TIM_TRGO_OC4REF;

ADC注入组的配置更要精益求精：

采样时间设为7.5个周期（ADC_SAMPLETIME_7CYCLES_5）
触发源选择TIM1_CH4（ADC_EXTERNALTRIGINJECCONV_T1_CC4）
采用双通道连续采样（INJECTED_RANK_1和2）

2.2 电流采样的硬件设计要点

在实际项目中，电流采样电路常成为性能瓶颈。建议采用：

三电阻采样方案：在低端MOSFET下方放置采样电阻
运放电路设计：使用差分放大电路，增益设为20-50倍
PCB布局要点：
- 采样电阻尽量靠近MOSFET
- 走线采用开尔文连接
- 避免PWM噪声耦合

一个常见的坑是运放电源电压不足。当母线电压为24V时，运放需要±12V供电才能准确放大电流信号。我曾遇到运放输出削顶导致控制失稳的问题，后来改用轨到轨运放才解决。

3. 软件实现的关键技巧

3.1 中断服务程序的优化

ADC中断服务程序是FOC的"神经中枢"，其执行时间直接影响控制性能。通过以下优化可将中断耗时控制在20us以内：

使用Q15格式运算：STM32没有FPU时，定点数运算效率更高
预先计算三角函数：建立256点的sin/cos查找表
状态机简化：将align/ramp/run状态判断放在主循环

void HAL_ADCEx_InjectedConvCpltCallback(ADC_HandleTypeDef* hadc) { // 1. 读取ADC值（约2us） int16_t adc_u = HAL_ADCEx_InjectedGetValue(&hadc1, ADC_INJECTED_RANK_1); // 2. Clarke/Park变换（约5us） Curr_Components I_ab = Clarke(I_abc); Curr_Components I_dq = Park(I_ab, theta_elec); // 3. PI控制器（约3us） Volt_Components V_dq; V_dq.qV_Component1 = PI_Update(&PI_Id, target_Id - I_dq.qI_Component1); // 4. SMO更新（约6us） SMO_Update(&SMO, I_ab.qI_Component1, I_ab.qI_Component2, V_dq.qV_Component1, V_dq.qV_Component2, dt); // 5. SVPWM输出（约4us） SVPWM_3ShuntCalcDutyCycles(Rev_Park(V_dq)); }

3.2 滑模观测器的实现细节

SMO的稳定性取决于滑模面的设计。在foc_algo.c中，我们采用改进型滑模观测器：

void SMO_Update(SMO_TypeDef *smo, float i_alpha, float i_beta, float v_alpha, float v_beta, float dt) { // 1. 电流误差计算 float e_alpha = i_alpha - smo->i_alpha; float e_beta = i_beta - smo->i_beta; // 2. 滑模控制量计算（符号函数用饱和函数替代） float K = 30.0f; // 滑模增益 smo->z_alpha = K * atan(100 * e_alpha); smo->z_beta = K * atan(100 * e_beta); // 3. 反电动势观测 float Ls = 0.0001f; // 电机电感 smo->e_alpha = smo->z_alpha + (Rs * i_alpha - v_alpha) / Ls; smo->e_beta = smo->z_beta + (Rs * i_beta - v_beta) / Ls; // 4. 角度估算 smo->theta_est = atan2f(-smo->e_alpha, smo->e_beta); // 5. 速度估算（低通滤波） static float last_theta = 0; float speed = (smo->theta_est - last_theta) / dt; last_theta = smo->theta_est; smo->speed_est = 0.9f * smo->speed_est + 0.1f * speed; }

这个实现有三个创新点：

用atan函数替代sign函数，减少高频抖动
加入电感参数补偿，提高低速估算精度
采用一阶低通滤波平滑速度信号

4. 调试实战经验分享

4.1 三段式启动策略

无感FOC的启动就像飞机起飞，需要分阶段进行：

预定位阶段（Align）：
- 给D轴注入固定电流（如2A）
- 持续时间100-500ms
- 确保转子固定在0度位置
开环加速（Ramp）：
- 角度按预设速度积分递增
- 电流限制在安全范围内
- 典型加速时间3-5秒
闭环切换（Run）：
- 当SMO估算速度>300RPM时切换
- 采用渐变混合过渡策略
- 避免转矩突变

// 状态机实现片段 switch(Motor_State) { case MOTOR_ALIGN: theta_elec = 0; if(align_cnt++ > ALIGN_TIME_MS*10) { Motor_State = MOTOR_RAMP; open_loop_angle = 0; } break; case MOTOR_RAMP: ramp_speed += (RAMP_END_SPD/(RAMP_TIME_MS/1000.0f)) * dt; open_loop_angle += ramp_speed * 6.0f * dt; // RPM转角度 theta_elec = (s16)((open_loop_angle/180.0f)*32767.0f); if(SMO.speed_est_rpm > SWITCH_THRESHOLD) { Motor_State = MOTOR_RUN; } break; }