（1）拓?fù)浣Y(jié)構(gòu)與器件選型

功率 MOSFET：選用耐壓≥40V、導(dǎo)通電阻 Rds (on)≤20mΩ 的 N 溝道器件（如 AON6282、BSC010N04），上下橋臂對稱布局，每相串聯(lián) 0.01~0.05Ω 精密采樣電阻，用于電流檢測；

預(yù)驅(qū)芯片：采用 TI DRV8323 或芯源 TMI8180G，集成 3 路半橋驅(qū)動(dòng)、柵極電源管理與死區(qū)控制（100ns~5μs 可調(diào)），內(nèi)置過流 / 過溫 / 欠壓硬件保護(hù)；

輔助元件：每相配置 10μF/25V 自舉電容實(shí)現(xiàn)高端 MOS 管懸浮供電，MOS 管兩端并聯(lián) 100Ω+10nF RC 吸收回路，抑制關(guān)斷尖峰電壓。

（2）六步換向與 PWM 調(diào)速協(xié)同原理

BLDC 電機(jī)定子繞組為三相星形連接，轉(zhuǎn)子內(nèi)置永磁體，通過 “兩兩導(dǎo)通” 的六步換向邏輯產(chǎn)生旋轉(zhuǎn)磁場，每步對應(yīng) 60° 電角度，具體通斷時(shí)序如下表：

PWM 調(diào)速通過占空比調(diào)節(jié)實(shí)現(xiàn)：MCU 輸出 20~40kHz 互補(bǔ) PWM 信號(hào)（推薦 25kHz，兼顧效率與噪音），通過改變方波高電平占空比（0~100%），等效調(diào)節(jié)繞組平均電壓，進(jìn)而控制電機(jī)轉(zhuǎn)速與轉(zhuǎn)矩。例如，占空比從 30% 提升至 70% 時(shí)，電機(jī)轉(zhuǎn)速從 0.1m/s 線性提升至 0.35m/s，轉(zhuǎn)矩同步增大。

2.2 核心控制單元（MCU）電路

控制單元選用 STM32G431CBT6（ARM Cortex-M4 內(nèi)核，主頻 170MHz），內(nèi)置 FPU 浮點(diǎn)運(yùn)算單元與硬件 CORDIC 協(xié)處理器，滿足 PWM 生成、坐標(biāo)變換與 PID 運(yùn)算的實(shí)時(shí)性需求。核心外圍電路設(shè)計(jì)如下：

電源電路：5V 轉(zhuǎn) 3.3V LDO（AMS1117-3.3）供電，輸出電流 1A，紋波≤50mV，配置 100nF 陶瓷電容 + 10μF 電解電容濾波；

時(shí)鐘與復(fù)位：外部 8MHz 晶振 + 內(nèi)部 PLL 倍頻至 170MHz，內(nèi)置獨(dú)立看門狗（WDT，超時(shí)時(shí)間 1s）防止程序跑飛；

通信接口：UART（115200bps）接收導(dǎo)航板速度指令，CAN 總線（500kbps）上報(bào)故障狀態(tài)；

PWM 輸出：4 個(gè)高級定時(shí)器生成 6 路互補(bǔ) PWM 信號(hào)，死區(qū)時(shí)間固定為 2μs，避免上下橋臂 MOS 管直通短路。

2.3 電源管理模塊電路

電源管理模塊承擔(dān) “寬壓輸入 - 多電壓輸出 - 低噪濾波” 功能，確保各模塊穩(wěn)定供電：

輸入級：電池接口串聯(lián)防反接 MOS 管（AO4407），配置 π 型濾波網(wǎng)絡(luò)（100μF 電解電容 + 10μH 電感 + 0.1μF 陶瓷電容），抑制電機(jī)換向產(chǎn)生的紋波干擾；

主電源轉(zhuǎn)換：14.4V/18V→5V 同步 DC-DC（MP2359），轉(zhuǎn)換效率≥95%，輸出電流 2A，為預(yù)驅(qū)芯片、霍爾傳感器供電；

輔助電源轉(zhuǎn)換：5V→3.3V LDO（RT9193），紋波≤30mV，為 MCU、編碼器等敏感電路供電；

待機(jī)模式：MCU 休眠時(shí)關(guān)閉 DC-DC 輸出，僅保留 LDO 最小功耗模式，待機(jī)功耗≤1mW。

2.4 反饋檢測模塊電路

反饋模塊是閉環(huán)控制的 “眼睛”，通過多維度數(shù)據(jù)采集實(shí)現(xiàn)精準(zhǔn)調(diào)速，核心包括三大檢測電路：

位置 / 轉(zhuǎn)速檢測：左右電機(jī)尾部安裝磁編碼器（MT6816，18 位分辨率），輸出 A/B/Z 三相脈沖，MCU 通過定時(shí)器計(jì)數(shù)計(jì)算轉(zhuǎn)速（n = 脈沖數(shù) ×60/(2× 極對數(shù) × 采樣時(shí)間)），位置精度 ±0.01°；

