ZMP控制卡在多軸控制系統(tǒng)中的應(yīng)用

沈振興

(北京慧摩森電機系統(tǒng)技術(shù)有限公司，北京)

1 多軸運動執(zhí)行機構(gòu)

本文介紹的多軸平臺為雙驅(qū)龍門式結(jié)構(gòu)，采用先進的直線電機驅(qū)動技術(shù)，使用MicroE高精度光柵尺反饋做閉環(huán)控制，光柵尺分辨率50 nm。保證高的運行速度以及良好的定位精度。驅(qū)動器采用科爾摩根AKD伺服驅(qū)動器。可通過SynqNet總線和運動控制卡通信。選用高性能的基于SynqNet總線技術(shù)的ZMP運動控制卡控制。運動控制卡系統(tǒng)自帶相關(guān)應(yīng)用軟件，包括Motion Console，Motion Scope其具有簡單的下載方式以及操作界面。用戶可以用Motion Scape進行基本的PID調(diào)節(jié)操作也可以通過轉(zhuǎn)換固件版本的方式使用Mechaware中功能函數(shù)修改合適的PID參數(shù)進行調(diào)節(jié)。ZMP卡的高級功能，也是用戶最希望的就是用戶可以使用Mechaware提供的功能函數(shù)在MatLab中進行伺服算法仿真和開發(fā)。多軸平臺見圖1所示。

2 ZMP控制卡

ZMP-SynqNet-PCI運動控制卡采用實時64位雙精度浮點Motorola PowerPC微處理器，CPU 466 MHz、16 MB 133 MHz SDRAM，強大的處理能力和運算速度，使理論上處理4個伺服軸時節(jié)點伺服刷新率高達48 kHz，處理12個伺服軸時節(jié)點伺服刷新率高達16 kHz?？梢匝杆俳⑷魏蜗到y(tǒng)的模型，并通過SynqNet控制器加以實現(xiàn)：多種濾波器、狀態(tài)觀察器、狀態(tài)反饋、坐標(biāo)轉(zhuǎn)換、使用ZMP的64位雙精度計算、復(fù)雜傳動跟隨方法、增益切換、振動控制、復(fù)雜多入多出的工廠模型、易于定義的臺架控制拓撲結(jié)構(gòu)，以及可以設(shè)計自定義控制方案等強大功能。

3 SYNQNET總線技術(shù)

SynqNet是 Motion Engineering Inc(MEI)公司設(shè)計的一個架構(gòu)在100Base-T物理層的運動控制網(wǎng)絡(luò)。此網(wǎng)絡(luò)代替標(biāo)準(zhǔn)的±10 V模擬量接口，從而能在復(fù)雜的環(huán)境中顯示其優(yōu)勢。其中ZMP控制卡安裝接線非常簡單，只需要將帶屏蔽的網(wǎng)線與驅(qū)動器通過SynqNet總線相連。從而實現(xiàn)控制功能。支持多達32個協(xié)調(diào)軸，實現(xiàn)多軸協(xié)調(diào)控制，針對噪聲抗擾度和電纜短路的電氣隔離、冗余自恢復(fù)的容錯網(wǎng)絡(luò)，自動網(wǎng)絡(luò)組態(tài)和完整性檢驗，確保網(wǎng)絡(luò)的可靠性。見圖2所示。

圖2 電機在SynqNet網(wǎng)絡(luò)中的應(yīng)用

通過SynqNet網(wǎng)絡(luò)，一個網(wǎng)絡(luò)下的所有節(jié)點可以通過每個伺服周期內(nèi)發(fā)送的同步幀來統(tǒng)一每個節(jié)點的時鐘信號以達到所有節(jié)點的同步控制，在每個伺服周期的開始控制器會先以廣播的方式向網(wǎng)絡(luò)中所有的節(jié)點發(fā)送一個同步幀SynqNet packet，然后以流的方式將命令幀Demand packet以及控制幀Control packet依次送達到每個節(jié)點，并且將各個節(jié)點的反饋信息Feedback packet與狀態(tài)信息Status packet帶回。同步幀用于統(tǒng)一校準(zhǔn)所有節(jié)點的時鐘，命令幀包含經(jīng)過DA轉(zhuǎn)換的模擬量軌跡數(shù)據(jù)也就是把脈沖量轉(zhuǎn)換過來的電流值，命令幀的值是否執(zhí)行要看控制幀，控制幀中包含了所有的控制信息。也就是說在每個伺服周期內(nèi)都會發(fā)送依次含有這三個幀的數(shù)據(jù)包給每個節(jié)點，這樣就可以保證一個網(wǎng)絡(luò)下節(jié)點的同步誤差在一個伺服周期內(nèi)。

