0 引言

目前的電動輪椅設(shè)計大體可分為兩種：一種是采用前被動輪加后輪驅(qū)動的方式，因為是前被動輪加后驅(qū)動輪的方式，所以回轉(zhuǎn)半徑窄的地方不能使用;另一種是根據(jù)希望前后左右都能夠自由移動的全方向移動方式，該方法是將驅(qū)動輪配在車體中央附近的區(qū)域，這樣可以適應(yīng)一定窄的環(huán)境，但由于車輪和車體之間不能產(chǎn)生相對運動，所以無論在驅(qū)動輪的配置上如何下功夫都不能使回轉(zhuǎn)半徑為零[1]。

針對上述兩種輪椅控制方案的缺點，設(shè)計實現(xiàn)了一種全方向輪椅控制系統(tǒng)。它是以DSP作為控制核心的電動輪椅控制系統(tǒng)，采用單路電動輪PID控制，雙路電動輪速度差協(xié)調(diào)控制方案。給出了主電路結(jié)構(gòu)，通過實際電路實現(xiàn)了設(shè)計方案，最后通過試驗結(jié)果證明了該設(shè)計方案的可行性。

1 系統(tǒng)總體設(shè)計

圖1 所示為電動輪椅控制系統(tǒng)的結(jié)構(gòu)框圖。

主要采用單個DSP 帶兩路無刷直流電機，直接通過DSP 實現(xiàn)對兩路電機的控制，并且將兩路BLDCM當前的位置反饋信號發(fā)送給DSP，DSP 計算采樣所得的反饋信號和位置給定信號，并發(fā)出相應(yīng)的PWM 波，控制三相逆變器，進而控制電機動作。

在系統(tǒng)中兩路BLDCM 對于DSP來說是一個集中的整體，DSP 獲取數(shù)據(jù)并反饋數(shù)據(jù)。在系統(tǒng)中，兩路BLDCM信息的處理有時是相互獨立的，所以具有相對獨立的軟件和硬件系統(tǒng)。另外，各通道的控制性能及效果幾乎一致，所以可以互換而不影響控制性能。

鍵盤和顯示部件都是直接與DSP相連，不存在傳輸過程中的信號干擾問題，同時對于系統(tǒng)所處的各階段都可以直接通過鍵盤控制，并且在顯示部件上直觀反映。

電機的霍爾傳感器將電機轉(zhuǎn)子位置以三路高低電平信號送入DSP 的捕獲單元(CAP)，之后與換相表相比較，以控制三相逆變器功率管的開通、關(guān)斷，使之與轉(zhuǎn)子的位置相匹配。

此外，系統(tǒng)將所采樣的相電壓信號作為功率保護信號經(jīng)電平轉(zhuǎn)換后直接送入DSP的功率保護引腳，當出現(xiàn)低電平時，將觸發(fā)DSP的功率保護中斷，DSP將封鎖對應(yīng)通路的PWM 波。

DSP發(fā)出的PWM 波經(jīng)光耦隔離后送入功率驅(qū)動芯片，進行功率放大后送入三相逆變器功率管的柵、源極之間，以控制功率管的開關(guān)動作。

2 系統(tǒng)控制策略

本設(shè)計主要控制策略包括以下兩個方面。

2.1 單路電機控制策略

如圖2所示，單路電機采用PID 閉環(huán)控制對轉(zhuǎn)速進行調(diào)節(jié)。系統(tǒng)位置閉環(huán)性能直接決定了伺服系統(tǒng)的動、靜態(tài)性能，是系統(tǒng)控制的關(guān)鍵部分。

PID算法具有結(jié)構(gòu)簡單，調(diào)試方便等特點。雖然在調(diào)節(jié)時改變量一定，但由于閉環(huán)產(chǎn)生的頻率很高，所以將改變量設(shè)定為一個較小量時，也能滿足系統(tǒng)的性能要求。在設(shè)定Ki，Kp，Kd 這3個參數(shù)范圍的基礎(chǔ)上，通過對實際電路參數(shù)進行微調(diào)，在基本滿足系統(tǒng)快速性的基礎(chǔ)上同時達到較好的超調(diào)量，從而提高系統(tǒng)穩(wěn)定性。

2.2 雙路電機控制策略

如圖3所示，是設(shè)計含有兩路獨立驅(qū)動的電動輪的控制系統(tǒng)框圖。由于兩個電機是分別安裝在兩個驅(qū)動輪的軸上，所以當兩輪的驅(qū)動裝置內(nèi)部參數(shù)及外界路況不等時，即使兩個電機的輸入一樣，也不能保證兩個驅(qū)動輪的速度相同，這里采用補償系統(tǒng)，來消除系統(tǒng)在運行過程中產(chǎn)生的兩電動輪之間的速度差。

在直線運行中，采用速度差協(xié)調(diào)系統(tǒng)來調(diào)節(jié)兩個電動輪的轉(zhuǎn)速。設(shè)定一主動輪，讓從動輪速度跟隨主動輪，使兩個電動輪速度盡量一致。在轉(zhuǎn)彎時，內(nèi)外側(cè)的電機同時減速，內(nèi)側(cè)電機的減幅遠大于外側(cè)電機的減速幅度。兩電機分別采用自己的參考速度，進行獨立的PID運算，從而保證在路面狀況不是很好的情況下實現(xiàn)輪椅的轉(zhuǎn)彎[2]。

3 系統(tǒng)硬件設(shè)計

根據(jù)電動輪椅功能需求，該設(shè)計主要由一片DSP和兩路BLDCM驅(qū)動電路，以及必要的電平轉(zhuǎn)化電路組成。DSP負責(zé)整個系統(tǒng)的設(shè)計和控制，所有的信號的采集和處理都由DSP完成，并且還產(chǎn)生所需的PWM 信號與故障保護中斷請求。結(jié)合實際情況，設(shè)計中采用TMS320LF2407A 作為控制核心。它包括兩個獨立的事件管理器：每一個都包含兩個16位通用定時器，8個16位脈寬調(diào)制(PWM)輸出通道，三個捕捉單元，DSP主頻為 40MHz[3]。

如圖4 所示，驅(qū)動電路主要通過驅(qū)動芯片IR2130作為核心驅(qū)動。逆變器主體由6 個功率開關(guān)器件組成三相全控橋電路，通過這6 個開關(guān)的關(guān)斷和導(dǎo)通完成BLDCM的驅(qū)動，實現(xiàn)對電機轉(zhuǎn)速和轉(zhuǎn)向的控制。為防止自舉電容兩端電壓放電，二極管應(yīng)選擇高頻恢復(fù)二極管HER107。另一方面為防止自舉電容放電造成其兩端電壓低于欠壓保護動作的門檻電壓值，電容的取值應(yīng)充分的大，本設(shè)計選擇47 滋F電容，耐壓25 V[4]。

4 系統(tǒng)軟件設(shè)計

圖5所示為產(chǎn)生逆變器驅(qū)動信號PWM 波的中斷子程序流程圖。圖6所示為兩路BLDCM 速度協(xié)調(diào)控制中斷子程序流程圖。兩路BLDCM 分別選用T2和T4 作為時基，從而準確捕獲兩次中斷的時間間隔，兩個時鐘都選用連續(xù)增計數(shù)模式。

上一頁 1 2 下一頁