基于ACRl505型運動控制卡實現(xiàn)自動封裝運動控制系統(tǒng)的設計

1、引言

在現(xiàn)代化工業(yè)加工及自動化生產(chǎn)線上經(jīng)常要使用諸如加工中心、機器人之類的需要進行多軸協(xié)同控制的自動化設備。對于這些設備，一種比較常見的控制方式是采用“計算機+運動控制卡+驅(qū)動器”的方法，即通過計算機軟件控制專用運動控制卡來控制驅(qū)動器，達到控制自動化設備的目的。其中，3坐標運動控制是多軸協(xié)同控制中最常見且能完成絕大多數(shù)任務要求的一種形式。本文介紹．PARKER公司的ACRl505型運動控制卡的特點及其應用。

2、自動封裝系統(tǒng)

2．1 機械系統(tǒng)

自動封裝系統(tǒng)的任務是首先抓取蓋片A，接著在蓋片A正面上涂膠，然后反轉(zhuǎn)180°下移動，壓到基片上，完成封裝過程。

自動封裝系統(tǒng)主要由移動大平臺、自動涂膠機構(gòu)、自動布貼機構(gòu)、控制系統(tǒng)4部分組成。系統(tǒng)的主體結(jié)構(gòu)設計采用了3自由度的橋架式機器人，數(shù)字控制器作為控制系統(tǒng)的核心，實時控制X、Y、Z軸的運動，同時通過輸出開關量控制電磁閥的開啟與關閉，完成抓取、反轉(zhuǎn)、滴膠、加壓的整個封裝過程。

自動封裝系統(tǒng)的控制系統(tǒng)工作流程如下：

（1）在移動平臺一端設有“定位槽”，控制X導軌先使“翻轉(zhuǎn)定位槽”裝置移動到平板最外端，然后將蓋片A背面向上放到“定位槽”內(nèi)，該定位槽內(nèi)每個對應單元格的位置上有真空吸孔，通過控制真空閥實現(xiàn)蓋片A的吸附固定。

（2）抓取蓋片A固定后，控制x導軌運動，將“翻轉(zhuǎn)定位槽”定位在平板待封裝基片B的正上方，采用真空吸盤吸附方式將基片A抓取槽翻轉(zhuǎn)180°，使基片A的背面正對布貼位置，并處于等待滴膠狀態(tài)。

（3）自動滴膠系統(tǒng)由1個3自由度直角坐標機器人控制“翻轉(zhuǎn)定位槽”帶動一排針頭將膠滴到固定好的蓋片A的正面上。

（4）通過節(jié)流閥控制氣缸使“翻轉(zhuǎn)定位槽”緩慢向下運動，使蓋片A與基片B保持一定的接觸壓力與接觸時間，同時控制噴嘴的電磁閥打開并對蓋片A均勻地施加設定的壓力。

（5）停止抽真空。

（6）布貼完成后，進行下一組蓋片的定位放置，以此類推。

2．2 運動控制系統(tǒng)

結(jié)合自動布貼系統(tǒng)的特點，選用“PC+運動控制器+伺服電機”的運動控制形式，功能結(jié)構(gòu)框圖如圖1所示。運動控制器利用高性能微處理器（以DSP為主）及復雜可編程邏輯器件（CPLD）實現(xiàn)多個伺服電機的多軸協(xié)調(diào)控制，具體就是將實現(xiàn)運動控制的底層軟件和硬件集成在一起，使其具有伺服電機控制所需的各種速度和位置控制功能，這些功能可通過計算機方便地調(diào)用。計算機的主要功能是根據(jù)具體裝置的運動控制類型優(yōu)化指令形式，它屬于上層控制。伺服電機及其驅(qū)動器是主要的執(zhí)行部件，具體完成運動控制。運動控制卡根據(jù)上層計算機給出的指令，結(jié)合具體的伺服系統(tǒng)類型，將其指令轉(zhuǎn)化為伺服電機的運動。

基于ACRl505型運動控制卡實現(xiàn)自動封裝運動控制系統(tǒng)的設計

3 、系統(tǒng)硬件設計與實現(xiàn)

由于DSP具有高達數(shù)10MHz的數(shù)據(jù)吞吐能力和短至幾十ns的指令周期，非常適合于大量數(shù)據(jù)的高速數(shù)據(jù)采集系統(tǒng)和實時控制系統(tǒng)。采用基于DSP的運動控制器與PC一起構(gòu)成控制系統(tǒng)，它可以將Windows強大的圖形用戶接口、多任務能力、強大的硬件和軟件兼容能力與基于DSP的運動控制器的伺服、插補和實時計算能力結(jié)合在一起，為用戶提供高速、高精度和低成本的現(xiàn)代化控制。

3．1系統(tǒng)組成

基于DSP的ACR1505型多軸運動控制卡使用120MHz、32字節(jié)浮點TMS320VC33型DSP作為CPU，提供了全新的高性能技術和Windows平臺。它是高性能伺服運動控制器，通過靈活的高級語言能同時控制1-4個軸（最多可擴展到8個軸），既可單步執(zhí)行程序，也可執(zhí)行存儲于控制器內(nèi)部的運動程序和PLC程序，還可以進行伺服環(huán)更新及以串口、并口、總線3種方式與上位機和多個控制卡進行通信?？刂葡到y(tǒng)的硬件結(jié)構(gòu)如圖2所示。

