無感磁場(chǎng)定向控制（Sensorless FOC）技術(shù)憑借 “無位置傳感器、高控制精度、低轉(zhuǎn)矩脈動(dòng)” 優(yōu)勢(shì)，成為中高端掃地機(jī)器人行走 / 風(fēng)機(jī)馬達(dá)的核心控制方案。本文針對(duì)掃地機(jī) 12V/14.4V/18V 低壓鋰電平臺(tái)，系統(tǒng)剖析無感 FOC 驅(qū)動(dòng)板的硬件架構(gòu)（功率拓?fù)洹?a target="_blank">電流采樣、驅(qū)動(dòng)模塊）、核心算法（轉(zhuǎn)子位置觀測(cè)、自適應(yīng)啟動(dòng)、三環(huán)閉環(huán)控制）及工程優(yōu)化策略，重點(diǎn)突破零速啟動(dòng)抖動(dòng)、低速觀測(cè)魯棒性、負(fù)載突變自適應(yīng)等關(guān)鍵技術(shù)痛點(diǎn)，提供兼顧成本與性能的全流程實(shí)現(xiàn)方案，為掃地機(jī)馬達(dá)驅(qū)動(dòng)板的設(shè)計(jì)與量產(chǎn)提供技術(shù)支撐。

1 引言

掃地機(jī)器人馬達(dá)（行走電機(jī)：0~300rpm 低速大轉(zhuǎn)矩；風(fēng)機(jī)電機(jī)：10,000~30,000rpm 高速低轉(zhuǎn)矩）對(duì)驅(qū)動(dòng)系統(tǒng)的核心要求包括：低速無抖動(dòng)、啟動(dòng)無反轉(zhuǎn)、高效節(jié)能、抗電磁干擾。傳統(tǒng)六步方波驅(qū)動(dòng)存在轉(zhuǎn)矩脈動(dòng)大、噪音高的缺陷，有感 FOC 依賴霍爾 / 編碼器傳感器，增加成本且降低可靠性，而無感 FOC通過電機(jī)數(shù)學(xué)模型估算轉(zhuǎn)子位置，完美平衡 “精度、成本、可靠性” 三大訴求。

無感 FOC 的核心技術(shù)挑戰(zhàn)在于：零速 / 低速時(shí)電機(jī)反電動(dòng)勢(shì)為零，位置觀測(cè)易失效；掃地機(jī)負(fù)載突變（爬坡、堵轉(zhuǎn)）與復(fù)雜電磁環(huán)境易導(dǎo)致控制失穩(wěn)。本文基于主流 MCU + 集成預(yù)驅(qū)架構(gòu)，從硬件與算法協(xié)同設(shè)計(jì)角度，完整解析無感 FOC 驅(qū)動(dòng)板的實(shí)現(xiàn)路徑。

2 無感 FOC 驅(qū)動(dòng)板硬件方案設(shè)計(jì)

硬件是無感 FOC 算法落地的基礎(chǔ)，需滿足 “電流采樣精度高、驅(qū)動(dòng)響應(yīng)快、功率密度大” 要求，核心架構(gòu)包括：MCU 控制單元、三相全橋功率拓?fù)?、電流采樣模塊、驅(qū)動(dòng)模塊、電源與保護(hù)單元。

2.1 核心硬件架構(gòu)

[鋰電池Vbat] → [EMI濾波+母線電容] → [三相全橋（6顆NMOS）] → [BLDC馬達(dá)] ↑[MCU控制單元] → [集成預(yù)驅(qū)芯片] → [6路PWM驅(qū)動(dòng)信號(hào)] → ↑ ↑[電流采樣模塊]（三相/單電阻采樣）→→→→→→→→→→→→→→→ ↑[保護(hù)單元]（過流/過溫/欠壓檢測(cè)）→→→→→→→→→→→→→→

2.2 關(guān)鍵硬件模塊設(shè)計(jì)

2.2.1 主控單元選型

