核心軟件層：面向機器人的軌跡控制與I/O邏輯控制的程序集合，如回零點、連續(xù)運行、單軸調(diào)整、軌跡曲線選擇、系統(tǒng)自檢等。該層軟件一方面負責(zé)完成機器人各關(guān)節(jié)驅(qū)動電機的精確同步運動控制，實現(xiàn)末端執(zhí)行器在操作空間中的精確軌跡；另一方面，該層軟件還需要完成一組通用I/O的輸入輸出控制，實現(xiàn)對機構(gòu)運動的過程控制以及對外圍設(shè)備的協(xié)調(diào)控制等，以適應(yīng)復(fù)雜的控制任務(wù)需要。

驅(qū)動軟件層：驅(qū)動軟件是實現(xiàn)單軸與多軸運動控制、D/A轉(zhuǎn)換和硬件I/O控制的函數(shù)集合，包括軸配置、運動類型設(shè)置、電機運行和停止等操作函數(shù)。該層軟件主要進行運動軸參數(shù)設(shè)置、電機加減速控制、起停控制、D/A轉(zhuǎn)換和運動I/O的設(shè)置與控制等。該層的函數(shù)主要是控制板卡所帶有的底層功能模塊，可以用這些函數(shù)很方便的根據(jù)自己設(shè)定的控制方案編程實現(xiàn)上一級的核心控制軟件層。LabVIEW 圖形化語言和LabVIEW RT、Control Design and Simulation Bundle、Labview System identification toolkit, motion assistant等相關(guān)的NI工具包開發(fā)應(yīng)用程序不但使得軟件程序的開發(fā)效率大大提高，而且使得軟件的功能齊全、人機界面友好。

系統(tǒng)整體特性與實驗

本方案是并聯(lián)機器人控制系統(tǒng)設(shè)計領(lǐng)域中一種新型的系統(tǒng)組建方法，其出發(fā)點和落腳點是縮短開發(fā)周期、降低系統(tǒng)造價、提高系統(tǒng)特性、完善系統(tǒng)功能。基于LabVIEW和PXI平臺的6-DOF并聯(lián)機器人開放式數(shù)字控制系統(tǒng)不需要從最低層進行開發(fā)，只需對各個模塊進行配置并編寫出用戶需要的特定功能程序即可，與以往的機器人控制系統(tǒng)的開發(fā)相比，不僅大大縮短了開發(fā)周期，而且系統(tǒng)的升級和維護也非常方便，在這個意義上來說此系統(tǒng)是性價比最高的。系統(tǒng)特性方面的優(yōu)勢主要體現(xiàn)在穩(wěn)定性、快速性和精確性上，25KHz—25.6MHz的編碼器反饋信號濾波范圍使得系統(tǒng)能夠在強電干擾的工業(yè)現(xiàn)場的穩(wěn)定工作，6軸PID控制周期可以達到250μs使得實時性遠遠高于一般控制控制系統(tǒng)1ms的要求，機器人六軸協(xié)調(diào)運動后的末端執(zhí)行器穩(wěn)態(tài)誤差可達1μm體現(xiàn)了系統(tǒng)精確的特性。下圖列出了幾個典型的模塊說明了系統(tǒng)的一些技術(shù)特點和成熟的功能。圖3是點動運行模塊，該模塊不僅具有6個軸中每軸的單軸點動，而且根據(jù)機器人的構(gòu)型特點和運動需求設(shè)置了任何兩軸的雙軸點動；該模塊可以根據(jù)用戶不同的運動需求設(shè)置點動步長、速度、加減速的基數(shù)值及其倍率；該模塊能夠?qū)崟r顯示運動的位置和運動完成狀態(tài)，圖示顯示了軸1經(jīng)過幾個單軸點動完成后的狀態(tài)。圖4為軌跡跟蹤模塊，該模塊不僅設(shè)置了預(yù)定軌跡的跟蹤也具有軌跡規(guī)劃的功能，并且能夠同時顯示六個軸的運行情況，圖示為反映x向兩軸同步運行的狀態(tài)。圖5為速度PID控制器加入前后同一余弦波的位置曲線運動所表現(xiàn)出的不同速度曲線特性，可見雙PID控制器能夠很大程度上改善其運動特性。圖6為并聯(lián)機器人整體系統(tǒng)。限于篇幅，此用于染色體切割裝置的宏動并聯(lián)機器人數(shù)控系統(tǒng)的其他特性不再一一贅述。

總結(jié)

本文課題內(nèi)容涉及虛擬儀器技術(shù)、運動控制技術(shù)、機器人技術(shù)以及諸多LabVIEW編程技巧，建立并完善了基于LabVIEW和PXI開發(fā)平臺的“六自由度并聯(lián)機器人控制系統(tǒng)”，本系統(tǒng)具有高可靠性、高精度、高運算速度、高智能化、友好的人機交互能力等特點。獨立開展了一系列運動控制研究與應(yīng)用軟件編制工作，本系統(tǒng)主要特點如下：

（1）將虛擬儀器拓展到并聯(lián)機器人的自動控制領(lǐng)域，充分利用LabVIEW 圖形化語言和LabVIEW RT, control design and Simulation Bundle、LabVIEW System identification Toolkit、Motion Assistant等相關(guān)的NI工具包開發(fā)應(yīng)用程序，構(gòu)成了一種基于模型的開放式運動控制系統(tǒng)，不但使系統(tǒng)具有極好的人機交互性、直觀性和齊全的功能，而且縮短了開發(fā)周期，降低了開發(fā)成本和硬件成本，為機器人走向社會奠定了基礎(chǔ)。


（2）充分利用PXI-7356多軸運動控制卡的相關(guān)軟件函數(shù)和模塊，開發(fā)了高精度的并聯(lián)機器人的多電機協(xié)調(diào)控制和雙電機同步控制。

（3）采用了用戶事件技術(shù)、通知或隊列技術(shù)LabVIEW的高級編程技術(shù)，解決了各用戶界面和各模塊之間的實時切換；采用各種變量實現(xiàn)不同模塊之間和相同模塊內(nèi)部的信息傳遞和共享；采用了VI的動態(tài)載入技術(shù)，實現(xiàn)了子VI的即調(diào)即用和多面板的動態(tài)載入及界面重用。

（4）充分利用LabVIEW強大的外部接口能力，實現(xiàn)了動態(tài)鏈接庫（DLL）和Windows API的調(diào)用，并嵌入了Matlab并聯(lián)機器人運動控制程序，使程序不但具有Windows系統(tǒng)的拷貝、打印等功能，也使得復(fù)雜的計算更為快捷。