在機(jī)器人控制器的設(shè)計(jì)中,如何最大程度的提高機(jī)器人控制的實(shí)時(shí)性是一個(gè)關(guān)鍵問題。這里我們運(yùn)用了將軟件任務(wù)劃分實(shí)時(shí)域與非實(shí)時(shí)域的思想,實(shí)現(xiàn)了一種將RT-Linux與Linux結(jié)合的實(shí)時(shí)機(jī)器人控制系統(tǒng)。該系統(tǒng)的優(yōu)點(diǎn)是:提供了非常高效的滿足底層硬件設(shè)備的實(shí)時(shí)性能,可以充分利用 Linux的強(qiáng)大功能;而且RT-Linux是完全開放源代碼的免費(fèi)軟件,降低了開發(fā)成本。
1 RT-Linux的系統(tǒng)結(jié)構(gòu)
RT-Linux的基本思想就是使Linux運(yùn)行在實(shí)時(shí)核心之下,如圖1所示。RT—Linux是一個(gè)可加載的核心模塊。一個(gè)小的RT-Linux實(shí)時(shí)內(nèi)核同原來的Linux內(nèi)核共同控制處理器。實(shí)時(shí)內(nèi)核直接管理硬件中斷,因此實(shí)時(shí)內(nèi)核操縱著機(jī)器的響應(yīng)時(shí)間,原來的Linux就無法影響實(shí)時(shí)任務(wù)了。在RT- Linux中設(shè)計(jì)了兩類中斷。軟中斷是正常的Linux中斷,硬中斷則是真正的實(shí)時(shí)中斷,執(zhí)行時(shí)幾乎沒有任何延遲。實(shí)現(xiàn)時(shí),RT-Linux是通過在 Linux核心和中斷處理器之間設(shè)計(jì)一個(gè)仿真軟件來達(dá)到其目的的。
在RT-Linux中采用兩種調(diào)度策略。一種是基于優(yōu)先級(jí)的搶占式調(diào)度算法;另一種是lsmaelRipoll實(shí)現(xiàn)的 EDF(EarliestDeadlineFirst)算法。對(duì)于周期性任務(wù)可以采用單調(diào)率調(diào)度算法,即周期短的任務(wù)能夠獲得較高的優(yōu)先級(jí)。調(diào)度策略將 Linux視為賦予最低優(yōu)先級(jí)的實(shí)時(shí)任務(wù)。
Linux僅僅在實(shí)時(shí)系統(tǒng)沒有其它任務(wù)時(shí)運(yùn)行。Linux和實(shí)時(shí)任務(wù)之間的轉(zhuǎn)換依據(jù)上述提及的軟中斷狀態(tài)而定。RT-Linux通過這樣一種設(shè)計(jì)方法,將標(biāo)準(zhǔn)的Linux核心改成一個(gè)可搶占的、具有低延遲中斷處理的實(shí)時(shí)系統(tǒng)。
2 實(shí)時(shí)機(jī)器人控制系統(tǒng)的軟/硬件結(jié)構(gòu)
2.1硬件系統(tǒng)結(jié)構(gòu)
整個(gè)實(shí)時(shí)機(jī)器人控制系統(tǒng)主要的硬件部件為:與IBM—PC兼容PentiumIII733MHzq-業(yè)控制微機(jī)(IPC),內(nèi)存l28MB;三軸位置控制卡(PCL一832);l0/100M自適應(yīng)網(wǎng)卡、集線器等以太網(wǎng)連接設(shè)備;機(jī)器人本體為具有5個(gè)自由度的日產(chǎn)PT500機(jī)器人。
機(jī)器人控制器運(yùn)行于一臺(tái)工業(yè)控制微型計(jì)算機(jī)(IPC)上。在該IPC上安裝了兩塊三軸位置控制卡。每塊三軸位置控制卡能對(duì)三軸進(jìn)行聯(lián)動(dòng)插補(bǔ)控制。每軸有專用位置芯片控制,構(gòu)成一個(gè)伺服位置和速度環(huán)。放在DDA脈沖緩沖器中的脈沖數(shù)被傳到DDA發(fā)生器,在下一個(gè)DDA周期中輸出。然后由三軸位置控制卡將各軸對(duì)應(yīng)的脈沖數(shù)解釋為相應(yīng)的電平信號(hào),驅(qū)動(dòng)伺服驅(qū)動(dòng)器以驅(qū)動(dòng)機(jī)器人本體的運(yùn)動(dòng)。
2.2軟件系統(tǒng)結(jié)構(gòu)
整個(gè)機(jī)器人實(shí)時(shí)控制器的系統(tǒng)結(jié)構(gòu)如圖2所示,整個(gè)系統(tǒng)分為2個(gè)域:實(shí)時(shí)域和非實(shí)時(shí)域。實(shí)時(shí)域中實(shí)現(xiàn)的是實(shí)時(shí)設(shè)備驅(qū)動(dòng)程序,負(fù)責(zé)PCL-832位置控制卡的控制與中斷響應(yīng),驅(qū)動(dòng)機(jī)器人本體運(yùn)動(dòng);非實(shí)時(shí)域中實(shí)現(xiàn)的是上層的機(jī)器人控制界面和遠(yuǎn)程監(jiān)控子系統(tǒng);二者之問通過實(shí)時(shí)先進(jìn)先出(RT-FIFO)緩沖隊(duì)列進(jìn)行數(shù)據(jù)交換。內(nèi)核調(diào)度策略將Linux視為賦予最低優(yōu)先級(jí)的實(shí)時(shí)任務(wù),Linux中的非實(shí)時(shí)任務(wù)僅僅在實(shí)時(shí)系統(tǒng)沒有其它任務(wù)時(shí)運(yùn)行,以確保實(shí)時(shí)任務(wù)的最高實(shí)時(shí)優(yōu)先級(jí)。
(1)RT-Linux中的實(shí)時(shí)模塊
實(shí)時(shí)域中的軟件模塊主要是三軸位置控制卡(PCL一832)的設(shè)備驅(qū)動(dòng)程序。驅(qū)動(dòng)程序是能夠直接訪問硬件的模塊,具有應(yīng)用程序不具備的處理中斷和讀寫端口的能力,是嵌入操作系統(tǒng)核心的底層軟件。三軸位置控制卡以毫秒級(jí)發(fā)出DDA中斷請(qǐng)求,對(duì)DDA中斷的響應(yīng)的快慢是決定整個(gè)機(jī)器人控制器實(shí)時(shí)性能的關(guān)鍵指標(biāo)。RT-Linux中的三軸位置控制卡的實(shí)時(shí)設(shè)備驅(qū)動(dòng)程序必須處理以下事務(wù):
① 響應(yīng)三軸位置卡的插補(bǔ)周期中斷(DDA),并輸出位置脈沖數(shù)值;
② 響應(yīng)三軸位置卡的誤差溢出中斷(Ov),通知應(yīng)用程序進(jìn)行相應(yīng)處理;
③ 為應(yīng)用程序提供服務(wù),如讀寫I/O端口、設(shè)置參數(shù)、讀取狀態(tài)等。
(2)Linux中的非實(shí)時(shí)模塊
非實(shí)時(shí)域中的軟件模塊由機(jī)器人控制器和遠(yuǎn)程監(jiān)控子系統(tǒng)組成。本地的機(jī)器人控制器負(fù)責(zé)將文本機(jī)器人指令解釋成相應(yīng)的位置脈沖數(shù)據(jù),通過先進(jìn)先出(RT- FIFO)緩沖隊(duì)列發(fā)送給實(shí)時(shí)域中的驅(qū)動(dòng)程序驅(qū)動(dòng)機(jī)器人本體運(yùn)動(dòng)。同時(shí)具有權(quán)限的用戶能夠以離線編程方式或在線操作方式通過高速以太網(wǎng)分別與離線編程與仿真數(shù)據(jù)發(fā)生器和機(jī)器人控制器進(jìn)行連接,實(shí)現(xiàn)離線編程和對(duì)機(jī)器人的實(shí)際控制。
3 實(shí)時(shí)系統(tǒng)的性能評(píng)估
實(shí)時(shí)系統(tǒng)的性能評(píng)估主要在8個(gè)方面進(jìn)行。它們分別是任務(wù)換道性能、任務(wù)優(yōu)先級(jí)性能、內(nèi)存分配性能、任務(wù)內(nèi)部通信性能、中斷延遲時(shí)間、操作系統(tǒng)運(yùn)行時(shí)效率、初始化時(shí)間和關(guān)機(jī)時(shí)間。而在機(jī)器人控制中最講究的就是中斷響應(yīng)時(shí)問。因?yàn)榫捅卷?xiàng)目而言,我們最關(guān)I~,RT-Linux系統(tǒng)對(duì)三軸位置控制卡(PCL一 832)的DDA中斷的響應(yīng)時(shí)間,所有工作的目的就是為了盡量減少中斷響應(yīng)時(shí)間。
3.1測(cè)試環(huán)境及方法
用于測(cè)試的工業(yè)控制微機(jī)的硬件配置為IntelPentium(clockl20MHz),RAM64MB;服務(wù)器軟件是用 RedHatLinux6.0(內(nèi)核版本號(hào)2.2.5一l5),RT-Linux的版本號(hào)2.2;網(wǎng)絡(luò)環(huán)境l0/100M自適應(yīng)網(wǎng)卡。中斷響應(yīng)時(shí)間的快慢直接反映了這樣一個(gè)過程的快慢:在用戶層的用戶進(jìn)程通過系統(tǒng)調(diào)用將脈沖數(shù)據(jù)寫入位于核心層的實(shí)時(shí)驅(qū)動(dòng)程序的數(shù)據(jù)緩沖隊(duì)列,在下一個(gè)DDA中斷請(qǐng)求到來時(shí),中斷服務(wù)例程將數(shù)據(jù)緩沖隊(duì)列中的脈沖數(shù)據(jù)寫入三軸位置控制卡的動(dòng)作控制芯片的緩沖區(qū),驅(qū)動(dòng)機(jī)器人本體運(yùn)行。圖3反映了上述過程。
3.2測(cè)試結(jié)果
分別設(shè)置DDA周期為8、12、16、24ms的4種情況作了測(cè)試,經(jīng)過計(jì)算,可以得出表1所示的結(jié)果。
表1 低負(fù)載下D DA中斷響應(yīng)處理時(shí)問測(cè)試結(jié)果
由此得出,在低負(fù)載下RT-Linux的測(cè)量時(shí)間要比Linux下快0.5—0.6ms左右,證明采用RT—Linux系統(tǒng)確實(shí)能夠提高系統(tǒng)的實(shí)時(shí)性能。需要注意的是:
① RT—Linux直接接受硬件中斷,所以我們將PCL一832卡的DDA中斷和OV中斷安裝在實(shí)時(shí)域中,目的就是讓RT-Linux最先捕獲這兩個(gè)實(shí)時(shí)中斷,進(jìn)行處理。
② 如果用戶應(yīng)用層開辟大量的用戶進(jìn)程,則對(duì)于分時(shí)的標(biāo)準(zhǔn)Linux來說會(huì)受到很大程度的影響。
由測(cè)試結(jié)果可看出,RT-Linux系統(tǒng)中斷響應(yīng)比標(biāo)準(zhǔn)Linux延時(shí)時(shí)間短,這個(gè)結(jié)果也預(yù)示在系統(tǒng)高負(fù)載情況下RT-Linux系統(tǒng)中的實(shí)時(shí)性能的優(yōu)勢(shì)將更為明顯。實(shí)際使用該實(shí)時(shí)機(jī)器人控制器時(shí),機(jī)器人運(yùn)行非常穩(wěn)定,能夠滿足實(shí)時(shí)控制的需要。
-
控制系統(tǒng)
+關(guān)注
關(guān)注
41文章
6662瀏覽量
110891 -
機(jī)器人
+關(guān)注
關(guān)注
211文章
28649瀏覽量
208446 -
Linux
+關(guān)注
關(guān)注
87文章
11345瀏覽量
210420
發(fā)布評(píng)論請(qǐng)先 登錄
相關(guān)推薦
評(píng)論