選用高性能 32 位 MCU，需具備足夠算力支撐復(fù)雜 FOC 算法（坐標(biāo)變換、觀測(cè)器迭代、PID 運(yùn)算），推薦型號(hào)：

中高端方案：STM32G474（Cortex-M4 內(nèi)核，170MHz 主頻，內(nèi)置 FPU，支持硬件除法器）；

成本敏感方案：LKS32MC087（凌鷗創(chuàng)芯，Cortex-M0 內(nèi)核，64MHz 主頻，集成 3P3N 預(yù)驅(qū) + LDO，BOM 成本低）；

核心外設(shè)要求：12 位以上 ADC（采樣率≥1MSPS）、高級(jí)定時(shí)器（支持 SVPWM 輸出）、硬件除法器（提升算法效率）。

2.2.2 三相全橋功率拓?fù)?/p>

核心功能是將直流電壓逆變?yōu)槿鄬?duì)稱交流電，適配 BLDC 馬達(dá)的電子換向需求：

MOS 管選型：低壓大電流場(chǎng)景優(yōu)先選擇低導(dǎo)通電阻（R_ON）、快開關(guān)速度的 NMOS 管，選型參數(shù)需預(yù)留 20%~50% 裕量：

行走電機(jī)：Infineon IRF7805（V_DS=40V，I_D=28A，R_ON=7.5mΩ），耐受啟動(dòng)沖擊電流；

風(fēng)機(jī)電機(jī)：AOS AON6404（V_DS=30V，I_D=30A，R_ON=8mΩ），低開關(guān)損耗適配高頻工況；

母線電容設(shè)計(jì)：采用 “電解電容 + 陶瓷電容” 組合，抑制母線電壓紋波：220~470μF/25V 電解電容（低 ESR）+ 10~22μF/25V 陶瓷電容（高頻濾波）；

功率回路優(yōu)化：采用 “短路徑、大銅皮” 布線，覆銅厚度≥2oz，減少寄生電感與開關(guān)尖峰。

2.2.3 電流采樣模塊：精度與成本的平衡

電流采樣是 FOC 算法的核心反饋，需精準(zhǔn)采集三相電流用于坐標(biāo)變換與閉環(huán)控制，主流方案對(duì)比：

采樣方案	硬件構(gòu)成	精度	成本	適用場(chǎng)景
三電阻采樣	三相下橋臂各串聯(lián) 0.01~0.02Ω 合金電阻	高（±1%）	中	高端機(jī)型，行走電機(jī)大轉(zhuǎn)矩控制
單電阻采樣	母線串聯(lián) 0.01Ω 合金電阻	中（±3%）	低	風(fēng)機(jī)電機(jī)，成本敏感場(chǎng)景

三電阻采樣優(yōu)化設(shè)計(jì)：

采樣電阻：選用合金電阻（精度 ±1%，溫漂≤50ppm/℃），功率≥3W，避免發(fā)熱導(dǎo)致阻值漂移；

信號(hào)調(diào)理：采用低噪聲差分運(yùn)放（如 TI OPA333），放大倍數(shù) 10~20 倍，添加 1.65V 偏置電壓（適配 3.3V ADC），抑制共模干擾；

采樣時(shí)序：同步 SVPWM 零矢量區(qū)間（三個(gè)下管導(dǎo)通時(shí)）采樣，避免開關(guān)噪聲影響，采樣頻率≥20kHz。

2.2.4 驅(qū)動(dòng)模塊：集成預(yù)驅(qū)芯片方案

推薦采用集成預(yù)驅(qū)芯片（替代分立驅(qū)動(dòng)電路），簡(jiǎn)化設(shè)計(jì)并提升可靠性，推薦型號(hào)：

TI DRV8313：集成 6 路驅(qū)動(dòng)通道，峰值驅(qū)動(dòng)電流 1A，內(nèi)置死區(qū)控制、過流保護(hù)；

森國科 SGK32G034：集成 6N 預(yù)驅(qū) + LDO，無需外部自舉二極管，QFN24 封裝，功率密度高；

關(guān)鍵設(shè)計(jì)：

