基于PMC6496運動(dòng)控制器的機械手上下料系統

一 PMC6496的特點(diǎn)

PMC6496運動(dòng)控制器是雷賽公司在獨立式運動(dòng)控制器的基礎上，精心研發(fā)的一款具有PLC特點(diǎn)的高性能產(chǎn)品。由于其全面支持IEC61131-3標準梯形圖編程語(yǔ)言，在邏輯控制上完全可以與中、小型PLC媲美。同時(shí)，其強大的運動(dòng)控制功能更是傳統中、小型PLC無(wú)法匹敵的。

1 .PMC6496的硬件性能

圖1為PMC6496運動(dòng)控制器的硬件結構圖。



圖1 PMC6496運動(dòng)控制器硬件結構

PMC6496基于嵌入式處理器和FPGA的硬件結構，插補算法、脈沖信號的產(chǎn)生及加速和減速控制、I/O信號的檢測處理，均由硬件和固件實(shí)現，確保了運動(dòng)控制高速、高精度及系統穩定。該系列控制器可控制4個(gè)步進(jìn)或伺服電機，具有最高5MHz脈沖頻率、四軸直線(xiàn)插補、兩軸圓弧插補、連續曲線(xiàn)插補、S形曲線(xiàn)速度控制等高級功能。通過(guò)簡(jiǎn)單的編程即可開(kāi)發(fā)出穩定可靠的高性能連續軌跡運動(dòng)控制系統。

除了4個(gè)電機控制端口外，還提供了豐富的I/O接口和通訊接口：光電隔離I/O接口、擴展I/O接口、D/A輸出、PWM輸出、編碼器接口、手搖脈沖發(fā)生器接口。1個(gè)網(wǎng)絡(luò )接口、2個(gè)串行口，可通過(guò)網(wǎng)口或串口與PC機通信；同時(shí)還可以通過(guò)串口連接其它設備，如：手持編程器、觸摸屏、PLC等?？赏ㄟ^(guò)U盤(pán)接口用U盤(pán)方便地存儲文件和參數。Flash用于存儲用戶(hù)程序、鐵電存儲器用于參數的掉電保存。PMC6496的主要技術(shù)指標詳見(jiàn)表1。

表1 PMC6496控制器硬件性能



2. PMC6496的功能特性

PMC6496運動(dòng)控制器運動(dòng)控制性能優(yōu)異的，工作穩定可靠，梯形圖編輯環(huán)境友好。其主要特點(diǎn)如下：

簡(jiǎn)單易學(xué)：由于梯形圖是自動(dòng)化行業(yè)工程師最熟悉的編程語(yǔ)言，因此PMC6496的推出，大大降低了運動(dòng)控制器的應用門(mén)檻，使用戶(hù)更容易上手，快速開(kāi)發(fā)自己的設備。

強大的運動(dòng)控制功能：PMC6496可控制4軸步進(jìn)電機或伺服電機進(jìn)行4軸直線(xiàn)插補，任意2軸圓弧插補，多軸連續插補?？蛇M(jìn)行橢圓，螺旋等軌跡控制。并且，PMC6496配置了2048段指令緩沖，有效地保證了高速軌跡運動(dòng)的連續性和平滑度。

友好的梯形圖編輯環(huán)境：全面支持IEC61131-3標準梯形圖編程語(yǔ)言，支持子程序，梯形圖比較，看門(mén)狗，單步調試等功能，梯形圖開(kāi)發(fā)更加方便快捷。

HMI設備支持：PMC6496可與基于標準Modbus協(xié)議的人機界面進(jìn)行通訊，包括：觸摸屏、文本顯示器、手持編程器等。用戶(hù)只需在人機界面設計時(shí)，按相應的寄存器地址映射公式正確設置各種軟元件的Modbus地址即可，而幾乎不需要編寫(xiě)任何程序代碼。

網(wǎng)絡(luò )通訊：PMC6496是一款基于10/100M以太網(wǎng)的PLC，可以使得梯形圖調試、下載等在線(xiàn)操作更加流暢。

二 機械手上下料的運動(dòng)軌跡

某客戶(hù)的生產(chǎn)線(xiàn)上需要使用機械手上下料，結構如圖2所示。X軸執行水平左右運動(dòng)，Y軸執行豎直上下運動(dòng)，手爪由氣缸控制執行抓取動(dòng)作。它們的任務(wù)是將右側工裝上的工件依次抓取至左側傳送帶上。X軸原點(diǎn)距離傳送帶上工件放置點(diǎn)為W，工裝上第一個(gè)工件距離傳送帶上工件放置點(diǎn)為S，工裝上每個(gè)工件之間的距離均為L(cháng)。



圖2 機械手上下料系統組成

通常，大多數用戶(hù)會(huì )將X、Y的運動(dòng)軌跡確定為矩形，即Y軸上下運動(dòng)完成后X軸再水平運動(dòng)，然后Y軸再次上下運動(dòng)，如此反復進(jìn)行。但這樣的方式會(huì )導致比較強烈的抖動(dòng)，并且造成一定的時(shí)間浪費。

因此，可采用圖4所示的運動(dòng)軌跡，在2個(gè)拐彎處，X、Y軸進(jìn)行一段半徑為R的圓弧插補運動(dòng)，這樣可大大減弱抖動(dòng)，且能節省時(shí)間。A點(diǎn)為起始點(diǎn)，抓取并放置第1個(gè)工件的路徑為A→B→C→D→E→F→G→H→I→J→K，抓取并放置第2個(gè)工件的路徑與第一個(gè)相同，只不過(guò)A→B和F→G的距離增加了長(cháng)度L，第3個(gè)、第4個(gè)、第5個(gè)亦然。

PMC6496支持連續插補運動(dòng)，在連續插補模式下，速度是連續的，各插補段之間沒(méi)有加減速過(guò)程，從而使得運動(dòng)更加平滑。運行CONTI_ENTER功能塊后進(jìn)入連續插補模式，加入要求的插補運動(dòng)軌跡，使用LINE_START功能塊啟動(dòng)連續插補運動(dòng)，PMC6496以連續插補模式運行完所有運動(dòng)軌跡。



圖3 連續插補運動(dòng)



圖4 機械手上下料運動(dòng)軌跡

三 機械手上下料控制系統流程

繪制流程圖，如圖5所示。每次啟動(dòng)時(shí)，將抓取次數重置為0，抓取5次后結束。“夾緊”和“松開(kāi)”為氣缸動(dòng)作。





圖5 機械手上下料流程圖



四 機械手上下料控制系統的程序



機械手上下料控制系統程序如圖6所示。







圖6 機械手上下料程序(程序1-4節)



圖6（續2） 程序5-22節