1 引言

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

2 自動封裝系統

2．1 機械系統

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

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

自動封裝系統的控制系統工作流程如下：

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

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

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

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

(5)停止抽真空。

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

2．2 運動控制系統

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

3 系統硬件設計與實現

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

3．1系統組成

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

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

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

3．2 控制算法

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

其中，uk（t）為輸出函數，kP為比例系數，Ti為積分時間常數，Td為微分時間常數，e（t）為給定量和輸出量的偏差。

對(1)式進行數字化離散處理后，可得到增量式PID算式：

式中，△ui為增量輸出，T為采樣周期，ei為當前的差值，ei-1為ei前一次的差值，ei-2為ei-1前一次的差值。

4 軟件設計

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

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

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

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