自舉電路：快恢復(fù)二極管（FR107）+ 1μF/25V 低 ESR 陶瓷電容，確保上橋臂 MOS 管可靠驅(qū)動(dòng)；

柵極電阻：10~47Ω，平衡開關(guān)速度與 EMI，行走電機(jī)選大阻值（抑制沖擊），風(fēng)機(jī)電機(jī)選小阻值（提升高頻響應(yīng)）。

2.2.5 電源與保護(hù)單元

電源模塊：DC-DC 降壓芯片（TPS5430）將電池電壓轉(zhuǎn)換為 5V，再經(jīng) LDO（AMS1117-3.3V）輸出穩(wěn)定 3.3V，為 MCU、運(yùn)放供電，電源回路串聯(lián)磁珠與去耦電容；

保護(hù)機(jī)制：集成硬件過流（比較器快速響應(yīng)）、過溫（NTC 熱敏電阻）、欠壓（電阻分壓檢測(cè)）保護(hù)，確保極端工況下系統(tǒng)安全。

3 無感 FOC 核心算法實(shí)現(xiàn)：突破行業(yè)痛點(diǎn)

算法是無感 FOC 的靈魂，核心解決 “轉(zhuǎn)子位置估算、零速啟動(dòng)、閉環(huán)控制” 三大問題，基于 “觀測(cè)器 + 啟動(dòng)策略 + 三環(huán)控制” 的全鏈路設(shè)計(jì)。

3.1 轉(zhuǎn)子位置觀測(cè)器：無感控制的核心

轉(zhuǎn)子位置與轉(zhuǎn)速的精準(zhǔn)估算是無感 FOC 的關(guān)鍵，需兼顧低速魯棒性與高速動(dòng)態(tài)響應(yīng)，主流方案：

3.1.1 滑模觀測(cè)器（SMO）：工程首選

基于電機(jī)反電動(dòng)勢(shì)模型，通過滑模變結(jié)構(gòu)算法估算位置，核心優(yōu)勢(shì)：抗干擾強(qiáng)、對(duì)電機(jī)參數(shù)敏感性低，適配掃地機(jī)復(fù)雜工況。

數(shù)學(xué)模型：

(hat{e}_alpha = -k_s cdot text{sgn}(i_alpha - hat{i}_alpha))

(hat{e}_beta = -k_s cdot text{sgn}(i_beta - hat{i}_beta))

其中，(hat{e}_alpha/hat{e}_beta)為估算反電動(dòng)勢(shì)，(k_s)為滑模增益，(text{sgn}())為符號(hào)函數(shù)；

工程優(yōu)化：

替換符號(hào)函數(shù)為飽和函數(shù)，抑制高頻抖振；

自適應(yīng)滑模增益：根據(jù)轉(zhuǎn)速動(dòng)態(tài)調(diào)整(k_s)，低速增大增益提升觀測(cè)魯棒性，高速減小增益降低噪聲。

3.1.2 混合觀測(cè)器方案：全速域覆蓋

針對(duì)零速 / 低速 SMO 觀測(cè)失效問題，采用 “高頻注入（HFI）+ SMO” 混合方案：

低速（<500rpm）：注入 100kHz 高頻電壓信號(hào)，利用電機(jī)凸極效應(yīng)提取轉(zhuǎn)子位置，實(shí)現(xiàn)零速帶載啟動(dòng)；

中高速（≥500rpm）：切換至 SMO 觀測(cè)器，利用反電動(dòng)勢(shì)信號(hào)估算位置，提升效率并降低噪聲；

切換策略：基于轉(zhuǎn)速閾值與觀測(cè)器信噪比平滑過渡，避免切換沖擊。

3.2 自適應(yīng)啟動(dòng)策略：解決啟動(dòng)抖動(dòng)與反轉(zhuǎn)

零速啟動(dòng)是無感 FOC 的行業(yè)痛點(diǎn)（反電動(dòng)勢(shì)為零導(dǎo)致位置未知），采用 “預(yù)定位 + 開環(huán)加速 + 閉環(huán)切換” 三段式策略：

