干洗机滚筒FOC矢量控制驱动板：无感BLDC低速大转矩启动与正反转切换技术-艾毕胜电子

干洗机滚筒启停频繁、正反转切换频繁、负载波动大，对无感FOC控制提出严苛要求。传统方波控制存在转矩脉动大、低速抖动、切换冲击等问题。本文提出一种基于滑模观测器+高频注入的复合无感FOC矢量控制马达驱动板方案，重点解决0速最大转矩启动、正反转无冲击切换两大技术难点，实验验证启动转矩达到2.5倍额定，正反转切换转矩波动<5%，满足干洗机全工况运行要求。

FOC矢量控制马达驱动板

一、干洗机滚筒控制需求分析

1.1 典型工况与技术难点

干洗机滚筒运行的四大典型工况：

工况	运行特点	控制要求
洗涤正转	50rpm正转，负载100%	低速平稳，转矩恒定
洗涤反转	50rpm反转，负载100%	无冲击切换，转矩连续
均布阶段	30~100rpm变速，负载不均	振动抑制，动态响应快
高速脱水	500~1500rpm，负载偏心	高速稳定，过流保护

核心技术难点：

低速大转矩启动：0速启动需2倍以上额定转矩，无感观测器0速失效

正反转平滑切换：过零速时观测器发散，易产生电流冲击

大范围负载波动：衣物分布不均导致负载±50%波动

全速度范围稳定：0~1500rpm宽速域无感稳定运行

1.2 控制方案选型对比

控制方案	方波控制（六步换相）	有感FOC	无感FOC
转矩脉动	大（15~30%）	小（<5%）	小（<8%）
低速性能	抖动严重	优	中→优（算法优化）
位置传感器	不需要	需要磁编/光编	不需要
BOM成本	低	高（+传感器）	中
正反转切换	冲击大	平滑	可平滑
效率	低	高	高

选型结论：无感FOC方案，采用滑模观测器+高频注入复合方案。

二、FOC矢量控制基础架构

2.1 FOC控制系统框图

 

速度环PI → q轴电流PI → Park逆变换 → SVPWM → 逆变器 → 电机
                                 ↑
i_a,i_b,i_c → Clarke变换 → Park变换 → d/q轴电流
                                 ↑
                           位置/速度观测器

 

2.2 核心坐标变换

Clarke变换（3s→2s）：

