蘇將兵,廖宏誼,成 軍
(桂林電子科技大學(xué) 材料科學(xué)與工程學(xué)院,廣西 桂林 541004)
拋光是模具制造過(guò)程中必不可少的工序之一。傳統(tǒng)的模具拋光主要依賴于手工,勞動(dòng)強(qiáng)度大,耗時(shí)長(zhǎng),拋光效率低,拋光效果也難以把握。具有廣泛適用性的六軸關(guān)節(jié)機(jī)器人的出現(xiàn),為實(shí)現(xiàn)模具的智能化、自動(dòng)化拋光提供了可能。因而,基于工業(yè)機(jī)器人平臺(tái),開(kāi)發(fā)適應(yīng)模具自由曲面拋光的實(shí)用系統(tǒng),已成為國(guó)內(nèi)外致力研究的課題[1~4]。
拋光工具的位姿,受機(jī)器人拋光工藝中多個(gè)參數(shù)的影響,如拋光力、拋光傾角、拋光路徑和機(jī)器人本身結(jié)構(gòu)等,決定了拋光后能否達(dá)到預(yù)期的模具表面粗糙度的要求。本研究就拋光點(diǎn)的提取、拋光點(diǎn)和軌跡點(diǎn)的位姿計(jì)算,展開(kāi)分析和討論。
為了生成用于機(jī)器人拋光用的軌跡點(diǎn)數(shù)據(jù),首先通過(guò)CAD/CAM軟件,生成模具加工表面的刀軌和數(shù)控點(diǎn)位數(shù)據(jù)[5],然后通過(guò)本研究編制的點(diǎn)位數(shù)據(jù),生成系統(tǒng)提取點(diǎn)位數(shù)據(jù)。通過(guò)合理配置數(shù)控點(diǎn)位數(shù)據(jù)的產(chǎn)生,可以使這些點(diǎn)位數(shù)據(jù)中含有足夠的信息,用來(lái)生成工業(yè)機(jī)器人用的點(diǎn)位數(shù)據(jù)。
關(guān)節(jié)機(jī)器人在拋光模具表面或型腔時(shí),拋光工具沿著拋光軌跡行走,其微觀行為是連續(xù)地在軌跡上相鄰兩點(diǎn)之間直線或圓弧插補(bǔ)移動(dòng)。通常在拋光工具的球頭的球心處,建立一個(gè)坐標(biāo)系,用于表示拋光工具的位姿。球心的運(yùn)動(dòng)軌跡,即為拋光工具的運(yùn)動(dòng)軌跡。軌跡點(diǎn)與拋光點(diǎn)是不同的,軌跡點(diǎn)在球心的運(yùn)動(dòng)軌跡上,而拋光點(diǎn)為拋光工具與模具加工表面的實(shí)際接觸點(diǎn)。
拋光點(diǎn)的位姿計(jì)算,依賴于拋光方向和加工表面的法線方向。拋光點(diǎn)位姿的計(jì)算方法為:首先通過(guò)六軸機(jī)器人模具拋光路徑規(guī)劃系統(tǒng)中的點(diǎn)位數(shù)據(jù)提取功能,提取模具加工表面中拋光點(diǎn)的坐標(biāo)和法向矢量,以法線矢量作為拋光點(diǎn)的坐標(biāo)的z軸,則x軸的方向?yàn)?/p>
y軸的方向,由右手旋轉(zhuǎn)法則得出
模具加工表面拋光點(diǎn)位姿見(jiàn)圖1。
圖1 模具加工表面拋光點(diǎn)位姿
拋光工具的軌跡點(diǎn)的位姿計(jì)算,依賴于拋光工具的球頭半徑、拋光工具的下壓量和相應(yīng)拋光點(diǎn)的位姿。設(shè)拋光工具的球頭球心所位置為oi,球頭半徑為r,拋光工藝要求的下壓量為Δh,拋光傾角為α。計(jì)算拋光工具軌跡點(diǎn)位姿時(shí),保證拋光點(diǎn)和拋光工具軌跡點(diǎn)的x軸同向,如圖2所示,其中{S}為全局坐標(biāo)系。
圖2 拋光工具軌跡點(diǎn)位姿與拋光點(diǎn)位姿
從而可得在全局坐標(biāo)系{S}下,模具加工表面拋光點(diǎn)Pi處拋光工具的位姿的齊次矩陣為SToi:
其中,STPi為拋光點(diǎn)位姿{(lán)Pi}相對(duì)于{S}的齊次變換矩陣。
本研究選用UGNX7.5軟件作為初始點(diǎn)位數(shù)據(jù)生成軟件,生成的模具加工表面的路徑的刀位源數(shù)據(jù)保存在CLSF文件中,使用Visual C++2008開(kāi)發(fā)平臺(tái),通過(guò)MFC和正則表達(dá)式技術(shù),從CLSF文件中提取模具表面的點(diǎn)的坐標(biāo)和法向矢量(圖2),然后通過(guò)位姿算法,計(jì)算適用于IRB2400L型機(jī)器人軌跡點(diǎn)的位姿,然后通過(guò)自編的路徑規(guī)劃軟件,生成相應(yīng)的軌跡。
圖3 從CLSF文件中提取拋光點(diǎn)
CLSF文件中刀具移動(dòng)指令為GOTO指令,具有如下固定格式:
GOTO/-84.7990,-240.8450,93.4380,0.1749487,0.0900292,0.9804528
其中,
-84.7990,-240.8450,93.4380 為刀具的刀位點(diǎn);
0.1749487,0.0900292,0.9804528 為刀具軸的矢量方向,可設(shè)置為刀位點(diǎn)處的法線方向。
而ABB六關(guān)節(jié)臂機(jī)器人的非線性移動(dòng)指令為MoveJ,具有如下指令格式:
MoveJ Target_10,v100,z100,My NewToolWobj=wobj0;
其中,
My NewTool變量,定義了相對(duì)于機(jī)器人第六軸坐標(biāo)系的拋光工具的TCP(工具中心點(diǎn)位姿);
Target_10變量,包含了軌跡點(diǎn)的位姿等其他數(shù)據(jù);
ν100變量,定義了移動(dòng)速度;
z100變量,定義了拋光工具以任何方式在兩個(gè)軌跡點(diǎn)間移動(dòng)。
點(diǎn)位數(shù)據(jù)生成系統(tǒng)首先提取GOTO中的刀位點(diǎn)的坐標(biāo)和刀軸矢量,然后通過(guò)拋光工具位姿算法變換為軌跡點(diǎn)位姿,并通過(guò)相應(yīng)算法生成ABB機(jī)器人MoveJ指令。
由于商業(yè)化的工業(yè)機(jī)器人的封閉控制結(jié)構(gòu),而拋光工具位姿須預(yù)先給定,在拋光過(guò)程中也不能微調(diào),因此拋光過(guò)程中軌跡點(diǎn)的間隔,應(yīng)當(dāng)隨模具加工表面曲率的變化而進(jìn)行調(diào)整。曲率變化劇烈的表面,軌跡點(diǎn)密集,變化緩慢的表面,軌跡點(diǎn)稀疏一些,這樣才可以保證拋光表面的粗糙度要求。
拋光機(jī)器人的各關(guān)節(jié)角,均在一定的角度范圍之內(nèi),如ABB IRB2400L機(jī)器人第三個(gè)關(guān)節(jié)軸的可動(dòng)范圍為(-87.03°~37.97°),而第六關(guān)節(jié)軸的關(guān)節(jié)角的可動(dòng)范圍為(-400°~+400°),因此拋光工具的可達(dá)位置為三維空間的一個(gè)子域,并且還存在一些奇異點(diǎn)位姿。因此這需要通過(guò)Robot Studio仿真驗(yàn)證,修正一些不可達(dá)的點(diǎn)位姿。
[1]J J Márquez,et al.Process Modeling for Robotic Polishing[J].JournalofMaterialsProcessingTechnology,2005,(159):69–82.
[2]Luis Basanez,Jan Rosell.Robotic Polishing Systems[J].IEEE Robotics&Automation Magazine,2005,(9):35-43.
[3]Fusaomi Nagata,et al.CAD/CAM-based Position/Force Controller for a Mold Polishing Robot[J].Mechatronics,2007,(17):207–216.
[4]韓光超,張海鷗,王桂蘭.面向金屬模具快速制造的機(jī)器人成型加工系統(tǒng)[J].機(jī)器人,2006,28(5):515-518.
[5]溫 正,魏建中.精通UG NX 6.0中文版數(shù)控加工[M].北京:科學(xué)出版社,2009.
[6]蔡自興.機(jī)器人學(xué)[M].北京:清華大學(xué)出版社,2000.