預(yù)定位（100ms）：向 d 軸注入恒定電流（如 1A），將轉(zhuǎn)子拖至已知位置，避免啟動(dòng)反轉(zhuǎn)；

優(yōu)化：通過多方向電流試探檢測(cè)轉(zhuǎn)子實(shí)際位置，替代固定方向注入，減少定位沖擊；

開環(huán)加速（500ms）：輸出旋轉(zhuǎn)電壓矢量，按線性斜坡提升電角速度（0→500rpm），強(qiáng)制電機(jī)加速，直至反電動(dòng)勢(shì)足夠大；

閉環(huán)切換：當(dāng) SMO 觀測(cè)器信噪比≥20dB 時(shí)，平滑切換至閉環(huán)控制，避免轉(zhuǎn)速突變。

3.3 三環(huán)閉環(huán)控制：轉(zhuǎn)速、電流、磁鏈解耦

采用 “轉(zhuǎn)速環(huán)→電流環(huán)→磁鏈環(huán)” 三環(huán)控制架構(gòu)，實(shí)現(xiàn)轉(zhuǎn)矩與磁通獨(dú)立控制，優(yōu)化動(dòng)態(tài)響應(yīng)與穩(wěn)定性：

磁鏈環(huán)（內(nèi)環(huán)）：控制 d 軸電流(i_d=0)，實(shí)現(xiàn)弱磁控制，提升風(fēng)機(jī)電機(jī)高速性能；

電流環(huán)（中環(huán)）：PI 調(diào)節(jié)器，帶寬≥1kHz，快速抑制電流波動(dòng)，比例系數(shù)(K_p=0.5)，積分系數(shù)(K_i=10)；

轉(zhuǎn)速環(huán)（外環(huán)）：PI 調(diào)節(jié)器，帶寬≥100Hz，適配負(fù)載突變，行走電機(jī)添加微分環(huán)節(jié)（(K_d=0.05)）抑制震蕩；

坐標(biāo)變換：

Clarke 變換：將三相電流（(i_u,i_v,i_w)）轉(zhuǎn)換為兩相靜止坐標(biāo)系（(i_alpha,i_beta)）；

Park 變換：將（(i_alpha,i_beta)）轉(zhuǎn)換為兩相旋轉(zhuǎn)坐標(biāo)系（(i_d,i_q)），實(shí)現(xiàn)解耦控制；

SVPWM 調(diào)制：七段式調(diào)制，載波頻率 20~40kHz，行走電機(jī)選低頻率（降低噪聲），風(fēng)機(jī)電機(jī)選高頻率（提升平穩(wěn)性）。

3.4 參數(shù)自辨識(shí)與自適應(yīng)優(yōu)化

針對(duì)電機(jī)參數(shù)離散性與溫漂問題，引入在線參數(shù)辨識(shí)算法：

離線標(biāo)定：出廠時(shí)通過階躍響應(yīng)法測(cè)量電機(jī)定子電阻(R_s)、電感(L_d/L_q)、磁鏈(psi_f)；

在線修正：采用遞推最小二乘法（RLS），實(shí)時(shí)更新電阻參數(shù)（溫度敏感），補(bǔ)償溫漂導(dǎo)致的觀測(cè)誤差；

負(fù)載自適應(yīng)：通過 q 軸電流變化率識(shí)別負(fù)載突變（如爬坡），動(dòng)態(tài)調(diào)整轉(zhuǎn)速環(huán) PI 參數(shù)，避免失步。

4 工程優(yōu)化：可靠性與性能的提升

4.1 抗干擾設(shè)計(jì)：適配掃地機(jī)復(fù)雜電磁環(huán)境

電磁干擾抑制：

功率回路與信號(hào)回路嚴(yán)格分區(qū)布線，電流采樣線采用差分走線，遠(yuǎn)離功率 MOS 管；

電源輸入端添加共模電感 + X/Y 電容，抑制傳導(dǎo)干擾；

軟件抗干擾：