$$begin{bmatrix}i_alpha \ i_betaend{bmatrix} = frac{2}{3}begin{bmatrix}1 & -frac{1}{2} & -frac{1}{2} \ 0 & frac{sqrt{3}}{2} & -frac{sqrt{3}}{2}end{bmatrix}begin{bmatrix}i_a \ i_b \ i_cend{bmatrix$$

Park变换（2s→2r）：

$$begin{bmatrix}i_d \ i_qend{bmatrix} = begin{bmatrix}costheta & sintheta \ -sintheta & costhetaend{bmatrix}begin{bmatrix}i_alpha \ i_betaend{bmatrix$$

2.3 三环控制参数设计

电流环设计（16kHz）：

带宽：f_ci = 1~2kHz

PI参数：Kp = Ls×ω_ci，Ki = Rs×ω_ci

干洗机3kW电机典型值：Kp=0.8，Ki=20

速度环设计（8kHz）：

带宽：f_cω = 50~100Hz

PI参数：Kp = J×ω_cω，Ki = B×ω_cω

典型值：Kp=0.05，Ki=2

位置环设计（2kHz）：

带宽：f_cθ = 5~10Hz

P参数：Kp = 5~10

三、无感观测器设计与低速增强

3.1 滑模观测器（SMO）基本原理

基于反电动势观测的滑模观测器：

$$frac{d}{dt}begin{bmatrix}hat{i}_alpha \ hat{i}_betaend{bmatrix} = frac{1}{L_s}begin{bmatrix}-R_s & 0 \ 0 & -R_send{bmatrix}begin{bmatrix}hat{i}_alpha \ hat{i}_betaend{bmatrix} + frac{1}{L_s}begin{bmatrix}u_alpha \ u_betaend{bmatrix} - frac{k}{L_s}begin{bmatrix}sign(tilde{i}_alpha) \ sign(tilde{i}_beta)end{bmatrix$$

传统SMO的低速问题：

反电动势E = ω×ψ，0速时E→0，信噪比极低

开关函数sign()带来抖振，低速时尤为严重

转速<10%额定时，观测角度误差>30°，系统失稳

3.2 高频注入法（HFI）低速增强

旋转高频电压注入原理：

在d轴注入高频旋转电压：

$$u_{dh} = V_hcos(omega_h t), quad u_{qh} = $$

利用电机凸极性（Ld ≠ Lq），提取高频电流响应，解调得到转子位置。

适用范围：0~10%额定转速，完全无反电动势区域。

3.3 复合观测器平滑切换策略

速度分区控制：

 

0 ~ 5% 额定转速  →  纯高频注入（HFI）
5% ~ 15% 额定转速  →  HFI与SMO加权融合
>15% 额定转速  →  纯滑模观测器（SMO）

 

切换加权函数：

$$hat{theta} = k(omega) cdot theta_{SMO} + (1-k(omega)) cdot theta_{HFI$$

其中k(ω)为S型平滑过渡函数，避免切换冲击。

四、低速大转矩启动技术

4.1 初始位置检测（IPD）

启动前必须准确检测转子初始位置，否则启动失败或反转。

两步检测法：

磁极极性判断：注入6个方向电压脉冲，检测电流响应差异

电角度精确定位：±30°区间内高频注入，精度±5°电角度

4.2 I/F启动控制策略

IF（电流-频率）开环启动流程：

阶段	转速范围	控制方式	持续时间
1. 定位	0rpm	Id=1.5Ie, Iq=0	200ms
2. 拖转	0→10%额定	恒定电流幅值，频率线性上升	500ms
3. 切换	10%额定	IF→FOC闭环平滑切换	300ms

关键参数设计：

启动电流：1.5~2.0倍额定电流（保证2倍转矩）

加速度：≤500rpm/s，避免失步

切换阈值：观测角度误差<10°，持续100ms

4.3 最大转矩电流比（MTPA）控制

内置MTPA表，实现最大转矩输出：

$$I_d = -frac{psi_f}{2(L_d-L_q)} + sqrt{left(frac{psi_f}{2(L_d-L_q)}right)^2 + I_q^2$$

干洗机启动效果：0速输出转矩达2.5倍额定，重载衣物一次启动成功。

五、正反转无冲击切换技术

5.1 传统切换问题分析

直接正反转切换的三大问题：

过零速观测失效：ω=0时反电动势为0，观测器发散

电流冲击：转速反向时PI积分饱和，输出突变

机械冲击：转矩突变导致滚筒振动、皮带打滑

5.2 无冲击切换算法设计

步骤1：转速指令平滑过渡

采用S型加减速曲线：

$$omega^*(t) = omega_{start} + (omega_{end}-omega_{start}) cdot S(t/T$$

切换时间T=500~1000ms，避免阶跃指令。

步骤2：PI抗饱和与转矩前馈

速度环PI采用抗积分饱和算法（back-calculation）

加减速前馈转矩：T_ff = J · dω*/dt

摩擦转矩前馈补偿

步骤3：过零速观测器增强

过零速区间（|ω|<5%额定）自动激活：

高频注入临时切入

观测器增益自适应调整

角度预测外推补偿

5.3 切换过程时序控制

 

t=0ms：收到反转指令
t=0~200ms：减速至0速，电流环保持闭环
t=200~300ms：0速停留，激活HFI增强观测
t=300~800ms：反向加速至目标转速
t=800ms：切换完成，恢复正常FOC

 

切换效果：整个过程最大电流冲击<1.2倍额定，转矩波动<5%，完全无机械冲击。

六、负载波动抑制与鲁棒性设计

6.1 负载转矩观测器

设计龙伯格负载观测器：

$$frac{d}{dt}begin{bmatrix}hat{omega} \ hat{T}_Lend{bmatrix} = begin{bmatrix}-frac{B}{J} & -frac{1}{J} \ 0 & 0end{bmatrix}begin{bmatrix}hat{omega} \ hat{T}_Lend{bmatrix} + begin{bmatrix}frac{1}{J} \ 0end{bmatrix}T_e + begin{bmatrix}L_1 \ L_2end{bmatrix}(omega-hat{omega}$$

观测到的负载转矩前馈至电流环，将负载扰动抑制时间从500ms缩短至50ms。

6.2 参数自适应辨识

在线辨识电机参数Rs、Ls、ψf：

低速时辨识Rs（温度漂移补偿）

中高速时辨识Ls、ψf

参数更新周期100ms，保证观测器精度

6.3 故障保护机制

三级保护体系：

软件限流：Iq指令限制在1.5Ie

硬件过流：>2Ie时立即关断PWM

失步保护：观测角度误差>30°时重启IF启动

七、实验验证与性能测试

7.1 测试平台

电机：3kW BLDC，极对数4，额定转速1500rpm

控制器：STM32G474，16kHz电流环

负载：磁粉制动器，模拟干洗机滚筒负载

7.2 启动性能测试

测试项	指标	实测值
0速启动转矩	≥2倍额定	2.5倍额定
重载启动成功率	100%	100%（50次测试）
启动电流峰值	≤2.5Ie	2.1Ie
切换至闭环时间	<1s	0.8s
启动转速超调	<10%	5.2%

7.3 正反转切换测试

测试项	指标	实测值
切换时间	1s	0.8s
切换电流冲击	<1.5Ie	1.15Ie
转矩波动	<10%	4.8%
过零速角度误差	<15°	8.3°
机械冲击	无明显振动	无感知

7.4 全速度范围效率

转速	方波控制效率	无感FOC效率	提升
50rpm（洗涤）	78%	89%	+11%
500rpm（均布）	85%	94%	+9%
1500rpm（脱水）	88%	95%	+7%

综合节能：洗涤周期平均节电15%以上。

八、工程实现与参数表

8.1 核心参数整定表（3kW干洗机）

参数	符号	典型值	调节方向
电流环P	Kp_idq	0.8	增大→响应快，超调大
电流环I	Ki_idq	20	增大→稳态误差小
速度环P	Kp_spd	0.05	增大→刚度大，易振荡
速度环I	Ki_spd	2	增大→静差小
SMO增益	K_smo	15	增大→收敛快，抖振大
HFI电压	Vh	30V	增大→信噪比高，损耗大
HFI频率	fh	1kHz	增大→纹波小，难解调
切换转速	ω_switch	150rpm	-

8.2 代码实现要点

定点运算：Q15格式，避免浮点运算

中断优先级：电流环>速度环>通讯

观测器计算：汇编优化，单周期完成

异常处理：看门狗+安全停机机制

九、总结与展望

9.1 技术创新点

复合无感观测：HFI+SMO平滑切换，0~1500rpm全速度范围稳定

大转矩启动：IF启动+MTPA，0速2.5倍额定转矩输出

无冲击切换：S型曲线+转矩前馈+过零增强，正反转平滑过渡

负载鲁棒性：负载观测器+参数自适应，±50%负载波动无影响

9.2 应用价值

性能提升：转矩脉动从25%降至5%，洗涤更平稳

节能效果：综合效率提升10%，年节电约50度/台

成本降低：省去位置传感器，BOM成本降低¥30/台

可靠性：无传感器，MTBF提升3倍

工程结论：本方案已在商用干洗机批量应用，完全解决传统方波控制的低速抖动与切换冲击问题，可直接移植至洗衣机、烘干机等同类家电产品。

审核编辑 黄宇