核心DSP主要完成位置和速度的PID控制、插補迭代運算、開關量輸入，輸出PLC控制等實時性要求高的任務，以及程序和數(shù)據(jù)存儲及上下位機的通信。采用復雜可編程邏輯器件（CPLD）來進行外設的尋址和最終信號的輸出。由于其極短的傳輸延遲、大量的用戶可用I／O口、內(nèi)部連線和可編程資源較為豐富，因而可以實現(xiàn)復雜的時序和組合邏輯，能大大簡化系統(tǒng)的硬件設計。同時由于其不可讀，與DSP配合使用具有較好的軟件保密性能，并且編程簡單方便，通過修改CPLD的軟件程序而不改變硬件就能方便實現(xiàn)系統(tǒng)的升級。模擬量控制電路將速度信號數(shù)字量用D／A轉(zhuǎn)換器轉(zhuǎn)換成一10V~+10V的模擬信號，輸出接模擬信號輸入的電機伺服驅(qū)動模塊。反饋電路是由CPLD構(gòu)成的4路12位可逆脈沖計數(shù)器，接收差分光電編碼器信號，對編碼脈沖進行循環(huán)計數(shù)。通信電路通過PCI接口器件與PC的PCI總線相連，實現(xiàn)高速數(shù)據(jù)傳輸。

系統(tǒng)的工作過程如下：電機反饋信號取白與電機同軸的光電編碼器產(chǎn)生的A相和z相脈沖，經(jīng)由CPLD構(gòu)成的正交脈沖計數(shù)器循環(huán)記錄脈沖數(shù)。DSP定時讀取計數(shù)器的計數(shù)值，計算各電機的當前速度和位置，并通過由插補程序計算出的進給指令計算電機跟蹤的誤差，通過增量式PID算法求出發(fā)給電機的控制信號，輸出到DAC，經(jīng)驅(qū)動器驅(qū)動伺服電機。在控制運算間隙，DSP完成和上位機的通信，取得指令，并將電機的狀態(tài)信息反饋給上位機。

3．2 控制算法

運動控制卡的控制采用增量式PID的控制算法。經(jīng)典的PID控制表達式為

4．1“PC+運動控制器”運動控制軟件的特點

針對運動控制卡開發(fā)的運動控制軟件在PC上運行，它由底層運動控制軟件和用戶操作界面組成。底層運動控制軟件告訴運動控制器進行直線和圓弧等插補運動所需的所有參數(shù)及對I／O口進行操作，同時接收運動控制卡上返回的運動狀態(tài)及輸入口狀態(tài)等參數(shù)。

運動控制卡按接收到的指令自行控制伺服電機進行插補運動及對I/O口進行操作。

用戶操作界面把操作員與底層運動控制軟件連接起來，輸入所有運動參數(shù)，控制運動過程及顯示各種運動狀態(tài)等。

4．2 軟件的設計與實現(xiàn)

軟件開發(fā)的重點是控制卡與PC的通信以及上層系統(tǒng)操作調(diào)度管理軟件的編制和故障診斷、參數(shù)輸入、程序編輯等非高實時性的任務功能的實現(xiàn)。由于控制卡提供了極其有效的開放軟件包ACR-View和API函數(shù)，與控制卡通信和交換信息只需調(diào)用動態(tài)鏈接庫acrownt．dll里面包含的函數(shù)庫里的相應功能函數(shù)或使用其提供的各種事件和方法，所以省去了繁重的通信驅(qū)動程序的開發(fā)，不必直接與控制卡硬件打交道，用Visual Basic語言即可方便的實現(xiàn)控制系統(tǒng)的操作。

在Windows操作系統(tǒng)下，以Visual Basic6.0為開發(fā)工具，采用面向?qū)ο蟮木幊谭椒?，充分利用控制卡配套的動態(tài)鏈接庫中的函數(shù)，開發(fā)伺服控制系統(tǒng)軟件，實現(xiàn)了控制系統(tǒng)的基本功能?？蓪崿F(xiàn)的具體功能包括windows友好人機接口界面、系統(tǒng)初始化預處理、狀態(tài)監(jiān)控、坐標位置和轉(zhuǎn)速的實時顯示、系統(tǒng)動態(tài)參數(shù)化配置等。

軟件程序?qū)崿F(xiàn)對電機位置的信號采集，對電機速度信號進行PID算法控制，對多軸進行插補運算，對被控對象的各種傳感器信號和控制開關等多個開關量進行控制和監(jiān)測，對DSP內(nèi)部存儲器中的加工程序進行管理。可以從上位機接收單獨的動作指令，并對上位機進行實時信息反饋，實現(xiàn)在自動和手動等多模式下運作。系統(tǒng)的初始化在ACR-View設置的過程中完成，主要進行控制卡參數(shù)的設置。系統(tǒng)的運行有許多狀態(tài)需要實時監(jiān)控，這里利用timer定時器控件，在程序運行時，計時器控件每隔一定時間間隔產(chǎn)生一次Timer事件，周期性的控制某些操作。控制器提供可擦寫存儲器來存儲用戶常用的參數(shù)、變量及數(shù)組，因此在進行調(diào)試工作之前必須對一些固定不變的參數(shù)進行設定，并且保存在可擦寫存儲器中。這些參數(shù)包括電機類型設定、編碼器反饋方式、極限位置設定和扭矩極限設定等，參數(shù)設置界面如圖3所示。設定這些參數(shù)的目的是確保系統(tǒng)不會出現(xiàn)飛車情況或者在出現(xiàn)異常情況的時候能夠保護系統(tǒng)。對于一些常常變化的參數(shù)，如PID參數(shù)、行程開關極性、電機轉(zhuǎn)動極性等，可以在調(diào)試過程中不斷進行設置來達到最佳的控制效果。