電流采樣值滑動(dòng)平均濾波（5 點(diǎn)），位置估算值一階低通濾波；

觀測(cè)器輸出添加相位補(bǔ)償，修正高頻工況下的相位滯后。

4.2 損耗優(yōu)化：提升續(xù)航能力

導(dǎo)通損耗：選用低 R_ON MOS 管，行走電機(jī)采用多 MOS 管并聯(lián)分流；

開關(guān)損耗：優(yōu)化 PWM 頻率與柵極電阻，避免高頻硬開關(guān)；

制動(dòng)能量回收：停機(jī)時(shí)切換至發(fā)電模式，將電機(jī)動(dòng)能轉(zhuǎn)化為電能回充鋰電池。

4.3 保護(hù)機(jī)制：全場(chǎng)景故障防護(hù)

過流保護(hù)：硬件比較器（響應(yīng)時(shí)間 μs）+ 軟件二次判斷，過流閾值 15~20A，觸發(fā)后封鎖 PWM 并上報(bào)故障；

堵轉(zhuǎn)保護(hù)：轉(zhuǎn)速為零且電流 > 10A 持續(xù) 1s，判定為堵轉(zhuǎn)，停機(jī) 300ms 后嘗試重啟（最多 3 次）；

過溫保護(hù)：NTC 檢測(cè) MOS 管溫度，≥85℃降功率，≥105℃封鎖輸出；

欠壓 / 過壓保護(hù)：電池電壓 <10V（14.4V 平臺(tái)）或> 17V 時(shí)，限制功率或封鎖輸出。

5 性能測(cè)試與驗(yàn)證

驅(qū)動(dòng)板需通過多維度測(cè)試驗(yàn)證性能，關(guān)鍵測(cè)試項(xiàng)目與指標(biāo)：

測(cè)試項(xiàng)目	測(cè)試條件	合格指標(biāo)
啟動(dòng)性能	空載 / 1kg 負(fù)載	無反轉(zhuǎn)、無抖動(dòng)，啟動(dòng)成功率 100%
低速平穩(wěn)性	行走電機(jī) 30rpm	轉(zhuǎn)矩脈動(dòng)≤5%，無爬行現(xiàn)象
轉(zhuǎn)速控制精度	目標(biāo)轉(zhuǎn)速 1000rpm，負(fù)載突變	轉(zhuǎn)速誤差≤±2%
效率	額定負(fù)載	≥85%（行走電機(jī)），≥90%（風(fēng)機(jī)電機(jī)）
抗干擾	與吸塵風(fēng)機(jī)同供電	無失步，轉(zhuǎn)速波動(dòng)≤±3rpm
連續(xù)工作	25℃環(huán)境，滿負(fù)載 4h	溫度≤80℃，無故障停機(jī)

6 結(jié)論

無感 FOC 掃地機(jī)器人馬達(dá)驅(qū)動(dòng)板的設(shè)計(jì)核心是 “硬件精準(zhǔn)匹配 + 算法協(xié)同優(yōu)化”：硬件端通過高集成度預(yù)驅(qū)芯片、高精度電流采樣、優(yōu)化的功率拓?fù)涞於ɑA(chǔ)；算法端通過混合觀測(cè)器、自適應(yīng)啟動(dòng)策略、三環(huán)閉環(huán)控制，突破零速啟動(dòng)、低速平穩(wěn)性等行業(yè)痛點(diǎn)。

該方案實(shí)現(xiàn)了 “無傳感器高精度控制”，相比傳統(tǒng)驅(qū)動(dòng)方案，轉(zhuǎn)矩脈動(dòng)降低 50% 以上，效率提升 10%~15%，同時(shí)簡(jiǎn)化系統(tǒng)設(shè)計(jì)、降低成本。未來，隨著 MCU 算力提升與寬禁帶半導(dǎo)體（GaN）應(yīng)用，無感 FOC 將向 “更高精度（24 位觀測(cè)）、更低損耗、更小體積” 方向發(fā)展，進(jìn)一步提升掃地機(jī)的操控體驗(yàn)與續(xù)航能力。