4 MechaWare

MechaWare軟件工具實現(xiàn)和MATLAB?/Simulink的協(xié)同工作，系統(tǒng)操作美觀、直接、方便，這里以簡單的PID設(shè)置為例進行說明，PID與復(fù)位塊組成一個比例、積分和導(dǎo)數(shù)(PID)濾波器。經(jīng)過濾波器濾波之后輸出給執(zhí)行機構(gòu)的模塊。此系統(tǒng)最大的優(yōu)點是：在一些分析工具中，采取補償?shù)姆绞絹砀倪M機械性能，如采用精確建模和非線性擾動的軟件算法來實現(xiàn)。然而在很多實例中，不能精確地反饋出設(shè)備位置，溫度摩擦等引起的變化效果，而這些導(dǎo)致系統(tǒng)共振，引起偏差并表現(xiàn)在運動上，利用Mechaware的Matlab/Simulink編程，可以輕松地實現(xiàn)高級系統(tǒng)的建模和仿真。見圖3。

圖3 PID模型

這里的PID與復(fù)位塊被使用后過濾。這個塊提供了一個簡單的接口添加到你的控制回路的PID參數(shù)。上面的傳遞函數(shù)被封裝到模塊中，見圖4。

可以通過C語言設(shè)置簡單的

其主要優(yōu)點是將復(fù)雜的傳遞函數(shù)用簡單的模塊化形式表示出來，可以方便地改變其參數(shù)，根據(jù)PID的算術(shù)公式進行Simulink拼接，經(jīng)搭好的輸入輸出塊封裝完成更加簡練的PID參數(shù)設(shè)置，模塊更是和C語言形成一對一的設(shè)置，達到與C語言有效的結(jié)合目的。

將封裝好的塊應(yīng)用到整個控制系統(tǒng)回路中，避免了控制程序冗長繁瑣等特點，使整個系統(tǒng)拼接更加方便快捷。見圖5。

圖5 程序示例

圖顯示的是驅(qū)動器與伺服電機之間經(jīng)過編碼器建立反饋，形成高精度的伺服控制系統(tǒng)，伺服電機實時的將其運動狀態(tài)與信息上傳給ZMP控制卡。作為Synqnet總線上的節(jié)點，驅(qū)動器可以和控制卡進行通訊，通過總線接受上位機的各種操作、控制和參數(shù)設(shè)定命令，使得電機按照指令執(zhí)行。其中編碼器反饋信號傳遞給Feedback作為實際位置輸入，與指令位置輸入經(jīng)過數(shù)學(xué)運算后輸入到PID比例、微分、積分形式控制器中，經(jīng)過修改PID參數(shù)完成對控制曲線完善的作用。

簡單的CMD指令保證控制卡程序方便容易的下載到驅(qū)動器里面，通過界面完成每個軸的監(jiān)控。見圖6。

其中Motion Scope可以對采樣的波形實時監(jiān)看，見圖7。

系統(tǒng)自帶MPI編程庫，編程人員能以更方便快捷易懂的方式通過C++進行編程見圖8所示。

MATLAB的數(shù)據(jù)可視化功能，可以對控制曲線實現(xiàn)Bode圖像顯示，IO輸入設(shè)置等。高層次的作圖包括二維和三維的可視化、圖象處理、動畫和表達式作圖。見圖9所示。

圖6 軟件界面

圖7 運動曲線實時監(jiān)視

圖8 軟件編程

圖9 波特圖

5 結(jié)束語

隨著科學(xué)技術(shù)的不斷發(fā)展，各行各業(yè)對各類專業(yè)人才的計算機技能要求越來越高，這就要求我們對運動系統(tǒng)更加熟悉。本文以直線電機平臺控制為例闡述了ZMP卡在運動控制系統(tǒng)中的應(yīng)用，用過Mechaware軟件工具實現(xiàn)和MATLAB/Simulink的協(xié)同工作，用戶可以很快的建立任何系統(tǒng)的控制模型，并通過ZMP控制卡加以實現(xiàn)。高性能的SynqNet以太網(wǎng)總線技術(shù)，解決了用戶在多軸控制系統(tǒng)中的復(fù)雜接線問題，對于傳統(tǒng)的通過模擬量控制而言，具有較高的可靠性。