引言

蓄電池極板連續(xù)生產(chǎn)線的碼垛機(jī)器人是一種特殊的直角坐標(biāo)搬運機(jī)器人,本文以此種機(jī)器人為例,研究機(jī)器人控制方法。蓄電池極板連續(xù)生產(chǎn)線的特點是同時輸出兩垛料,需要機(jī)器人能同時將兩垛料取出并搬運至目標(biāo)位置。傳統(tǒng)直角坐標(biāo)機(jī)器人三軸(x軸、Y軸、Z軸）的機(jī)械結(jié)構(gòu)顯然不能滿足這樣的應(yīng)用需求,因此設(shè)計了能滿足此種應(yīng)用需求的特殊機(jī)器人,機(jī)器人結(jié)構(gòu)簡化如圖1所示。

機(jī)器人共包含5個軸,Y1、Z1機(jī)械臂和Y2、Z2機(jī)械臂共用一個x軸,Y1、Z2機(jī)械臂和Y2、Z2機(jī)械臂需要分別獨立動作,執(zhí)行搬運任務(wù)。Y1、Z1機(jī)械臂和Y2、Z2機(jī)械臂末端分別安裝了一個夾持裝置,由電磁閥控制氣缸動作對物料進(jìn)行夾持。同時,為了適應(yīng)多變的生產(chǎn)環(huán)境,機(jī)器人不僅要滿足基礎(chǔ)的搬運功能,還要具備碰撞保護(hù)、一鍵復(fù)位、一鍵啟動等功能。

1控制系統(tǒng)的硬件平臺搭建

本文案例選用的運動控制器為歐姆龍Nx1P2-1140DT,具備多軸運動控制功能,循環(huán)周期最短為1ms。控制器擴(kuò)展了I/O模塊,用于傳感器信號的輸入以及電磁閥控制信號的輸出?？刂破魍ㄟ^Ethernet與一塊觸摸屏通信實現(xiàn)人機(jī)交互,其功能包括參數(shù)設(shè)置、狀態(tài)顯示、配方設(shè)置、手動操作、路徑示教等,觸摸屏型號為臺達(dá)DOP-B07E415?？刂破魍ㄟ^EtherCAT總線與5臺伺服驅(qū)動器通信,實現(xiàn)對機(jī)器人x軸、Y1軸、Z1軸、Y2軸、Z2軸的控制。伺服系統(tǒng)選用臺達(dá)ASD-A2系列,具有較好的實時性和動態(tài)響應(yīng)特性:伺服電機(jī)均安裝絕對值編碼器,設(shè)備斷電時可保存機(jī)械臂位置信息。

2數(shù)據(jù)結(jié)構(gòu)分析

實現(xiàn)機(jī)器人運動控制的核心為運動軌跡控制,把運動軌跡稱作路徑(Route）。運動軌跡是由空間中一個一個確定的點組成的,把這些點稱作坐標(biāo)(Coord）。坐標(biāo)(Coord）包含的最基本信息顯然是位置信息,包括x、Y1、Z1、Y2、Z2五個軸的位置信息,分別用x、y1、z1、y2、z2表示:除位置信息外,坐標(biāo)(Coord）還應(yīng)該包含運動信息,包括運動至當(dāng)前坐標(biāo)的速度(speed）、加速度(acc）、減速度(dec）:為了使運動軌跡更平滑,提高工作效率,還需要引入一個軌跡控制精度的概念,即當(dāng)前坐標(biāo)位置執(zhí)行完成的提前量(advance）:機(jī)器人要完成具體的搬運任務(wù),需要對機(jī)械臂安裝的各類工裝進(jìn)行控制,除此之外,各種復(fù)雜的應(yīng)用場合需要機(jī)器人實現(xiàn)各種特殊的功能,因此,還需要引入一個動作的概念,當(dāng)機(jī)器人完成當(dāng)前坐標(biāo)運動后,需要執(zhí)行一定的動作(action）。由此,我們提出一個結(jié)構(gòu)體coord,其元素為(x,y1,y2,z1,z2,speed,acc,dec,advance,action）。

假設(shè)實際生產(chǎn)應(yīng)用中,完成一個搬運工作的運動軌跡最大由20個坐標(biāo)(Coord）組成,那么數(shù)組ARRAY[1..20]OFcoord就是可以完全描述這段運動軌跡的路徑(Route）。

3機(jī)器人運動控制原理

機(jī)器人的控制原理主要部分如圖2所示。執(zhí)行第I步時,控制器向各個軸下發(fā)當(dāng)前步的運動控制命令:控制命令通過一個命令執(zhí)行過濾器(fi1ter）,當(dāng)前軸上一步目標(biāo)位置和當(dāng)前步目標(biāo)位置一致,且前當(dāng)軸正在運動時,則不執(zhí)行運動命令,否則執(zhí)行當(dāng)前步運動命令:當(dāng)所有軸的當(dāng)前位置距離目標(biāo)位置在軌跡控制精度(advance）范圍內(nèi)時,則認(rèn)為當(dāng)前步位置命令完成,開始執(zhí)行當(dāng)前步動作命令:當(dāng)前步動作命令執(zhí)行完成后,開始執(zhí)行下一步運動命令。

4系統(tǒng)狀態(tài)控制設(shè)計

圖3為本文案列的狀態(tài)轉(zhuǎn)移圖,以層級式狀態(tài)機(jī)思維描述了系統(tǒng)在各狀態(tài)之間轉(zhuǎn)移的方向。在"初始狀態(tài)",系統(tǒng)可通過外部"自動模式"旋鈕切換至"自動狀態(tài)":"自動狀態(tài)"下,可通過外部"啟動"按鈕進(jìn)入"自動回原點狀態(tài)":在"自動回原點狀態(tài)"中,機(jī)器人將根據(jù)當(dāng)前空間位置,選擇合適的回原點路徑進(jìn)行回原點動作:回原點動作完成后,系統(tǒng)自動進(jìn)入"自動待機(jī)狀態(tài)",按下外部"啟動"按鈕后,機(jī)器人進(jìn)入"自動運行狀態(tài)",機(jī)器人執(zhí)行循環(huán)搬運工作:可隨時通過外部"停止"按鈕進(jìn)入"自動待機(jī)狀態(tài)",亦可隨時通過外部"啟動"按鈕使機(jī)器人重新進(jìn)入"自動運行狀態(tài)",執(zhí)行搬運工作:機(jī)器人在搬運過程中出現(xiàn)碰撞報警時,將自動進(jìn)入"力矩超限狀態(tài)",以極慢的速度避讓障礙物并報警,隨后系統(tǒng)自動進(jìn)入"自動回原點狀態(tài)"。

通過對機(jī)器人需求的分析,確定機(jī)器人需要實現(xiàn)的功能,按功能劃分機(jī)器人的各個系統(tǒng)狀態(tài),通過層級式狀態(tài)機(jī)思維描述系統(tǒng)狀態(tài)的轉(zhuǎn)移方向,最終實現(xiàn)了操作簡單、使用靈活,并具備碰撞保護(hù)功能的機(jī)器人系統(tǒng)設(shè)計。

5結(jié)語

本文結(jié)合實際案例,介紹了一種多軸直角坐標(biāo)搬運機(jī)器人的通用控制方法。經(jīng)過設(shè)備在實際生產(chǎn)實踐中的驗證,證明了此種控制方法是可靠、高效、穩(wěn)定的,可以作為一種多軸直角坐標(biāo)搬運機(jī)器人的通用控制方法。