引言：
在過(guò)去的幾十年里，工業(yè)機(jī)器人技術(shù)經(jīng)歷了飛速的發(fā)展。自二十世紀(jì)80年代以來(lái)，它們已經(jīng)從只能以有限精度沿著預(yù)訂軌跡運(yùn)動(dòng)的抓放式機(jī)器人，發(fā)展成具有高精度、可以在手術(shù)室中應(yīng)用，并且靈活適應(yīng)環(huán)境，同時(shí)可經(jīng)常與視覺(jué)系統(tǒng)及生產(chǎn)單元中的其它機(jī)器人進(jìn)行交互的系統(tǒng)。
Author(s):
Jonas Neubert - Imperial College London
Industry:
Research
Products:
CompactRIO, FPGA Module, Real-Time Module
The Challenge:
為已經(jīng)丟失控制器的20歲工業(yè)機(jī)器人替換新的控制器，并對(duì)其進(jìn)行擴(kuò)展，使之具有現(xiàn)代機(jī)器人控制軟件中的典型功能。創(chuàng)建可通過(guò)直觀圖形化用戶界面(GUI)操作的、適于本科生實(shí)驗(yàn)課程的系統(tǒng)。
The Solution:
使用NI CompactRIO控制器作為機(jī)器人驅(qū)動(dòng)器和編碼器與LabVIEW 8.5軟件、 比例-積分-微分(PID)工具箱、3D圖像渲染和VI服務(wù)器間的接口，實(shí)現(xiàn)機(jī)器人運(yùn)動(dòng)軟件，并可以通過(guò)圖形界面進(jìn)行訪問(wèn)。
CompactRIO-9014實(shí)時(shí)控制器
"使用CompactRIO和LabVIEW，我們可以在單個(gè)編程環(huán)境中，從零開(kāi)始構(gòu)建完整的機(jī)器人驅(qū)動(dòng)和控制系統(tǒng)。"
在過(guò)去的幾十年里，工業(yè)機(jī)器人技術(shù)經(jīng)歷了飛速的發(fā)展。自二十世紀(jì)80年代以來(lái)，它們已經(jīng)從只能以有限精度沿著預(yù)訂軌跡運(yùn)動(dòng)的抓放式機(jī)器人，發(fā)展成具有高精度、可以在手術(shù)室中應(yīng)用，并且靈活適應(yīng)環(huán)境，同時(shí)可經(jīng)常與視覺(jué)系統(tǒng)及生產(chǎn)單元中的其它機(jī)器人進(jìn)行交互的系統(tǒng)。這就是我們?cè)诖髮W(xué)的倉(cāng)庫(kù)中發(fā)現(xiàn)20歲的三菱Movemaster機(jī)器人時(shí)，第一反應(yīng)是決定把它送給博物館的原因。但是，一個(gè)教師決定把它交給我 —— 當(dāng)時(shí)我還只是一名帝國(guó)理工學(xué)院的本科生，來(lái)使機(jī)器人“復(fù)活”。
項(xiàng)目目標(biāo)
早先的時(shí)候，三菱Movemaster機(jī)器人配有一個(gè)手持式教學(xué)盒、一個(gè)微波爐大小的驅(qū)動(dòng)單元和一個(gè)可通過(guò)串行接口將所有機(jī)器關(guān)節(jié)所需的角位置傳輸?shù)津?qū)動(dòng)單元的可選計(jì)算機(jī)。但是現(xiàn)在所有外設(shè)都丟失了，所以我們需要修復(fù)機(jī)器人底座上的36根未定義管腳，使其恢復(fù)原有的功能。我們需要替換以前用于從PC機(jī)的可視化用戶界面來(lái)控制機(jī)器人的過(guò)時(shí)的編程語(yǔ)言?？紤]到需要保留可能作為教學(xué)輔助的應(yīng)用，我們需要?jiǎng)?chuàng)建出一種可以允許學(xué)生在未來(lái)進(jìn)行便捷擴(kuò)展的系統(tǒng)（特別是不同的控制算法）。
設(shè)計(jì)選項(xiàng)
在我們?cè)噲D對(duì)機(jī)器人進(jìn)行逆向工程后，我們需要通過(guò)兩個(gè)主要步驟確定系統(tǒng)的總體布局。首先，我們需要開(kāi)發(fā)I/O解決方案驅(qū)動(dòng)機(jī)器人的5個(gè)直流電機(jī)，并同時(shí)讀取編碼器信號(hào)。第二，我們需要將信息傳輸?shù)綐?biāo)準(zhǔn)PC機(jī)上并將其在圖形界面上顯示出來(lái)。
系統(tǒng)所需的通道數(shù)(15路脈寬調(diào)制[PWM]數(shù)字輸出和10路數(shù)字輸入)和采樣速率(PWM為1kHz而輸入采樣速率為100kHz)都沒(méi)有超出標(biāo)準(zhǔn)微控制器電路板的個(gè)性化解決方案的范疇。但是，編程環(huán)境的多樣性和開(kāi)發(fā)這樣系統(tǒng)所面臨的挑戰(zhàn)，超出了本科生項(xiàng)目的時(shí)限和范圍。由于美國(guó)國(guó)家儀器公司的產(chǎn)品，可以提供從數(shù)據(jù)采集到高級(jí)圖形用戶界面開(kāi)發(fā)等全部所需的功能，顯而易見(jiàn)可以作為我們的選擇之一。
我們選擇了CompactRIO可編程自動(dòng)控制器，利用它來(lái)實(shí)時(shí)采集和處理所需數(shù)量的信號(hào)。雖然產(chǎn)品的花費(fèi)超出了典型本科生項(xiàng)目的預(yù)算，但考慮到CompactRIO的全面性和易用性，我們還是選擇了它。我們可以在5分鐘內(nèi)設(shè)定好CompactRIO控制器(包括接線和所有軟件的部署)，而且可以在其他項(xiàng)目中共用這一個(gè)控制器。
信號(hào)I/O
CompactRIO控制器的現(xiàn)場(chǎng)可編程門(mén)陣列(FPGA)背板，能夠以完全并行化的方式讀取、輸出和處理I/O模塊通道。利用數(shù)量充足的可編程門(mén)電路，我們能夠以1kHz的頻率輸出5個(gè)獨(dú)立的PWM信號(hào)，輸出10個(gè)數(shù)字信號(hào)到外部的馬達(dá)驅(qū)動(dòng)芯片，同時(shí)以100kHz頻率對(duì)10條編碼通道進(jìn)行采樣。在FPGA上，我們將每個(gè)機(jī)器人關(guān)節(jié)上的兩個(gè)編碼器上獲得的信號(hào)，顯示成整數(shù)以表示相對(duì)的關(guān)節(jié)角度。使用NI網(wǎng)站上提供的VI幫助我們進(jìn)一步縮短了FPGA上VI的開(kāi)發(fā)時(shí)間。兩個(gè)高速切換的數(shù)字輸出和數(shù)字輸入模塊為我們的應(yīng)用提供了充足的通道數(shù)。
圖形化用戶界面
上述硬件接口的功能一定程度上受到FPGA技術(shù)能力的限制，但是系統(tǒng)的用戶界面在Windows PC上運(yùn)行，可以充分利用LabVIEW 8.5的特性。使用基于事件的界面，用戶可以通過(guò)輸入位置向量或上下、左右和前后增量式移動(dòng)機(jī)器人，來(lái)設(shè)定機(jī)器人終端效應(yīng)器的笛卡爾坐標(biāo)位置和方向。然后進(jìn)行坐標(biāo)變換，計(jì)算出每個(gè)機(jī)器人關(guān)節(jié)所需的關(guān)節(jié)角。這些數(shù)據(jù)會(huì)反饋給控制器子VI，從所需和實(shí)際的關(guān)節(jié)角中計(jì)算出電機(jī)命令信號(hào)。
為了允許學(xué)生們?cè)趯?lái)實(shí)現(xiàn)不同的控制算法，只要模板定義的前面板元件存在，控制器子VI在每次運(yùn)行時(shí)都加載并可以包含任意的邏輯。這非常有用，因?yàn)閷W(xué)生們可能不能使用LabVIEW環(huán)境下的所有功能，而只能使用缺少LabVIEW FPGA和LabVIEW Real-Time Module的學(xué)生版本。雖然學(xué)生版軟件不能打開(kāi)全部的機(jī)器人軟件，但學(xué)生們?nèi)匀豢梢允褂盟_(kāi)發(fā)機(jī)器人控制器，并在機(jī)器人上進(jìn)行測(cè)試。
我們的“老”機(jī)器人的可靠性是整個(gè)項(xiàng)目中的一個(gè)問(wèn)題，我們需要一個(gè)機(jī)器人仿真以便我們?cè)跈C(jī)器人維修時(shí)繼續(xù)工作。使用LabVIEW 3D圖像控制，我們創(chuàng)建了機(jī)器人的示意原理圖。使用圖形化用戶界面，用戶可以得知軟件是否精確表示了當(dāng)前機(jī)器人的位置。當(dāng)可視化與現(xiàn)實(shí)不符合時(shí)，用戶可將機(jī)器人送到啟動(dòng)原點(diǎn)，并按下按鈕重新啟動(dòng)軟件。
結(jié)論
使用CompactRIO和LabVIEW，我們可以在同一個(gè)編程環(huán)境中，從零開(kāi)始構(gòu)建完整的機(jī)器人驅(qū)動(dòng)和控制系統(tǒng)。借助于CompactRIO控制器的易用性，使用高科技的FPGA技術(shù)來(lái)喚醒我們的“古董”機(jī)器人簡(jiǎn)直輕而易舉。作為本科生的我，利用不到九個(gè)月的兼職項(xiàng)目工作，就開(kāi)發(fā)出了包括軟件和硬件的整個(gè)系統(tǒng)。
致謝
我在醫(yī)藥機(jī)電一體化實(shí)驗(yàn)室中完成了這個(gè)項(xiàng)目，指導(dǎo)者是Ferdinando Rodriguez y Baena博士。該項(xiàng)目是在Christopher Burton已有工作的基礎(chǔ)上進(jìn)行的。
Author Information:
Jonas Neubert
Imperial College London
South Kensington Campus
London SW7 2AZ
（轉(zhuǎn)載）
