電機(jī)驅(qū)動(dòng)方案詳解)
做機(jī)器人的朋友應(yīng)該都有過(guò)這種經(jīng)歷上電一看電機(jī)嗡嗡響軸卻一動(dòng)不動(dòng)要么換了個(gè)負(fù)載扭矩就不夠電機(jī)燙得能煎蛋。我這次做的工業(yè)/機(jī)器人步進(jìn)電機(jī)驅(qū)動(dòng)方案用的是一顆很多人覺(jué)得“老氣”的 8 位單片機(jī) PIC18LF47K42和 TI 的 DRV8818PWPR 雙 H 橋驅(qū)動(dòng)器目標(biāo)是把雙極步進(jìn)電機(jī)的速度、位置和力矩控制做到穩(wěn)定可靠。這套組合看起來(lái)簡(jiǎn)單實(shí)際把硬件參數(shù)、電流斬波、加減速算法、異常保護(hù)全部理順之后跑工業(yè)定位平臺(tái)和機(jī)器人關(guān)節(jié)都足夠穩(wěn)。下面把我整個(gè)設(shè)計(jì)和調(diào)試過(guò)程完整拆開(kāi)講從硬件選型到軟件實(shí)現(xiàn)再到常見(jiàn)坑位全部記錄在案。1. 項(xiàng)目概覽與控制方案怎么定1.1 先搞清楚要控制的是什么雙極步進(jìn)電機(jī)和普通直流電機(jī)不一樣us that 雙極步進(jìn)電機(jī)通常是四根線(xiàn)分成 A 相和 B 相每一相都是一組線(xiàn)圈。想讓轉(zhuǎn)子轉(zhuǎn)起來(lái)必須讓電流按順序在 A、B 兩個(gè)線(xiàn)圈里換相形成旋轉(zhuǎn)磁場(chǎng)。所以不能簡(jiǎn)單地把電源往電機(jī)上一懟而是要有一對(duì) H 橋至少四個(gè)功率開(kāi)關(guān)管按順序打開(kāi)關(guān)閉。這個(gè)項(xiàng)目里用到的 DRV8818PWPR其實(shí)就把兩個(gè) H 橋和電流斬波、限流比較器、各種保護(hù)邏輯集成到了一顆芯片里。PIC18LF47K42 只負(fù)責(zé)出邏輯信號(hào)不需要自己干功率放大的活。這種“MCU 出邏輯 驅(qū)動(dòng)芯片出功率”的分工在工業(yè)板和機(jī)器人控制板里是最常見(jiàn)也最不容易出錯(cuò)的方案。因?yàn)槟惆迅唠妷?、大電流和邏輯電源隔開(kāi)了出問(wèn)題的時(shí)候排查范圍一下就縮小了。如果把“步進(jìn)電機(jī)控制”簡(jiǎn)單理解成“給個(gè)脈沖轉(zhuǎn)多少角度”那很多項(xiàng)目都能跑但跑得穩(wěn)不穩(wěn)是另一回事。真正的控制目標(biāo)有三個(gè)一是位置精確說(shuō)走 100 步就真的走 100 步二是速度曲線(xiàn)可控加速、勻速、減速都不會(huì)丟步三是電流受控電機(jī)不白發(fā)熱力矩不僅夠還要穩(wěn)。這些目標(biāo)同時(shí)滿(mǎn)足需要從驅(qū)動(dòng)芯片的參數(shù)設(shè)置、MCU 的定時(shí)器用法、運(yùn)動(dòng)曲線(xiàn)的軟件算法三個(gè)層面一起下手。1.2 為什么是 PIC18LF47K42 而不是一顆“更現(xiàn)代”的 MCU選 PIC18LF47K42一開(kāi)始團(tuán)隊(duì)里也有人質(zhì)疑現(xiàn)在隨便一顆 ARM Cortex-M0 都八九十個(gè)引腳性能比 8 位機(jī)強(qiáng)為什么還要選它但實(shí)際做下來(lái)這顆 K42 系列芯片還真挺適合步進(jìn)電機(jī)控制。理由很樸素它自帶不少 Core Independent Peripherals也就是所謂 CIP 外設(shè)很多實(shí)時(shí)性要求高的活可以在硬件層面完成CPU 只需要在關(guān)鍵節(jié)點(diǎn)處理邏輯。比如產(chǎn)生 STEP 脈沖這件事如果用 GPIO 翻轉(zhuǎn)加延時(shí)來(lái)做中斷一多、任務(wù)一復(fù)雜脈沖間隔就不均勻速度曲線(xiàn)會(huì)抖最終表現(xiàn)就是電機(jī)噪音大、丟步。而 K42 的定時(shí)器配合 PWM/CCP 模塊可以由硬件連續(xù)輸出占空比 50% 的方波脈沖頻率只由定時(shí)器周期寄存器決定。CPU 不用每一步都參與只要在運(yùn)動(dòng)過(guò)程中調(diào)整目標(biāo)頻率就能產(chǎn)生非常平滑的步進(jìn)脈沖序列。還有就是成本、庫(kù)存、可靠性的考量。工業(yè)設(shè)備不追求最新最酷的芯片而是講究生命周期長(zhǎng)、文檔齊全、供應(yīng)鏈穩(wěn)定。PIC 系列在傳統(tǒng)工控里應(yīng)用很廣汽車(chē)電子、醫(yī)療設(shè)備里也能看到它的影子。8 位 MCU 算力確實(shí)不強(qiáng)但步進(jìn)電機(jī)控制本身不是一個(gè) CPU 密集型的活真正吃性能的往往是通訊協(xié)議、故障診斷、數(shù)據(jù)記錄這些“外圍工作”。K42 把這些外圍工作分給硬件外設(shè)去跑CPU 性能反而是夠的。1.3 DRV8818PWPR 在系統(tǒng)里承擔(dān)什么角色DRV8818PWPR 這顆芯片后綴 PWPR 代表 PowerPAD HTSSOP 封裝。這種封裝的底部有一塊大焊盤(pán)焊接到 PCB 的銅皮上可以顯著改善散熱。工業(yè)環(huán)境經(jīng)常連續(xù)工作一整天驅(qū)動(dòng) IC 的結(jié)溫如果壓不住一不穩(wěn)定就會(huì)觸發(fā)過(guò)熱保護(hù)機(jī)器停在那里等你重啟。所以選這種帶 PowerPAD 的封裝不是隨便定的就是為了把熱阻降下來(lái)讓持續(xù)大電流工況下的余量更充足。芯片內(nèi)部集成的兩個(gè) H 橋足以驅(qū)動(dòng)一臺(tái)雙極步進(jìn)電機(jī)。同時(shí)它還有電流斬波功能意思是我設(shè)定一個(gè)目標(biāo)電流比如 1.5A當(dāng)相電流上升到這個(gè)值芯片內(nèi)部就會(huì)通過(guò) PWM 關(guān)斷功率管讓電流降下來(lái)然后再導(dǎo)通如此循環(huán)把電流限制在目標(biāo)值附近。這個(gè)功能叫電流限制也叫斬波恒流。沒(méi)有它步進(jìn)電機(jī)相電流可能直接沖到電源允許的極限電機(jī)和驅(qū)動(dòng)器都會(huì)燒掉。MCU 和 DRV8818 的分工也很直觀(guān)MCU 給出 STEP 脈沖、DIR 方向、SLEEP 休眠、EN 使能這些邏輯信號(hào)DRV8818 再把邏輯信號(hào)放大成功率開(kāi)關(guān)動(dòng)作同時(shí)通過(guò)內(nèi)部電流比較器實(shí)現(xiàn)限流還提供 FAULT 故障輸出讓 MCU 知道當(dāng)前出了什么狀況。這樣 MCU 完全沒(méi)有觸碰高電壓功率級(jí)安全性高很多。后續(xù)調(diào)試時(shí)只要軟件邏輯看著沒(méi)問(wèn)題就可以用萬(wàn)用表去量 DRV8818 的 VM、VREF、ISENSE 這些引腳兩步之內(nèi)就能定位故障在驅(qū)動(dòng)側(cè)還是控制側(cè)。2. DRV8818PWPR 硬件設(shè)計(jì)與電流參數(shù)計(jì)算2.1 供電與功率電路的基本盤(pán)這個(gè)項(xiàng)目里我給電機(jī)側(cè)的 VM 供的是 24VMCU 邏輯部分用 3.3V兩套地最終在整板電源入口附近單點(diǎn)匯接。24V 的電源進(jìn)來(lái)之后先經(jīng)過(guò)一個(gè)防反接二極管然后是一顆 100μF 電解電容加一顆 1μF 陶瓷電容兩個(gè)電容盡量靠近 DRV8818 的 VM 引腳。很多步進(jìn)驅(qū)動(dòng)板的問(wèn)題不是芯片燒了而是電源電容放得太遠(yuǎn)MOS 開(kāi)關(guān)瞬間產(chǎn)生的高 dV/dt 把芯片旁邊的邏輯電路干擾得亂七八糟。要注意的是 VM 不要和 MCU 的電源共用一個(gè) LDO。DRV8818 工作的時(shí)候VM 上的電流變化非常劇烈如果 3.3V 是從同一個(gè)電源軌拉出來(lái)的步進(jìn)脈沖一來(lái)邏輯電壓就會(huì)跳。我一開(kāi)始圖省事用一塊 DC-DC 輸出 24V然后從 24V 再拉一個(gè) LDO 出來(lái)做 3.3V結(jié)果電機(jī)一轉(zhuǎn)MCU 時(shí)不時(shí)復(fù)位。后來(lái)改成獨(dú)立的 5V 轉(zhuǎn) 3.3V 電源軌問(wèn)題就消失了。VM 電壓的選擇要結(jié)合電機(jī)的額定電壓來(lái)理解。步進(jìn)電機(jī)相電壓一般有個(gè)標(biāo)稱(chēng)值但實(shí)際運(yùn)行時(shí)線(xiàn)圈是電感PWM 恒流驅(qū)動(dòng)下電源電壓高于電機(jī)額定電壓反而能更快地建立電流。所以 12V 的電機(jī)用 24V 驅(qū)動(dòng)很常見(jiàn)只要限流值沒(méi)超過(guò)電機(jī)額定電流就不會(huì)燒。但也要注意電壓太高會(huì)讓電流紋波變大開(kāi)關(guān)損耗和 EMI 跟著增加。24V 在這個(gè)項(xiàng)目里是一個(gè)均衡點(diǎn)。2.2 峰值電流怎么算VREF 和采樣電阻是關(guān)鍵電流限制的原理是相電流流過(guò)采樣電阻在電阻上產(chǎn)生壓降這個(gè)電壓和 VREF 引腳設(shè)定的參考電壓比較。當(dāng)采樣電壓超過(guò)參考內(nèi)部比較器翻轉(zhuǎn)關(guān)斷當(dāng)前導(dǎo)通管進(jìn)入衰減階段。所以在 DRV8818 上目標(biāo)電流主要由 VREF 和 ISENSE 處的采樣電阻共同決定。不同廠(chǎng)牌、不同絲印版本的公式可能略有差異但思路一樣就是I_trip VREF / (Gain × R_sense)Gain 是芯片內(nèi)部的電流增益倍數(shù)不同芯片差異很大我這邊用到的實(shí)際配置是 VREF 1.5V、R_sense 0.1Ω目標(biāo)峰值電流 1.5A。算出來(lái)之后還要留出裕量。尤其機(jī)器人關(guān)節(jié)在加速的時(shí)候電流瞬時(shí)值會(huì)明顯超過(guò)勻速電流如果 VREF 卡得太死加速過(guò)程中限流提前觸法力矩不夠直接丟步。經(jīng)驗(yàn)值是目標(biāo)電流不要超過(guò)電機(jī)額定電流的 80% 到 90%同時(shí)驅(qū)動(dòng)芯片的峰值電流能力再留 30% 左右的余量。比如這臺(tái)電機(jī)額定相電流 1.7A我就把限流設(shè)成 1.5A驅(qū)動(dòng)器宣稱(chēng)峰值能力 2.5A余量足夠。再把 VREF 的電壓接到一個(gè)可調(diào)的 DAC 上后續(xù)如果需要降低靜止保持電流我可以通過(guò)軟件調(diào)節(jié) VREF讓電機(jī)在停頓狀態(tài)時(shí)少發(fā)熱。VREF 引腳不能懸空采樣電阻要用低感抗的低阻值大功率電阻我用的 0.1Ω/1W 金屬膜電阻布局上要盡量靠近 ISENSE 引腳。采樣電阻的走線(xiàn)要短、寬因?yàn)楣β驶芈防锏娜魏渭纳娮瓒紩?huì)分掉采樣信號(hào)導(dǎo)致電流不準(zhǔn)。如果采樣點(diǎn)離芯片太遠(yuǎn)線(xiàn)路壓降疊加進(jìn)去可能還沒(méi)到閾值芯片就提前關(guān)斷了實(shí)際力矩會(huì)比預(yù)期小。2.3 衰減模式容易被忽略但影響很大的參數(shù)步進(jìn)電機(jī)是電感負(fù)載電感有個(gè)特性電流不能突變。當(dāng)限流比較器觸發(fā)、功率管關(guān)斷時(shí)相電流不可能瞬間歸零必須給電流一個(gè)“泄放回路”。衰減模式?jīng)Q定的就是這個(gè)泄放過(guò)程怎么做。慢衰減模式下關(guān)斷時(shí)電流在 H 橋的下管續(xù)流回路里自然衰減電流紋波比較小電機(jī)運(yùn)行更“安靜”但電流下降速度慢跟不上快節(jié)奏的換相。快衰減模式則是把功率管全部反向驅(qū)動(dòng)迫使電流快速下降響應(yīng)快但紋波大在高電源電壓下會(huì)顯得電機(jī)和驅(qū)動(dòng)板更熱。混合衰減則是折中先快衰減一段再切換到慢衰減兼顧響應(yīng)速度和紋波。DRV8818 上通常有配置引腳來(lái)選擇衰減模式。我這里最終選的是混合衰減。原因很簡(jiǎn)單機(jī)器人關(guān)節(jié)經(jīng)常要在低速下反復(fù)啟停低速段最容易出現(xiàn)共振和噪音純慢衰減雖然安靜但位置跟隨性差純快衰減又會(huì)讓電流噪聲偏大。調(diào)衰減模式的時(shí)候最好拿鉗流表或者采樣電阻上的電壓波形來(lái)看不要只憑耳朵感受耳朵會(huì)騙人波形不會(huì)。2.4 與 PIC18LF47K42 的接線(xiàn)和引腳功能劃分我實(shí)際用的引腳映射如下給各位一個(gè)參考PIC18LF47K42 引腳DRV8818 引腳信號(hào)作用RA0DIR方向控制高/低電平切換RC5 / PWM 輸出STEP步進(jìn)脈沖輸入上升沿有效RB0FAULT故障輸出低電平有效接 MCU 中斷RD1SLEEP休眠控制低電平進(jìn)入休眠RD2EN使能控制低電平關(guān)閉輸出DAC 輸出VREF設(shè)定電流運(yùn)行/保持時(shí)調(diào)節(jié)STEP 和 DIR 是核心的兩根信號(hào)線(xiàn)。STEP 脈沖的寬度要注意不能太窄。如果 MCU 的 PWM 輸出脈寬小于 DRV8818 的最小步進(jìn)脈寬要求芯片可能漏掉脈沖造成位置漂移。所以我在軟件里把 STEP 設(shè)為占空比 50% 的方波頻率可變脈寬永遠(yuǎn)夠。FAULT 引腳接到了 RB0 的外部中斷上。一旦 FAULT 變低MCU 立即進(jìn)入保護(hù)流程把運(yùn)動(dòng)狀態(tài)凍結(jié)記錄故障代碼然后通過(guò)通訊口上報(bào)給上位機(jī)。這個(gè)處理在工業(yè)現(xiàn)場(chǎng)特別重要因?yàn)闄C(jī)械卡住、電機(jī)過(guò)流、驅(qū)動(dòng)過(guò)熱時(shí)有時(shí)候電機(jī)會(huì)劇烈抖動(dòng)如果不快速響應(yīng)下一步就可能打壞減速機(jī)。3. PIC18LF47K42 端軟件實(shí)現(xiàn)3.1 用硬件定時(shí)器生成精準(zhǔn) STEP 脈沖軟件里第一個(gè)關(guān)鍵點(diǎn)STEP 脈沖絕對(duì)不能用軟件延時(shí)去翻轉(zhuǎn) IO。延時(shí)函數(shù)的誤差會(huì)隨中斷、任務(wù)調(diào)度疊加脈沖間隔可能忽長(zhǎng)忽短步進(jìn)電機(jī)對(duì)這種抖動(dòng)非常敏感輕則噪音變大重則直接丟步。正確做法是把定時(shí)器配置成自由運(yùn)行的時(shí)基讓 PWM 模塊在硬件層面連續(xù)輸出方波。大概的配置思路是這樣的選擇 TMR2 作為 PWM 的時(shí)基周期寄存器 PR2 決定頻率占空比寄存器決定高電平寬度。我要輸出的是固定占空比 50% 的方波一個(gè)完整 PWM 周期就對(duì)應(yīng)一個(gè) STEP 脈沖。那么頻率和 PR2 的關(guān)系是PWM_Frequency Fosc / (4 × Prescaler × (PR2 1))反過(guò)來(lái)已知目標(biāo)速度 S單位是 steps/s那么PR2 Fosc / (4 × Prescaler × S) - 1PIC18LF47K42 是 4 倍時(shí)鐘分頻架構(gòu)這里的 4 就是指令周期除法系數(shù)。Prescaler 我設(shè)成 1這樣低速和高速范圍都能覆蓋。代碼實(shí)現(xiàn)上我寫(xiě)了個(gè)接口函數(shù)// 目標(biāo)速度 S 單位steps/s void stepper_set_speed(uint32_t steps_per_sec) { uint32_t pr2 (_XTAL_FREQ / (4UL * 1UL * steps_per_sec)) - 1; if (pr2 65535UL) pr2 65535UL; // 限速下限 PR2 (uint16_t)pr2; }修改 PR2 的時(shí)機(jī)也很講究。不能隨便在一個(gè) PWM 周期的中間改否則這個(gè)周期的長(zhǎng)度會(huì)突然被拉長(zhǎng)產(chǎn)生一個(gè)毛刺脈沖。我是在 TMR2 周期匹配中斷里更新 PR2 的也就是每個(gè) PWM 周期結(jié)束之后再改這樣脈沖序列始終平滑。這個(gè)細(xì)節(jié)直接影響電機(jī)噪音尤其在低速段表現(xiàn)差異很大。3.2 梯形加減速和 S 型曲線(xiàn)的落地步進(jìn)電機(jī)開(kāi)環(huán)控制最大的敵人不是扭矩不夠而是加速度太猛。電機(jī)本身有慣性如果速度瞬間跳變轉(zhuǎn)子跟不上磁場(chǎng)就會(huì)丟步。所以任何正經(jīng)應(yīng)用都不會(huì)直接一步到位給最高速度而是先低速啟動(dòng)再逐步加速最后減速停止。最基礎(chǔ)的是梯形加減速速度曲線(xiàn)像一個(gè)梯形軟件實(shí)現(xiàn)也最簡(jiǎn)單。梯形曲線(xiàn)的邏輯是每個(gè)控制周期更新一次“目標(biāo)速度”。我用的控制周期是 1ms也就是每隔 1ms 算一次當(dāng)前應(yīng)該跑多少 speed。加速段每次加一個(gè)固定增量直到達(dá)到設(shè)定最大速度減速段同理每次減一個(gè)固定增量。這樣做的好處是加速度恒定力矩需求可預(yù)估。但梯形曲線(xiàn)在加速起點(diǎn)和減速終點(diǎn)會(huì)有加速度突變機(jī)械上會(huì)有沖擊。機(jī)器人關(guān)節(jié)如果帶著負(fù)載來(lái)回?cái)[這種沖擊會(huì)被放大顯得動(dòng)作“愣”。所以這個(gè)項(xiàng)目里我改用了 S 型曲線(xiàn)加速速率的斜率不是恒定的而是從 0 慢慢升到最大值最后再慢慢回落到 0。實(shí)現(xiàn)也不復(fù)雜維護(hù)一個(gè)“當(dāng)前速度”和一個(gè)“當(dāng)前加速度”每 1ms 更新一次加速度然后再用這個(gè)加速度更新速度。S 型曲線(xiàn)看起來(lái)有點(diǎn)復(fù)雜實(shí)際上代碼就是狀態(tài)機(jī)// 加速階段加速度從 a_min 按斜率遞增到 a_max accel jerk * dt; if (accel accel_max) accel accel_max; speed accel * dt; if (speed target_speed) speed target_speed;減速階段反向跑同樣的邏輯。整個(gè)運(yùn)動(dòng)過(guò)程中位置計(jì)數(shù)器在每個(gè) STEP 中斷里遞增或遞減方向由 DIR 引腳控制。實(shí)際測(cè)試下來(lái)S 型曲線(xiàn)后電機(jī)嘯叫明顯降低機(jī)械末端也穩(wěn)了很多。3.3 位置閉環(huán)、堵轉(zhuǎn)檢測(cè)和故障聯(lián)動(dòng)純開(kāi)環(huán)步進(jìn)控制的問(wèn)題在于丟步了 MCU 不知道。工業(yè)應(yīng)用里位置錯(cuò)了是很大的事所以我在這個(gè)項(xiàng)目里加了一個(gè)增量編碼器裝在電機(jī)后端用來(lái)做位置閉環(huán)。做法很簡(jiǎn)單MCU 用輪詢(xún)或者外部中斷讀取編碼器的 A、B 相維護(hù)一個(gè)實(shí)際位置計(jì)數(shù)同時(shí)指令位置由 STEP 脈沖計(jì)數(shù)得到。兩者誤差超過(guò)一定閾值就認(rèn)為丟步了觸發(fā)報(bào)警。堵轉(zhuǎn)檢測(cè)也可以不裝編碼器用電流特征來(lái)猜。電機(jī)堵轉(zhuǎn)時(shí)相電流變化率、反電動(dòng)勢(shì)都會(huì)異常但這樣精度有限做安全保護(hù)可以做精確糾偏不行。我建議在機(jī)器人關(guān)節(jié)這種場(chǎng)景還是老老實(shí)實(shí)加編碼器或者磁編碼器成本不高可靠性大幅提升。FAULT 引腳和編碼器信號(hào)都接在 MCU 的中斷/輸入捕獲上。FAULT 一旦變低我立刻把 PWM 輸出關(guān)掉同時(shí)把 STEP 引腳拉低防止芯片在異常狀態(tài)下繼續(xù)收脈沖。然后記錄一個(gè)故障碼通過(guò)串口送到上位機(jī)。實(shí)際調(diào)試中最常觸發(fā) FAULT 的原因不是過(guò)流而是電源跌落導(dǎo)致的欠壓保護(hù)這一點(diǎn)后面在調(diào)試部分詳細(xì)講。4. 步進(jìn)電機(jī) FOC 控制原理以及什么時(shí)候該升級(jí)4.1 為什么現(xiàn)在到處都在聊“步進(jìn)電機(jī) FOC”最近搜索“步進(jìn)電機(jī) FOC 控制原理”的人很多其實(shí)大家關(guān)注的不是理論本身而是實(shí)際問(wèn)題傳統(tǒng)步進(jìn)電機(jī)用全步進(jìn)或微步驅(qū)動(dòng)電流是方波或者近似正弦的階梯波扭矩有波動(dòng)噪音大高速段扭矩掉得快。FOC 也就是磁場(chǎng)定向控制能讓電流保持理想的正弦波形轉(zhuǎn)子的磁場(chǎng)和定子磁場(chǎng)始終處在最佳矢量關(guān)系上效率、噪音、高速性能都得到改善。很多新的機(jī)器人關(guān)節(jié)和 3D 打印機(jī)開(kāi)始用“閉環(huán)步進(jìn)”或者“伺服步進(jìn)”本質(zhì)上就是在步進(jìn)電機(jī)上做 FOC再加一個(gè)編碼器做位置環(huán)。這套方案對(duì)比傳統(tǒng)開(kāi)環(huán)步進(jìn)的優(yōu)勢(shì)很明顯同樣的電機(jī)能輸出更大的有效扭矩發(fā)熱變低噪音顯著下降高速不丟步。代價(jià)是硬件復(fù)雜度和成本上去了。4.2 FOC 的核心原理用大白話(huà)講清楚先解釋一個(gè)基礎(chǔ)概念三相電機(jī)的電流不是一個(gè)標(biāo)量而是一個(gè)空間矢量。FOC 的思路是把這個(gè)電流矢量分解成兩個(gè)直角分量一個(gè)叫 d 軸分量直軸電流對(duì)應(yīng)勵(lì)磁一個(gè)叫 q 軸分量交軸電流對(duì)應(yīng)力矩。理想控制就是讓 d 軸電流控制磁通讓 q 軸電流控制扭矩兩者互不干擾。想提速就加大 q 軸電流想省電就把 d 軸電流控制到零。實(shí)現(xiàn)這個(gè)目標(biāo)需要三步坐標(biāo)變換。第一步把檢測(cè)到的三相電流通過(guò) Clark 變換轉(zhuǎn)換到靜止兩相坐標(biāo)系得到 α 軸和 β 軸分量。第二步把靜止兩相坐標(biāo)系通過(guò) Park 變換投影到轉(zhuǎn)子旋轉(zhuǎn)坐標(biāo)系得到 d 軸和 q 軸分量。這一步必須知道轉(zhuǎn)子的實(shí)時(shí)角度所以需要編碼器或者無(wú)感觀(guān)測(cè)器。第三步對(duì) d、q 軸電流分別做 PI 調(diào)節(jié)輸出 d、q 軸電壓指令然后再做逆 Park 變換和 SVPWM得到實(shí)際要施加到電機(jī)上的三相電壓占空比。雙極步進(jìn)電機(jī)本質(zhì)上就是兩相電機(jī)FOC 實(shí)現(xiàn)時(shí)只需要采樣兩相電流第三相可以用基爾霍夫定律算出來(lái)。很多步進(jìn)驅(qū)動(dòng)芯片已經(jīng)把電流采樣和 PWM 斬波集成好了但 FOC 需要實(shí)時(shí)控制每一相的電流波形所以驅(qū)動(dòng)方式和傳統(tǒng) STEP/DIR 芯片完全不一樣。DRV8818 這類(lèi)芯片工作在恒定頻率的 PWM 斬波模式下輸出的是“電壓型方波占空比”用來(lái)實(shí)現(xiàn)電流限制是可以的但要做 FOC 矢量控制就力不從心了。4.3 這個(gè)項(xiàng)目要不要上 FOC我的判斷回到這個(gè)項(xiàng)目如果只是做一個(gè)工業(yè)定位平臺(tái)、小型機(jī)器人關(guān)節(jié)用 DRV8818 微步 S 型曲線(xiàn)開(kāi)環(huán)跑大部分場(chǎng)景都?jí)蛴?。微步模式已?jīng)能把電流階梯細(xì)分配合 1/8、1/16 甚至更高細(xì)分噪音和共振已經(jīng)壓得不錯(cuò)。再加上編碼器位置閉環(huán)和真正的 FOC 相比實(shí)現(xiàn)成本低很多軟件調(diào)試驗(yàn)證周期也短很多。但如果負(fù)載變化大、經(jīng)常需要高速啟停、或者外發(fā)噪音有嚴(yán)格要求那就應(yīng)該考慮 FOC。具體升級(jí)路徑也簡(jiǎn)單一種是把 DRV8818 換成帶 FOC 算法的集成驅(qū)動(dòng)芯片MCU 只管位置和通訊另一種是保留功率 H 橋在 MCU 里自己跑 FOC 算法和控制定時(shí)器電流采樣用 ADC 完成。后者對(duì) MCU 的 ADC 采樣速度和 PWM 同步要求很高PIC18LF47K42 可以做簡(jiǎn)單的低速實(shí)驗(yàn)但真正量產(chǎn)我更推薦用更高性能的處理器。4.4 FOC 控制的硬件采樣和軟件骨架如果非要在這顆 K42 上跑 FOC首先要把兩塊 ADC 配置成和 PWM 同步觸發(fā)這樣才能在 PWM 的特定點(diǎn)采樣相電流避免開(kāi)關(guān)噪聲。電流采樣通過(guò)兩個(gè)低電阻采樣電阻放大后接入 ADC 引腳采樣點(diǎn)要避開(kāi)功率管開(kāi)關(guān)瞬間。位置角度如果是無(wú)感的還需要用滑模觀(guān)測(cè)器或者磁鏈觀(guān)測(cè)器估計(jì)轉(zhuǎn)子位置和速度低速時(shí)無(wú)感觀(guān)測(cè)效果會(huì)變差通常會(huì)用開(kāi)環(huán) I/f 啟動(dòng)速度上來(lái)后再切到閉環(huán)。代碼框架大概是這樣// PWM 周期中斷里執(zhí)行 FOC 控制環(huán) void foc_current_loop(void) { ia adc_read(ADC_A); ib adc_read(ADC_B); alpha clarke_alpha(ia, ib); beta clarke_beta(ia, ib); id park_d(alpha, beta, theta); iq park_q(alpha, beta, theta); vd PI_controller(id - id_ref); vq PI_controller(iq - iq_ref); alpha_v inverse_park(vd, vq, theta); beta_v inverse_park_q(vd, vq, theta); svpwm_update(alpha_v, beta_v, mcpwm_comparator); }這一段的核心是一個(gè) 10kHz 到 20kHz 的電流環(huán)中斷所有坐標(biāo)變換和 PI 運(yùn)算必須在中斷周期內(nèi)完成。實(shí)際上 8 位 MCU 跑浮點(diǎn)會(huì)很吃力一般用定點(diǎn)數(shù)或者查表法。所以還是那句不是說(shuō)不行而是你要算清楚時(shí)間余量。5. 調(diào)試實(shí)錄與常見(jiàn)問(wèn)題速查5.1 上電沒(méi)力矩先把三個(gè)點(diǎn)查了我調(diào)試這個(gè)板子的第一天就遇到過(guò)上電之后電機(jī)紋絲不動(dòng)一點(diǎn)保持力都沒(méi)有。這種情況下先不要懷疑代碼那是最后一步。第一步拿萬(wàn)用表量 DRV8818 的 VM確認(rèn) 24V 真的到了。第二步量 VREF確實(shí)有電壓。第三步量 nSLEEP 引腳如果它被拉低了芯片整個(gè)處于休眠狀態(tài)所有 H 橋輸出都是高阻電機(jī)自然一點(diǎn)力都沒(méi)有。后來(lái)排查發(fā)現(xiàn)是 MCU 上電默認(rèn)狀態(tài)下RD1 輸出的是低電平而 nSLEEP 是低有效等于一上電就被按進(jìn)休眠。解決辦法很簡(jiǎn)單把 SLEEP 初始化函數(shù)放在最前面上電立即拉高。這個(gè)坑很典型尤其從其他平臺(tái)轉(zhuǎn)到 PIC 平臺(tái)容易遇到因?yàn)椴煌?MCU 上電后的默認(rèn) GPIO 電平不一樣。5.2 電機(jī)噪音大和共振查電流波形步進(jìn)電機(jī)低速噪音大幾乎所有人都遇到過(guò)。噪音的來(lái)源是電流波形的諧波分量和機(jī)械結(jié)構(gòu)的共振疊加。調(diào)試時(shí)我建議先不要開(kāi) S 型曲線(xiàn)把速度固定在一個(gè)比較慢的值然后逐檔切換細(xì)分聽(tīng)聲音、看電流波形。細(xì)分越高相電流越接近正弦噪音越低。但細(xì)分也不是越高越好太高的細(xì)分對(duì) STEP 脈沖頻率要求很高PIC 的定時(shí)器能輸出但機(jī)械響應(yīng)不一定需要那么細(xì)。電流波形怎么看在采樣電阻兩端接一個(gè)差分探頭或者直接在 VREF 和 GND 之間看斬波頻率都可以看到斬波痕跡。如果你看到電流波形在某一段出現(xiàn)了明顯的失真說(shuō)明衰減模式?jīng)]設(shè)置好或者電源電壓不夠電流建立速率跟不上換相節(jié)奏。我調(diào)衰減模式時(shí)的判斷標(biāo)準(zhǔn)很簡(jiǎn)單電流紋波小且加速過(guò)程不出現(xiàn)明顯的“撞齒聲”。5.3 芯片過(guò)熱先降保持電流DRV8818 的 PowerPAD 焊接到大面積銅皮后熱設(shè)計(jì)通常不會(huì)有太大問(wèn)題。我遇到的過(guò)熱案例仔細(xì)查下來(lái)是靜止保持電流設(shè)置太高。電機(jī)停下來(lái)的時(shí)候只是要保持位置不需要額定力矩但驅(qū)動(dòng)芯片如果沒(méi)有單獨(dú)調(diào)整電流會(huì)持續(xù)輸出額定電流時(shí)間一長(zhǎng)整塊板子都熱。解決辦法是在運(yùn)動(dòng)完成之后通過(guò) DAC 把 VREF 降一半或者控制 nSLEEP 進(jìn)入半流保持狀態(tài)。PCB 布局上還有一個(gè)細(xì)節(jié)PowerPAD 底下的過(guò)孔要打足最好是大孔徑過(guò)孔熱阻才低。只用一兩個(gè)小過(guò)孔導(dǎo)熱等于把整塊銅皮的熱量憋在芯片底下功率一大必然掉鏈子。5.4 丟步和位置漂移的排查順序丟步是最難排查的問(wèn)題之一因?yàn)樗赡苁菣C(jī)械、硬件、軟件三方共同作用的結(jié)果。我自己的排查順序是先看機(jī)械負(fù)載有沒(méi)有卡滯然后看加速曲線(xiàn)是不是太陡再看供電電壓在加速瞬間有沒(méi)有跌落最后才是看代碼邏輯。供電電壓跌落是最容易忽略的。加速時(shí)電流峰值很高如果電源是穩(wěn)壓電源電壓可能從 24V 掉到 22V步進(jìn)驅(qū)動(dòng)芯片的限流點(diǎn)會(huì)跟著下降力矩不足就丟步。我處理過(guò)一次換了一個(gè)功率更足的電源適配器問(wèn)題直接消失。后來(lái)我在 VM 引腳附近加了一顆大容量?jī)?chǔ)能電容抗瞬間跌落的能力好了很多。再補(bǔ)一個(gè)細(xì)節(jié)STEP 信號(hào)線(xiàn)上如果走線(xiàn)太長(zhǎng)建議串聯(lián)一個(gè) 100Ω 左右的小電阻同時(shí)在 STEP 引腳對(duì)地加一個(gè)小電容濾掉振鈴。如果脈沖沿有毛刺DRV8818 可能在一個(gè)脈沖周期內(nèi)誤觸發(fā)多次位置瞬間偏掉好幾個(gè)步距角。5.5 常見(jiàn)問(wèn)題速查表問(wèn)題現(xiàn)象可能原因排查與解決上電電機(jī)無(wú)力nSLEEP 引腳電平錯(cuò)誤上電初始化時(shí)拉高 SLEEP電機(jī)抖動(dòng)但不動(dòng)電流限幅太小調(diào)高 VREF確認(rèn) R_sense 阻值電機(jī)嘯叫明顯衰減模式不對(duì)或細(xì)分過(guò)低調(diào)成混合衰減提高細(xì)分運(yùn)行一段時(shí)間停機(jī)芯片過(guò)熱保護(hù)降保持電流優(yōu)化散熱焊盤(pán)高速時(shí)丟步加速曲線(xiàn)過(guò)陡或電源跌落用 S 型曲線(xiàn)、加大儲(chǔ)能電容STEP 脈沖被漏掉脈寬過(guò)窄或信號(hào)振鈴用 50% 占空比方波加 RC 濾波6. 最后分享一些我踩過(guò)的小坑這套系統(tǒng)調(diào)試到最后最大的體會(huì)就是步進(jìn)電機(jī)控制難的不是原理而是把所有看似不起眼的細(xì)節(jié)都管住。DRV8818 和 PIC18LF47K42 的組合既不像專(zhuān)用運(yùn)動(dòng)控制芯片那樣黑盒也不像完全用分立器件搭 H 橋那樣費(fèi)勁是一個(gè)比較理想的折中。只要電流限制、衰減模式、STEP 脈沖質(zhì)量和加減速曲線(xiàn)這四個(gè)維度都控制好工業(yè)定位和機(jī)器人關(guān)節(jié)應(yīng)用都能跑得很穩(wěn)。最后再分享一個(gè)小技巧電機(jī)和驅(qū)動(dòng)器之間最好用短而粗的線(xiàn)直接連接不要用細(xì)長(zhǎng)線(xiàn)更不要用那種帶接插口的“延長(zhǎng)線(xiàn)”到處飛來(lái)飛去。雙極步進(jìn)電機(jī)相電流在換相瞬間變化率很高線(xiàn)纜的電感會(huì)造成很大的尖峰幾十伏的尖峰很容易把 VM 電容充爆甚至灌到邏輯電路里。我后來(lái)給電機(jī)線(xiàn)加了磁環(huán)尖峰明顯小了很多板子也安靜了不少。希望在調(diào)試步進(jìn)電機(jī)的各位能少走兩條彎路。 基于PIC18LF47K42與DRV8818的雙極步進(jìn)電機(jī)驅(qū)動(dòng)方案詳解
做機(jī)器人的朋友應(yīng)該都有過(guò)這種經(jīng)歷上電一看電機(jī)嗡嗡響軸卻一動(dòng)不動(dòng)要么換了個(gè)負(fù)載扭矩就不夠電機(jī)燙得能煎蛋。我這次做的工業(yè)/機(jī)器人步進(jìn)電機(jī)驅(qū)動(dòng)方案用的是一顆很多人覺(jué)得“老氣”的 8 位單片機(jī) PIC18LF47K42和 TI 的 DRV8818PWPR 雙 H 橋驅(qū)動(dòng)器目標(biāo)是把雙極步進(jìn)電機(jī)的速度、位置和力矩控制做到穩(wěn)定可靠。這套組合看起來(lái)簡(jiǎn)單實(shí)際把硬件參數(shù)、電流斬波、加減速算法、異常保護(hù)全部理順之后跑工業(yè)定位平臺(tái)和機(jī)器人關(guān)節(jié)都足夠穩(wěn)。下面把我整個(gè)設(shè)計(jì)和調(diào)試過(guò)程完整拆開(kāi)講從硬件選型到軟件實(shí)現(xiàn)再到常見(jiàn)坑位全部記錄在案。1. 項(xiàng)目概覽與控制方案怎么定1.1 先搞清楚要控制的是什么雙極步進(jìn)電機(jī)和普通直流電機(jī)不一樣us that 雙極步進(jìn)電機(jī)通常是四根線(xiàn)分成 A 相和 B 相每一相都是一組線(xiàn)圈。想讓轉(zhuǎn)子轉(zhuǎn)起來(lái)必須讓電流按順序在 A、B 兩個(gè)線(xiàn)圈里換相形成旋轉(zhuǎn)磁場(chǎng)。所以不能簡(jiǎn)單地把電源往電機(jī)上一懟而是要有一對(duì) H 橋至少四個(gè)功率開(kāi)關(guān)管按順序打開(kāi)關(guān)閉。這個(gè)項(xiàng)目里用到的 DRV8818PWPR其實(shí)就把兩個(gè) H 橋和電流斬波、限流比較器、各種保護(hù)邏輯集成到了一顆芯片里。PIC18LF47K42 只負(fù)責(zé)出邏輯信號(hào)不需要自己干功率放大的活。這種“MCU 出邏輯 驅(qū)動(dòng)芯片出功率”的分工在工業(yè)板和機(jī)器人控制板里是最常見(jiàn)也最不容易出錯(cuò)的方案。因?yàn)槟惆迅唠妷?、大電流和邏輯電源隔開(kāi)了出問(wèn)題的時(shí)候排查范圍一下就縮小了。如果把“步進(jìn)電機(jī)控制”簡(jiǎn)單理解成“給個(gè)脈沖轉(zhuǎn)多少角度”那很多項(xiàng)目都能跑但跑得穩(wěn)不穩(wěn)是另一回事。真正的控制目標(biāo)有三個(gè)一是位置精確說(shuō)走 100 步就真的走 100 步二是速度曲線(xiàn)可控加速、勻速、減速都不會(huì)丟步三是電流受控電機(jī)不白發(fā)熱力矩不僅夠還要穩(wěn)。這些目標(biāo)同時(shí)滿(mǎn)足需要從驅(qū)動(dòng)芯片的參數(shù)設(shè)置、MCU 的定時(shí)器用法、運(yùn)動(dòng)曲線(xiàn)的軟件算法三個(gè)層面一起下手。1.2 為什么是 PIC18LF47K42 而不是一顆“更現(xiàn)代”的 MCU選 PIC18LF47K42一開(kāi)始團(tuán)隊(duì)里也有人質(zhì)疑現(xiàn)在隨便一顆 ARM Cortex-M0 都八九十個(gè)引腳性能比 8 位機(jī)強(qiáng)為什么還要選它但實(shí)際做下來(lái)這顆 K42 系列芯片還真挺適合步進(jìn)電機(jī)控制。理由很樸素它自帶不少 Core Independent Peripherals也就是所謂 CIP 外設(shè)很多實(shí)時(shí)性要求高的活可以在硬件層面完成CPU 只需要在關(guān)鍵節(jié)點(diǎn)處理邏輯。比如產(chǎn)生 STEP 脈沖這件事如果用 GPIO 翻轉(zhuǎn)加延時(shí)來(lái)做中斷一多、任務(wù)一復(fù)雜脈沖間隔就不均勻速度曲線(xiàn)會(huì)抖最終表現(xiàn)就是電機(jī)噪音大、丟步。而 K42 的定時(shí)器配合 PWM/CCP 模塊可以由硬件連續(xù)輸出占空比 50% 的方波脈沖頻率只由定時(shí)器周期寄存器決定。CPU 不用每一步都參與只要在運(yùn)動(dòng)過(guò)程中調(diào)整目標(biāo)頻率就能產(chǎn)生非常平滑的步進(jìn)脈沖序列。還有就是成本、庫(kù)存、可靠性的考量。工業(yè)設(shè)備不追求最新最酷的芯片而是講究生命周期長(zhǎng)、文檔齊全、供應(yīng)鏈穩(wěn)定。PIC 系列在傳統(tǒng)工控里應(yīng)用很廣汽車(chē)電子、醫(yī)療設(shè)備里也能看到它的影子。8 位 MCU 算力確實(shí)不強(qiáng)但步進(jìn)電機(jī)控制本身不是一個(gè) CPU 密集型的活真正吃性能的往往是通訊協(xié)議、故障診斷、數(shù)據(jù)記錄這些“外圍工作”。K42 把這些外圍工作分給硬件外設(shè)去跑CPU 性能反而是夠的。1.3 DRV8818PWPR 在系統(tǒng)里承擔(dān)什么角色DRV8818PWPR 這顆芯片后綴 PWPR 代表 PowerPAD HTSSOP 封裝。這種封裝的底部有一塊大焊盤(pán)焊接到 PCB 的銅皮上可以顯著改善散熱。工業(yè)環(huán)境經(jīng)常連續(xù)工作一整天驅(qū)動(dòng) IC 的結(jié)溫如果壓不住一不穩(wěn)定就會(huì)觸發(fā)過(guò)熱保護(hù)機(jī)器停在那里等你重啟。所以選這種帶 PowerPAD 的封裝不是隨便定的就是為了把熱阻降下來(lái)讓持續(xù)大電流工況下的余量更充足。芯片內(nèi)部集成的兩個(gè) H 橋足以驅(qū)動(dòng)一臺(tái)雙極步進(jìn)電機(jī)。同時(shí)它還有電流斬波功能意思是我設(shè)定一個(gè)目標(biāo)電流比如 1.5A當(dāng)相電流上升到這個(gè)值芯片內(nèi)部就會(huì)通過(guò) PWM 關(guān)斷功率管讓電流降下來(lái)然后再導(dǎo)通如此循環(huán)把電流限制在目標(biāo)值附近。這個(gè)功能叫電流限制也叫斬波恒流。沒(méi)有它步進(jìn)電機(jī)相電流可能直接沖到電源允許的極限電機(jī)和驅(qū)動(dòng)器都會(huì)燒掉。MCU 和 DRV8818 的分工也很直觀(guān)MCU 給出 STEP 脈沖、DIR 方向、SLEEP 休眠、EN 使能這些邏輯信號(hào)DRV8818 再把邏輯信號(hào)放大成功率開(kāi)關(guān)動(dòng)作同時(shí)通過(guò)內(nèi)部電流比較器實(shí)現(xiàn)限流還提供 FAULT 故障輸出讓 MCU 知道當(dāng)前出了什么狀況。這樣 MCU 完全沒(méi)有觸碰高電壓功率級(jí)安全性高很多。后續(xù)調(diào)試時(shí)只要軟件邏輯看著沒(méi)問(wèn)題就可以用萬(wàn)用表去量 DRV8818 的 VM、VREF、ISENSE 這些引腳兩步之內(nèi)就能定位故障在驅(qū)動(dòng)側(cè)還是控制側(cè)。2. DRV8818PWPR 硬件設(shè)計(jì)與電流參數(shù)計(jì)算2.1 供電與功率電路的基本盤(pán)這個(gè)項(xiàng)目里我給電機(jī)側(cè)的 VM 供的是 24VMCU 邏輯部分用 3.3V兩套地最終在整板電源入口附近單點(diǎn)匯接。24V 的電源進(jìn)來(lái)之后先經(jīng)過(guò)一個(gè)防反接二極管然后是一顆 100μF 電解電容加一顆 1μF 陶瓷電容兩個(gè)電容盡量靠近 DRV8818 的 VM 引腳。很多步進(jìn)驅(qū)動(dòng)板的問(wèn)題不是芯片燒了而是電源電容放得太遠(yuǎn)MOS 開(kāi)關(guān)瞬間產(chǎn)生的高 dV/dt 把芯片旁邊的邏輯電路干擾得亂七八糟。要注意的是 VM 不要和 MCU 的電源共用一個(gè) LDO。DRV8818 工作的時(shí)候VM 上的電流變化非常劇烈如果 3.3V 是從同一個(gè)電源軌拉出來(lái)的步進(jìn)脈沖一來(lái)邏輯電壓就會(huì)跳。我一開(kāi)始圖省事用一塊 DC-DC 輸出 24V然后從 24V 再拉一個(gè) LDO 出來(lái)做 3.3V結(jié)果電機(jī)一轉(zhuǎn)MCU 時(shí)不時(shí)復(fù)位。后來(lái)改成獨(dú)立的 5V 轉(zhuǎn) 3.3V 電源軌問(wèn)題就消失了。VM 電壓的選擇要結(jié)合電機(jī)的額定電壓來(lái)理解。步進(jìn)電機(jī)相電壓一般有個(gè)標(biāo)稱(chēng)值但實(shí)際運(yùn)行時(shí)線(xiàn)圈是電感PWM 恒流驅(qū)動(dòng)下電源電壓高于電機(jī)額定電壓反而能更快地建立電流。所以 12V 的電機(jī)用 24V 驅(qū)動(dòng)很常見(jiàn)只要限流值沒(méi)超過(guò)電機(jī)額定電流就不會(huì)燒。但也要注意電壓太高會(huì)讓電流紋波變大開(kāi)關(guān)損耗和 EMI 跟著增加。24V 在這個(gè)項(xiàng)目里是一個(gè)均衡點(diǎn)。2.2 峰值電流怎么算VREF 和采樣電阻是關(guān)鍵電流限制的原理是相電流流過(guò)采樣電阻在電阻上產(chǎn)生壓降這個(gè)電壓和 VREF 引腳設(shè)定的參考電壓比較。當(dāng)采樣電壓超過(guò)參考內(nèi)部比較器翻轉(zhuǎn)關(guān)斷當(dāng)前導(dǎo)通管進(jìn)入衰減階段。所以在 DRV8818 上目標(biāo)電流主要由 VREF 和 ISENSE 處的采樣電阻共同決定。不同廠(chǎng)牌、不同絲印版本的公式可能略有差異但思路一樣就是I_trip VREF / (Gain × R_sense)Gain 是芯片內(nèi)部的電流增益倍數(shù)不同芯片差異很大我這邊用到的實(shí)際配置是 VREF 1.5V、R_sense 0.1Ω目標(biāo)峰值電流 1.5A。算出來(lái)之后還要留出裕量。尤其機(jī)器人關(guān)節(jié)在加速的時(shí)候電流瞬時(shí)值會(huì)明顯超過(guò)勻速電流如果 VREF 卡得太死加速過(guò)程中限流提前觸法力矩不夠直接丟步。經(jīng)驗(yàn)值是目標(biāo)電流不要超過(guò)電機(jī)額定電流的 80% 到 90%同時(shí)驅(qū)動(dòng)芯片的峰值電流能力再留 30% 左右的余量。比如這臺(tái)電機(jī)額定相電流 1.7A我就把限流設(shè)成 1.5A驅(qū)動(dòng)器宣稱(chēng)峰值能力 2.5A余量足夠。再把 VREF 的電壓接到一個(gè)可調(diào)的 DAC 上后續(xù)如果需要降低靜止保持電流我可以通過(guò)軟件調(diào)節(jié) VREF讓電機(jī)在停頓狀態(tài)時(shí)少發(fā)熱。VREF 引腳不能懸空采樣電阻要用低感抗的低阻值大功率電阻我用的 0.1Ω/1W 金屬膜電阻布局上要盡量靠近 ISENSE 引腳。采樣電阻的走線(xiàn)要短、寬因?yàn)楣β驶芈防锏娜魏渭纳娮瓒紩?huì)分掉采樣信號(hào)導(dǎo)致電流不準(zhǔn)。如果采樣點(diǎn)離芯片太遠(yuǎn)線(xiàn)路壓降疊加進(jìn)去可能還沒(méi)到閾值芯片就提前關(guān)斷了實(shí)際力矩會(huì)比預(yù)期小。2.3 衰減模式容易被忽略但影響很大的參數(shù)步進(jìn)電機(jī)是電感負(fù)載電感有個(gè)特性電流不能突變。當(dāng)限流比較器觸發(fā)、功率管關(guān)斷時(shí)相電流不可能瞬間歸零必須給電流一個(gè)“泄放回路”。衰減模式?jīng)Q定的就是這個(gè)泄放過(guò)程怎么做。慢衰減模式下關(guān)斷時(shí)電流在 H 橋的下管續(xù)流回路里自然衰減電流紋波比較小電機(jī)運(yùn)行更“安靜”但電流下降速度慢跟不上快節(jié)奏的換相。快衰減模式則是把功率管全部反向驅(qū)動(dòng)迫使電流快速下降響應(yīng)快但紋波大在高電源電壓下會(huì)顯得電機(jī)和驅(qū)動(dòng)板更熱。混合衰減則是折中先快衰減一段再切換到慢衰減兼顧響應(yīng)速度和紋波。DRV8818 上通常有配置引腳來(lái)選擇衰減模式。我這里最終選的是混合衰減。原因很簡(jiǎn)單機(jī)器人關(guān)節(jié)經(jīng)常要在低速下反復(fù)啟停低速段最容易出現(xiàn)共振和噪音純慢衰減雖然安靜但位置跟隨性差純快衰減又會(huì)讓電流噪聲偏大。調(diào)衰減模式的時(shí)候最好拿鉗流表或者采樣電阻上的電壓波形來(lái)看不要只憑耳朵感受耳朵會(huì)騙人波形不會(huì)。2.4 與 PIC18LF47K42 的接線(xiàn)和引腳功能劃分我實(shí)際用的引腳映射如下給各位一個(gè)參考PIC18LF47K42 引腳DRV8818 引腳信號(hào)作用RA0DIR方向控制高/低電平切換RC5 / PWM 輸出STEP步進(jìn)脈沖輸入上升沿有效RB0FAULT故障輸出低電平有效接 MCU 中斷RD1SLEEP休眠控制低電平進(jìn)入休眠RD2EN使能控制低電平關(guān)閉輸出DAC 輸出VREF設(shè)定電流運(yùn)行/保持時(shí)調(diào)節(jié)STEP 和 DIR 是核心的兩根信號(hào)線(xiàn)。STEP 脈沖的寬度要注意不能太窄。如果 MCU 的 PWM 輸出脈寬小于 DRV8818 的最小步進(jìn)脈寬要求芯片可能漏掉脈沖造成位置漂移。所以我在軟件里把 STEP 設(shè)為占空比 50% 的方波頻率可變脈寬永遠(yuǎn)夠。FAULT 引腳接到了 RB0 的外部中斷上。一旦 FAULT 變低MCU 立即進(jìn)入保護(hù)流程把運(yùn)動(dòng)狀態(tài)凍結(jié)記錄故障代碼然后通過(guò)通訊口上報(bào)給上位機(jī)。這個(gè)處理在工業(yè)現(xiàn)場(chǎng)特別重要因?yàn)闄C(jī)械卡住、電機(jī)過(guò)流、驅(qū)動(dòng)過(guò)熱時(shí)有時(shí)候電機(jī)會(huì)劇烈抖動(dòng)如果不快速響應(yīng)下一步就可能打壞減速機(jī)。3. PIC18LF47K42 端軟件實(shí)現(xiàn)3.1 用硬件定時(shí)器生成精準(zhǔn) STEP 脈沖軟件里第一個(gè)關(guān)鍵點(diǎn)STEP 脈沖絕對(duì)不能用軟件延時(shí)去翻轉(zhuǎn) IO。延時(shí)函數(shù)的誤差會(huì)隨中斷、任務(wù)調(diào)度疊加脈沖間隔可能忽長(zhǎng)忽短步進(jìn)電機(jī)對(duì)這種抖動(dòng)非常敏感輕則噪音變大重則直接丟步。正確做法是把定時(shí)器配置成自由運(yùn)行的時(shí)基讓 PWM 模塊在硬件層面連續(xù)輸出方波。大概的配置思路是這樣的選擇 TMR2 作為 PWM 的時(shí)基周期寄存器 PR2 決定頻率占空比寄存器決定高電平寬度。我要輸出的是固定占空比 50% 的方波一個(gè)完整 PWM 周期就對(duì)應(yīng)一個(gè) STEP 脈沖。那么頻率和 PR2 的關(guān)系是PWM_Frequency Fosc / (4 × Prescaler × (PR2 1))反過(guò)來(lái)已知目標(biāo)速度 S單位是 steps/s那么PR2 Fosc / (4 × Prescaler × S) - 1PIC18LF47K42 是 4 倍時(shí)鐘分頻架構(gòu)這里的 4 就是指令周期除法系數(shù)。Prescaler 我設(shè)成 1這樣低速和高速范圍都能覆蓋。代碼實(shí)現(xiàn)上我寫(xiě)了個(gè)接口函數(shù)// 目標(biāo)速度 S 單位steps/s void stepper_set_speed(uint32_t steps_per_sec) { uint32_t pr2 (_XTAL_FREQ / (4UL * 1UL * steps_per_sec)) - 1; if (pr2 65535UL) pr2 65535UL; // 限速下限 PR2 (uint16_t)pr2; }修改 PR2 的時(shí)機(jī)也很講究。不能隨便在一個(gè) PWM 周期的中間改否則這個(gè)周期的長(zhǎng)度會(huì)突然被拉長(zhǎng)產(chǎn)生一個(gè)毛刺脈沖。我是在 TMR2 周期匹配中斷里更新 PR2 的也就是每個(gè) PWM 周期結(jié)束之后再改這樣脈沖序列始終平滑。這個(gè)細(xì)節(jié)直接影響電機(jī)噪音尤其在低速段表現(xiàn)差異很大。3.2 梯形加減速和 S 型曲線(xiàn)的落地步進(jìn)電機(jī)開(kāi)環(huán)控制最大的敵人不是扭矩不夠而是加速度太猛。電機(jī)本身有慣性如果速度瞬間跳變轉(zhuǎn)子跟不上磁場(chǎng)就會(huì)丟步。所以任何正經(jīng)應(yīng)用都不會(huì)直接一步到位給最高速度而是先低速啟動(dòng)再逐步加速最后減速停止。最基礎(chǔ)的是梯形加減速速度曲線(xiàn)像一個(gè)梯形軟件實(shí)現(xiàn)也最簡(jiǎn)單。梯形曲線(xiàn)的邏輯是每個(gè)控制周期更新一次“目標(biāo)速度”。我用的控制周期是 1ms也就是每隔 1ms 算一次當(dāng)前應(yīng)該跑多少 speed。加速段每次加一個(gè)固定增量直到達(dá)到設(shè)定最大速度減速段同理每次減一個(gè)固定增量。這樣做的好處是加速度恒定力矩需求可預(yù)估。但梯形曲線(xiàn)在加速起點(diǎn)和減速終點(diǎn)會(huì)有加速度突變機(jī)械上會(huì)有沖擊。機(jī)器人關(guān)節(jié)如果帶著負(fù)載來(lái)回?cái)[這種沖擊會(huì)被放大顯得動(dòng)作“愣”。所以這個(gè)項(xiàng)目里我改用了 S 型曲線(xiàn)加速速率的斜率不是恒定的而是從 0 慢慢升到最大值最后再慢慢回落到 0。實(shí)現(xiàn)也不復(fù)雜維護(hù)一個(gè)“當(dāng)前速度”和一個(gè)“當(dāng)前加速度”每 1ms 更新一次加速度然后再用這個(gè)加速度更新速度。S 型曲線(xiàn)看起來(lái)有點(diǎn)復(fù)雜實(shí)際上代碼就是狀態(tài)機(jī)// 加速階段加速度從 a_min 按斜率遞增到 a_max accel jerk * dt; if (accel accel_max) accel accel_max; speed accel * dt; if (speed target_speed) speed target_speed;減速階段反向跑同樣的邏輯。整個(gè)運(yùn)動(dòng)過(guò)程中位置計(jì)數(shù)器在每個(gè) STEP 中斷里遞增或遞減方向由 DIR 引腳控制。實(shí)際測(cè)試下來(lái)S 型曲線(xiàn)后電機(jī)嘯叫明顯降低機(jī)械末端也穩(wěn)了很多。3.3 位置閉環(huán)、堵轉(zhuǎn)檢測(cè)和故障聯(lián)動(dòng)純開(kāi)環(huán)步進(jìn)控制的問(wèn)題在于丟步了 MCU 不知道。工業(yè)應(yīng)用里位置錯(cuò)了是很大的事所以我在這個(gè)項(xiàng)目里加了一個(gè)增量編碼器裝在電機(jī)后端用來(lái)做位置閉環(huán)。做法很簡(jiǎn)單MCU 用輪詢(xún)或者外部中斷讀取編碼器的 A、B 相維護(hù)一個(gè)實(shí)際位置計(jì)數(shù)同時(shí)指令位置由 STEP 脈沖計(jì)數(shù)得到。兩者誤差超過(guò)一定閾值就認(rèn)為丟步了觸發(fā)報(bào)警。堵轉(zhuǎn)檢測(cè)也可以不裝編碼器用電流特征來(lái)猜。電機(jī)堵轉(zhuǎn)時(shí)相電流變化率、反電動(dòng)勢(shì)都會(huì)異常但這樣精度有限做安全保護(hù)可以做精確糾偏不行。我建議在機(jī)器人關(guān)節(jié)這種場(chǎng)景還是老老實(shí)實(shí)加編碼器或者磁編碼器成本不高可靠性大幅提升。FAULT 引腳和編碼器信號(hào)都接在 MCU 的中斷/輸入捕獲上。FAULT 一旦變低我立刻把 PWM 輸出關(guān)掉同時(shí)把 STEP 引腳拉低防止芯片在異常狀態(tài)下繼續(xù)收脈沖。然后記錄一個(gè)故障碼通過(guò)串口送到上位機(jī)。實(shí)際調(diào)試中最常觸發(fā) FAULT 的原因不是過(guò)流而是電源跌落導(dǎo)致的欠壓保護(hù)這一點(diǎn)后面在調(diào)試部分詳細(xì)講。4. 步進(jìn)電機(jī) FOC 控制原理以及什么時(shí)候該升級(jí)4.1 為什么現(xiàn)在到處都在聊“步進(jìn)電機(jī) FOC”最近搜索“步進(jìn)電機(jī) FOC 控制原理”的人很多其實(shí)大家關(guān)注的不是理論本身而是實(shí)際問(wèn)題傳統(tǒng)步進(jìn)電機(jī)用全步進(jìn)或微步驅(qū)動(dòng)電流是方波或者近似正弦的階梯波扭矩有波動(dòng)噪音大高速段扭矩掉得快。FOC 也就是磁場(chǎng)定向控制能讓電流保持理想的正弦波形轉(zhuǎn)子的磁場(chǎng)和定子磁場(chǎng)始終處在最佳矢量關(guān)系上效率、噪音、高速性能都得到改善。很多新的機(jī)器人關(guān)節(jié)和 3D 打印機(jī)開(kāi)始用“閉環(huán)步進(jìn)”或者“伺服步進(jìn)”本質(zhì)上就是在步進(jìn)電機(jī)上做 FOC再加一個(gè)編碼器做位置環(huán)。這套方案對(duì)比傳統(tǒng)開(kāi)環(huán)步進(jìn)的優(yōu)勢(shì)很明顯同樣的電機(jī)能輸出更大的有效扭矩發(fā)熱變低噪音顯著下降高速不丟步。代價(jià)是硬件復(fù)雜度和成本上去了。4.2 FOC 的核心原理用大白話(huà)講清楚先解釋一個(gè)基礎(chǔ)概念三相電機(jī)的電流不是一個(gè)標(biāo)量而是一個(gè)空間矢量。FOC 的思路是把這個(gè)電流矢量分解成兩個(gè)直角分量一個(gè)叫 d 軸分量直軸電流對(duì)應(yīng)勵(lì)磁一個(gè)叫 q 軸分量交軸電流對(duì)應(yīng)力矩。理想控制就是讓 d 軸電流控制磁通讓 q 軸電流控制扭矩兩者互不干擾。想提速就加大 q 軸電流想省電就把 d 軸電流控制到零。實(shí)現(xiàn)這個(gè)目標(biāo)需要三步坐標(biāo)變換。第一步把檢測(cè)到的三相電流通過(guò) Clark 變換轉(zhuǎn)換到靜止兩相坐標(biāo)系得到 α 軸和 β 軸分量。第二步把靜止兩相坐標(biāo)系通過(guò) Park 變換投影到轉(zhuǎn)子旋轉(zhuǎn)坐標(biāo)系得到 d 軸和 q 軸分量。這一步必須知道轉(zhuǎn)子的實(shí)時(shí)角度所以需要編碼器或者無(wú)感觀(guān)測(cè)器。第三步對(duì) d、q 軸電流分別做 PI 調(diào)節(jié)輸出 d、q 軸電壓指令然后再做逆 Park 變換和 SVPWM得到實(shí)際要施加到電機(jī)上的三相電壓占空比。雙極步進(jìn)電機(jī)本質(zhì)上就是兩相電機(jī)FOC 實(shí)現(xiàn)時(shí)只需要采樣兩相電流第三相可以用基爾霍夫定律算出來(lái)。很多步進(jìn)驅(qū)動(dòng)芯片已經(jīng)把電流采樣和 PWM 斬波集成好了但 FOC 需要實(shí)時(shí)控制每一相的電流波形所以驅(qū)動(dòng)方式和傳統(tǒng) STEP/DIR 芯片完全不一樣。DRV8818 這類(lèi)芯片工作在恒定頻率的 PWM 斬波模式下輸出的是“電壓型方波占空比”用來(lái)實(shí)現(xiàn)電流限制是可以的但要做 FOC 矢量控制就力不從心了。4.3 這個(gè)項(xiàng)目要不要上 FOC我的判斷回到這個(gè)項(xiàng)目如果只是做一個(gè)工業(yè)定位平臺(tái)、小型機(jī)器人關(guān)節(jié)用 DRV8818 微步 S 型曲線(xiàn)開(kāi)環(huán)跑大部分場(chǎng)景都?jí)蛴?。微步模式已?jīng)能把電流階梯細(xì)分配合 1/8、1/16 甚至更高細(xì)分噪音和共振已經(jīng)壓得不錯(cuò)。再加上編碼器位置閉環(huán)和真正的 FOC 相比實(shí)現(xiàn)成本低很多軟件調(diào)試驗(yàn)證周期也短很多。但如果負(fù)載變化大、經(jīng)常需要高速啟停、或者外發(fā)噪音有嚴(yán)格要求那就應(yīng)該考慮 FOC。具體升級(jí)路徑也簡(jiǎn)單一種是把 DRV8818 換成帶 FOC 算法的集成驅(qū)動(dòng)芯片MCU 只管位置和通訊另一種是保留功率 H 橋在 MCU 里自己跑 FOC 算法和控制定時(shí)器電流采樣用 ADC 完成。后者對(duì) MCU 的 ADC 采樣速度和 PWM 同步要求很高PIC18LF47K42 可以做簡(jiǎn)單的低速實(shí)驗(yàn)但真正量產(chǎn)我更推薦用更高性能的處理器。4.4 FOC 控制的硬件采樣和軟件骨架如果非要在這顆 K42 上跑 FOC首先要把兩塊 ADC 配置成和 PWM 同步觸發(fā)這樣才能在 PWM 的特定點(diǎn)采樣相電流避免開(kāi)關(guān)噪聲。電流采樣通過(guò)兩個(gè)低電阻采樣電阻放大后接入 ADC 引腳采樣點(diǎn)要避開(kāi)功率管開(kāi)關(guān)瞬間。位置角度如果是無(wú)感的還需要用滑模觀(guān)測(cè)器或者磁鏈觀(guān)測(cè)器估計(jì)轉(zhuǎn)子位置和速度低速時(shí)無(wú)感觀(guān)測(cè)效果會(huì)變差通常會(huì)用開(kāi)環(huán) I/f 啟動(dòng)速度上來(lái)后再切到閉環(huán)。代碼框架大概是這樣// PWM 周期中斷里執(zhí)行 FOC 控制環(huán) void foc_current_loop(void) { ia adc_read(ADC_A); ib adc_read(ADC_B); alpha clarke_alpha(ia, ib); beta clarke_beta(ia, ib); id park_d(alpha, beta, theta); iq park_q(alpha, beta, theta); vd PI_controller(id - id_ref); vq PI_controller(iq - iq_ref); alpha_v inverse_park(vd, vq, theta); beta_v inverse_park_q(vd, vq, theta); svpwm_update(alpha_v, beta_v, mcpwm_comparator); }這一段的核心是一個(gè) 10kHz 到 20kHz 的電流環(huán)中斷所有坐標(biāo)變換和 PI 運(yùn)算必須在中斷周期內(nèi)完成。實(shí)際上 8 位 MCU 跑浮點(diǎn)會(huì)很吃力一般用定點(diǎn)數(shù)或者查表法。所以還是那句不是說(shuō)不行而是你要算清楚時(shí)間余量。5. 調(diào)試實(shí)錄與常見(jiàn)問(wèn)題速查5.1 上電沒(méi)力矩先把三個(gè)點(diǎn)查了我調(diào)試這個(gè)板子的第一天就遇到過(guò)上電之后電機(jī)紋絲不動(dòng)一點(diǎn)保持力都沒(méi)有。這種情況下先不要懷疑代碼那是最后一步。第一步拿萬(wàn)用表量 DRV8818 的 VM確認(rèn) 24V 真的到了。第二步量 VREF確實(shí)有電壓。第三步量 nSLEEP 引腳如果它被拉低了芯片整個(gè)處于休眠狀態(tài)所有 H 橋輸出都是高阻電機(jī)自然一點(diǎn)力都沒(méi)有。后來(lái)排查發(fā)現(xiàn)是 MCU 上電默認(rèn)狀態(tài)下RD1 輸出的是低電平而 nSLEEP 是低有效等于一上電就被按進(jìn)休眠。解決辦法很簡(jiǎn)單把 SLEEP 初始化函數(shù)放在最前面上電立即拉高。這個(gè)坑很典型尤其從其他平臺(tái)轉(zhuǎn)到 PIC 平臺(tái)容易遇到因?yàn)椴煌?MCU 上電后的默認(rèn) GPIO 電平不一樣。5.2 電機(jī)噪音大和共振查電流波形步進(jìn)電機(jī)低速噪音大幾乎所有人都遇到過(guò)。噪音的來(lái)源是電流波形的諧波分量和機(jī)械結(jié)構(gòu)的共振疊加。調(diào)試時(shí)我建議先不要開(kāi) S 型曲線(xiàn)把速度固定在一個(gè)比較慢的值然后逐檔切換細(xì)分聽(tīng)聲音、看電流波形。細(xì)分越高相電流越接近正弦噪音越低。但細(xì)分也不是越高越好太高的細(xì)分對(duì) STEP 脈沖頻率要求很高PIC 的定時(shí)器能輸出但機(jī)械響應(yīng)不一定需要那么細(xì)。電流波形怎么看在采樣電阻兩端接一個(gè)差分探頭或者直接在 VREF 和 GND 之間看斬波頻率都可以看到斬波痕跡。如果你看到電流波形在某一段出現(xiàn)了明顯的失真說(shuō)明衰減模式?jīng)]設(shè)置好或者電源電壓不夠電流建立速率跟不上換相節(jié)奏。我調(diào)衰減模式時(shí)的判斷標(biāo)準(zhǔn)很簡(jiǎn)單電流紋波小且加速過(guò)程不出現(xiàn)明顯的“撞齒聲”。5.3 芯片過(guò)熱先降保持電流DRV8818 的 PowerPAD 焊接到大面積銅皮后熱設(shè)計(jì)通常不會(huì)有太大問(wèn)題。我遇到的過(guò)熱案例仔細(xì)查下來(lái)是靜止保持電流設(shè)置太高。電機(jī)停下來(lái)的時(shí)候只是要保持位置不需要額定力矩但驅(qū)動(dòng)芯片如果沒(méi)有單獨(dú)調(diào)整電流會(huì)持續(xù)輸出額定電流時(shí)間一長(zhǎng)整塊板子都熱。解決辦法是在運(yùn)動(dòng)完成之后通過(guò) DAC 把 VREF 降一半或者控制 nSLEEP 進(jìn)入半流保持狀態(tài)。PCB 布局上還有一個(gè)細(xì)節(jié)PowerPAD 底下的過(guò)孔要打足最好是大孔徑過(guò)孔熱阻才低。只用一兩個(gè)小過(guò)孔導(dǎo)熱等于把整塊銅皮的熱量憋在芯片底下功率一大必然掉鏈子。5.4 丟步和位置漂移的排查順序丟步是最難排查的問(wèn)題之一因?yàn)樗赡苁菣C(jī)械、硬件、軟件三方共同作用的結(jié)果。我自己的排查順序是先看機(jī)械負(fù)載有沒(méi)有卡滯然后看加速曲線(xiàn)是不是太陡再看供電電壓在加速瞬間有沒(méi)有跌落最后才是看代碼邏輯。供電電壓跌落是最容易忽略的。加速時(shí)電流峰值很高如果電源是穩(wěn)壓電源電壓可能從 24V 掉到 22V步進(jìn)驅(qū)動(dòng)芯片的限流點(diǎn)會(huì)跟著下降力矩不足就丟步。我處理過(guò)一次換了一個(gè)功率更足的電源適配器問(wèn)題直接消失。后來(lái)我在 VM 引腳附近加了一顆大容量?jī)?chǔ)能電容抗瞬間跌落的能力好了很多。再補(bǔ)一個(gè)細(xì)節(jié)STEP 信號(hào)線(xiàn)上如果走線(xiàn)太長(zhǎng)建議串聯(lián)一個(gè) 100Ω 左右的小電阻同時(shí)在 STEP 引腳對(duì)地加一個(gè)小電容濾掉振鈴。如果脈沖沿有毛刺DRV8818 可能在一個(gè)脈沖周期內(nèi)誤觸發(fā)多次位置瞬間偏掉好幾個(gè)步距角。5.5 常見(jiàn)問(wèn)題速查表問(wèn)題現(xiàn)象可能原因排查與解決上電電機(jī)無(wú)力nSLEEP 引腳電平錯(cuò)誤上電初始化時(shí)拉高 SLEEP電機(jī)抖動(dòng)但不動(dòng)電流限幅太小調(diào)高 VREF確認(rèn) R_sense 阻值電機(jī)嘯叫明顯衰減模式不對(duì)或細(xì)分過(guò)低調(diào)成混合衰減提高細(xì)分運(yùn)行一段時(shí)間停機(jī)芯片過(guò)熱保護(hù)降保持電流優(yōu)化散熱焊盤(pán)高速時(shí)丟步加速曲線(xiàn)過(guò)陡或電源跌落用 S 型曲線(xiàn)、加大儲(chǔ)能電容STEP 脈沖被漏掉脈寬過(guò)窄或信號(hào)振鈴用 50% 占空比方波加 RC 濾波6. 最后分享一些我踩過(guò)的小坑這套系統(tǒng)調(diào)試到最后最大的體會(huì)就是步進(jìn)電機(jī)控制難的不是原理而是把所有看似不起眼的細(xì)節(jié)都管住。DRV8818 和 PIC18LF47K42 的組合既不像專(zhuān)用運(yùn)動(dòng)控制芯片那樣黑盒也不像完全用分立器件搭 H 橋那樣費(fèi)勁是一個(gè)比較理想的折中。只要電流限制、衰減模式、STEP 脈沖質(zhì)量和加減速曲線(xiàn)這四個(gè)維度都控制好工業(yè)定位和機(jī)器人關(guān)節(jié)應(yīng)用都能跑得很穩(wěn)。最后再分享一個(gè)小技巧電機(jī)和驅(qū)動(dòng)器之間最好用短而粗的線(xiàn)直接連接不要用細(xì)長(zhǎng)線(xiàn)更不要用那種帶接插口的“延長(zhǎng)線(xiàn)”到處飛來(lái)飛去。雙極步進(jìn)電機(jī)相電流在換相瞬間變化率很高線(xiàn)纜的電感會(huì)造成很大的尖峰幾十伏的尖峰很容易把 VM 電容充爆甚至灌到邏輯電路里。我后來(lái)給電機(jī)線(xiàn)加了磁環(huán)尖峰明顯小了很多板子也安靜了不少。希望在調(diào)試步進(jìn)電機(jī)的各位能少走兩條彎路。