電流檢測：三相采樣電阻電壓經(jīng)預(yù)驅(qū)芯片差分運(yùn)放放大（增益 20 倍），送入 MCU 16 位 ADC（采樣頻率≥20kHz），檢測范圍 0~8A，精度 ±1%；

溫度 / 電壓檢測：MOS 管表面貼裝 NTC 熱敏電阻（10KΩ，B 值 3950），電池端分壓電阻（100KΩ+22KΩ）采集電壓，ADC 轉(zhuǎn)換后用于過溫 / 欠壓保護(hù)。

三、PWM 控制算法實(shí)現(xiàn)（軟件核心）

掃地機(jī)器人行走電機(jī)采用 “FOC 磁場定向控制 + 雙環(huán) PID” 算法，相比傳統(tǒng)六步換向，轉(zhuǎn)矩脈動(dòng)降低 30%，噪音控制在 55dB 以下。核心實(shí)現(xiàn)流程如下：

3.1 FOC 控制核心邏輯

信號(hào)采集：霍爾傳感器獲取轉(zhuǎn)子位置角 θ，采樣電阻采集三相電流 Ia/Ib/Ic；

坐標(biāo)變換：Clarke 變換將 Ia/Ib/Ic 轉(zhuǎn)換為兩相靜止坐標(biāo)系電流 Iα/Iβ，再通過 Park 變換轉(zhuǎn)換為兩相旋轉(zhuǎn)坐標(biāo)系電流 Id/Iq（勵(lì)磁電流 / 轉(zhuǎn)矩電流）；

PID 調(diào)節(jié)：采用 Id=0 控制策略，轉(zhuǎn)速環(huán) PID 輸出 Iq*，電流環(huán) PID 輸出 Vd/Vq；

調(diào)制輸出：Park 逆變換 + SVPWM 調(diào)制生成 6 路 PWM 信號(hào)，驅(qū)動(dòng) MOS 管導(dǎo)通，電壓利用率提升至 1（傳統(tǒng)六步換向?yàn)?0.866）。

3.2 差速轉(zhuǎn)向控制實(shí)現(xiàn)

左右行走電機(jī)獨(dú)立控制，通過速度差實(shí)現(xiàn)轉(zhuǎn)向功能：

直行：左右電機(jī)轉(zhuǎn)速一致（n 左 = n 右 = 0.3m/s）；

左轉(zhuǎn)：n 左 = 0.1m/s，n 右 = 0.3m/s，速度差產(chǎn)生轉(zhuǎn)向力矩，原地旋轉(zhuǎn)時(shí) n 左 =-n 右；

自適應(yīng)調(diào)整：結(jié)合 IMU 姿態(tài)數(shù)據(jù)，當(dāng)檢測到車輪打滑時(shí)，自動(dòng)增大低轉(zhuǎn)速側(cè) PWM 占空比，補(bǔ)償轉(zhuǎn)向偏差。

四、故障保護(hù)設(shè)計(jì)（硬件 + 軟件雙重機(jī)制）

針對掃地機(jī)器人行走過程中常見的過流、堵轉(zhuǎn)、過溫、欠壓等故障，設(shè)計(jì)多級保護(hù)機(jī)制，確保系統(tǒng) “故障可檢測、損傷可避免、恢復(fù)可自動(dòng)”。

4.1 硬件保護(hù)電路設(shè)計(jì)（快速響應(yīng)）

（1）過流 / 短路保護(hù)

檢測原理：采樣電阻電壓 V_R=I×R_sense，當(dāng) I>8A（短路）或 I>3A（持續(xù)過流）時(shí)，V_R>80mV（0.01Ω×8A）；

響應(yīng)機(jī)制：預(yù)驅(qū)芯片內(nèi)置比較器檢測 V_R，1μs 內(nèi)觸發(fā)硬件閉鎖，關(guān)斷所有 PWM 輸出，同時(shí)向 MCU 發(fā)送故障中斷信號(hào)；

硬件冗余：在電源輸入端串聯(lián) PPTC 自恢復(fù)保險(xiǎn)絲（額定電流 5A），短路時(shí) 10ms 內(nèi)熔斷，切斷主電源。

（2）過溫保護(hù)

檢測電路：NTC 熱敏電阻與 10KΩ 電阻組成分壓電路，溫度 T=25℃時(shí)分壓電壓 1.65V，T=85℃時(shí)降至 0.8V；

分級保護(hù)策略：

一級（T=80℃）：預(yù)驅(qū)芯片降額輸出，PWM 頻率從 25kHz 降至 20kHz，減少開關(guān)損耗；

二級（T=90℃）：MCU 關(guān)斷 PWM 輸出，電機(jī)停轉(zhuǎn)，等待溫度降至 60℃后自動(dòng)重啟；

硬件熔斷：MOS 管焊盤覆蓋 2mm2 銅箔，配合相變導(dǎo)熱材料，避免局部過熱燒毀。

（3）欠壓 / 過壓保護(hù)

欠壓保護(hù)：電池電壓 < 10.8V 時(shí)，分壓電路輸出電壓 < 1.2V，MCU 觸發(fā)低電量預(yù)警，逐步降低電機(jī)轉(zhuǎn)速，電壓 < 10V 時(shí)強(qiáng)制停機(jī)，避免電池過放；

過壓保護(hù)：電池電壓 > 26.4V 時(shí)，TVS 管（SMBJ26CA）擊穿鉗位，同時(shí) MCU 關(guān)斷 PWM，防止 MOS 管耐壓超限擊穿。

（4）EMI 與靜電保護(hù)

信號(hào)接口：所有外部接口串聯(lián) ESD 保護(hù)器件（USBLC6-2SC6），抗 5000V 接觸放電；

PCB 布局：功率回路與信號(hào)回路分離，地線采用星形接地，MOS 管區(qū)域鋪銅接地，減少電磁耦合干擾；

電機(jī)線防護(hù)：三相電機(jī)線串聯(lián)磁珠（100Ω/100MHz），抑制高頻諧波輻射。

4.2 軟件保護(hù)算法設(shè)計(jì)（智能補(bǔ)償）

（1）堵轉(zhuǎn)保護(hù)

檢測邏輯：電機(jī)電流 > 5A 且轉(zhuǎn)速持續(xù) 50ms 判定為堵轉(zhuǎn)（如跨越門檻失敗、毛發(fā)纏繞）；

處理流程：MCU 立即關(guān)斷 PWM 輸出，1s 后輸出反向 PWM（占空比 30%），嘗試反轉(zhuǎn) 0.2s 脫困；若 3 次反轉(zhuǎn)后仍堵轉(zhuǎn)，上報(bào)導(dǎo)航板觸發(fā)繞行策略。

（2）電流畸變補(bǔ)償

問題：MOS 管導(dǎo)通壓降與采樣電阻溫漂導(dǎo)致電流檢測畸變，影響 FOC 控制精度；

解決方案：通過軟件算法補(bǔ)償，建立溫度 - 導(dǎo)通壓降 lookup 表，實(shí)時(shí)修正電流采樣值，補(bǔ)償后電流誤差從 ±5% 降至 ±1%。

（3）故障自診斷與恢復(fù)

自診斷：MCU 定期檢測 PWM 輸出、傳感器信號(hào)、電源電壓，每 10ms 執(zhí)行一次故障掃描；

故障存儲(chǔ)：將故障類型（過流 / 過溫 / 欠壓）與發(fā)生時(shí)間存儲(chǔ)在 Flash，支持通過 UART 讀?。?/p>

自動(dòng)恢復(fù)：故障解除后（如溫度降至閾值以下、欠壓充電后），MCU 自動(dòng)重啟驅(qū)動(dòng)模塊，恢復(fù)正常運(yùn)行，無需人工干預(yù)。

4.3 保護(hù)機(jī)制響應(yīng)時(shí)間對比

五、工程實(shí)踐優(yōu)化與常見問題調(diào)試

5.1 關(guān)鍵優(yōu)化措施

散熱優(yōu)化：采用鋁基板 PCB（熱導(dǎo)率 5W/m?K），MOS 管表面涂覆 1mm 厚相變導(dǎo)熱材料，降低結(jié)溫 20℃；

抗干擾優(yōu)化：編碼器信號(hào)線采用差分傳輸，電源輸入端增加共模電感，減少電機(jī)換向?qū)鞲衅鞯母蓴_；

算法優(yōu)化：引入自適應(yīng) PID 調(diào)參，根據(jù)地面材質(zhì)（地板 / 地毯）動(dòng)態(tài)調(diào)整轉(zhuǎn)速環(huán) P/I/D 參數(shù)，避免負(fù)載突變導(dǎo)致的振蕩。

5.2 常見故障調(diào)試指南

基于 BLDC/PWM 的掃地機(jī)器人行走電機(jī)驅(qū)動(dòng)板，通過三相全橋拓?fù)渑c FOC 控制算法的協(xié)同設(shè)計(jì)，實(shí)現(xiàn)了精準(zhǔn)調(diào)速與靈活轉(zhuǎn)向，而硬件 + 軟件雙重保護(hù)機(jī)制確保了復(fù)雜環(huán)境下的可靠性。測試結(jié)果表明，該驅(qū)動(dòng)板速度控制誤差≤±0.01m/s，故障保護(hù)響應(yīng)時(shí)間≤1μs，完全滿足掃地機(jī)器人作業(yè)需求。

未來技術(shù)發(fā)展方向包括：① 采用 GaN（氮化鎵）MOSFET 替代硅基器件，開關(guān)頻率提升至 2MHz 以上，進(jìn)一步縮小驅(qū)動(dòng)板體積；② 集成 AI 自適應(yīng)算法，通過電流紋波識(shí)別地面類型，動(dòng)態(tài)優(yōu)化 PWM 占空比；③ 單芯片集成 MCU + 預(yù)驅(qū) + MOSFET，降低成本與功耗，推動(dòng)掃地機(jī)器人向輕量化、長續(xù)航方向升級。

審核編輯 黃宇