玻璃鋼管道相貫線機(jī)器人銑削軌跡規(guī)劃

尤 波 鄒 宇 許家忠

哈爾濱理工大學(xué)自動化學(xué)院，哈爾濱，150080

0 引言

環(huán)氧樹脂與玻璃纖維形成的復(fù)合材料俗稱玻璃鋼，它以其質(zhì)量輕、耐腐蝕好、強(qiáng)度高、使用壽命長、施工方便、廉價等優(yōu)點(diǎn)而深受人們的重視和推崇[1]。由環(huán)氧樹脂玻璃纖維制成的玻璃鋼管道已被廣泛應(yīng)用到船舶的管道系統(tǒng)中[2]。直徑達(dá)4 m和設(shè)計(jì)壽命至少50年的大型玻璃鋼管道系統(tǒng)已被大規(guī)模應(yīng)用在大型飲用水管道、大型重力下水道、雨水排水管道、河水與海水的進(jìn)水口和排水口以及電廠循環(huán)冷卻水管線系統(tǒng)中[3]。由于管道的相貫結(jié)構(gòu)在管道工程中普遍存在，故玻璃鋼相貫管的制造質(zhì)量幾乎影響著整個管道系統(tǒng)的使用壽命。

在玻璃鋼相貫管的制造工藝中，相貫線的銑削質(zhì)量較大程度上決定了玻璃鋼相貫管的生產(chǎn)質(zhì)量。由于玻璃鋼管相貫線上的坡口復(fù)雜多變，且不易測量，故很難確定銑刀的姿態(tài)。玻璃鋼管相貫線軌跡上的每點(diǎn)銑削厚度未知，無法確定銑刀具體深入的合適長度，極易出現(xiàn)管道未切透或過切的現(xiàn)象，造成二次加工、刀具碰撞管件和損壞刀具及管件等后果，進(jìn)而嚴(yán)重影響生產(chǎn)效率。玻璃鋼屬于低剛度材質(zhì)，極易出現(xiàn)銑削變形的現(xiàn)象。上述問題均給玻璃鋼相貫線的銑削工作帶來了極大的挑戰(zhàn)。

目前國內(nèi)外針對玻璃鋼管道相貫線加工的研究較少，缺乏成功的經(jīng)驗(yàn)借鑒，存在較多技術(shù)問題需要解決。對于大直徑、不垂直的玻璃鋼管相貫線開孔，傳統(tǒng)方案往往通過刀具靠模，按模具的輪廓線將此類相貫線孔加工完成，但加工質(zhì)量差，效率低，且相貫線與軸線角度難以保證[4]。美國南方復(fù)合管道公司采用套筒攻絲的方法對玻璃鋼管道進(jìn)行開孔[5]，該方法雖然可以保證相貫線的輪廓準(zhǔn)確，但由于套筒種類有限，較難滿足型號繁多的管件，自動化程度低，不易滿足生產(chǎn)效率。日本KOPCI系列數(shù)控切管機(jī)、德國MULLER公司的RB系列數(shù)控管切割機(jī)以及美國JESON公司的SE-4、SE-5系列馬鞍形數(shù)控切割機(jī)等的切割效率、切割質(zhì)量、自動化程度、設(shè)備操作性能都很高[6-8]，但存在價格高昂、柔性程度低、體積龐大等缺點(diǎn)，在國內(nèi)大多數(shù)企業(yè)中不能廣泛使用[9]?；跈C(jī)器人的切割系統(tǒng)則具有更高的靈活性和適應(yīng)性[10]。重慶智能系統(tǒng)與機(jī)器人研究中心開發(fā)的工業(yè)機(jī)器人相貫線切割系統(tǒng)[11]可以有效地利用機(jī)器人進(jìn)行管件相貫線的激光切割，但由于玻璃鋼管所能承受的溫度有限，高溫易導(dǎo)致其表面焦灼，故不適合玻璃鋼管道的相貫線加工?？紤]到國內(nèi)企業(yè)對高效率高質(zhì)量低成本的機(jī)器人銑削玻璃鋼管道相貫線系統(tǒng)的迫切需求，研發(fā)出既能滿足相貫線坡口多樣性，又能準(zhǔn)確把握各點(diǎn)銑削厚度的機(jī)器人銑削玻璃鋼相貫線的工作站，對我國的船舶工業(yè)和管道系統(tǒng)的發(fā)展具有十分積極的意義。

本文通過計(jì)算管道內(nèi)壁及與之對應(yīng)的管道外壁銑削軌跡的曲線方程，推導(dǎo)銑削厚度與玻璃鋼相貫線的坡口模型。根據(jù)相貫線軌跡上每一點(diǎn)所對應(yīng)的銑削厚度確定銑削深入的適合長度，避免未切透和過切的現(xiàn)象。根據(jù)坡口模型確定機(jī)器人末端銑刀的位姿，針對銑刀過切、碰撞與未切透的問題，對機(jī)器人關(guān)節(jié)空間的軌跡進(jìn)行規(guī)劃。通過機(jī)器人的離線控制實(shí)驗(yàn)，設(shè)計(jì)機(jī)器人銑削工作站運(yùn)行該軌跡，驗(yàn)證該工作站的銑削性能。

1 機(jī)器人銑削工作站系統(tǒng)結(jié)構(gòu)

機(jī)器人銑削系統(tǒng)主要由系統(tǒng)總控制柜、機(jī)器人、機(jī)器人控制柜和電主軸4大部分組成，系統(tǒng)總控制柜由工控機(jī)、PLC控制器、變頻器等器件組成。PLC通過控制變頻器對電主軸的轉(zhuǎn)速進(jìn)行調(diào)整。機(jī)器人末端安裝電主軸，帶動銑刀進(jìn)行銑削。玻璃鋼相貫線銑削機(jī)器人的整體結(jié)構(gòu)框圖見圖1。

圖1 機(jī)器人銑削工作站系統(tǒng)結(jié)構(gòu)Fig.1 Systematic structure of robot station for milling

2 玻璃鋼相貫線銑削軌跡建模

2.1 銑削坡口模型

本文重點(diǎn)研究的玻璃鋼相貫管為典型的插入式相貫結(jié)構(gòu)，支管外壁與主管內(nèi)壁以任意角度相交，形成主管內(nèi)壁的相貫線軌跡。坡口向量將以此為起點(diǎn)，根據(jù)不同的坡口要求向外發(fā)散，并與主管外壁相交，交線為主管外壁的銑削軌跡，因此，推導(dǎo)出主管內(nèi)壁的相貫線軌跡與外壁銑削軌跡，即可建立銑削坡口模型。

(1)主管內(nèi)壁相貫線軌跡。在主管開孔的相貫線銑削方式中，主管內(nèi)壁相貫線軌跡為主管內(nèi)壁與支管外壁相交所得的曲線軌跡，分別建立主管OXYZ坐標(biāo)系和支管O′X′Y′Z′坐標(biāo)系，見圖2。

圖2 主支管坐標(biāo)系Fig.2 Coordinates of main pipe and branch pipe

主管內(nèi)壁在主管OXYZ坐標(biāo)系中的空間方程為

支管外壁在支管O′X′Y′Z′坐標(biāo)系中的空間方程為

主管OXYZ坐標(biāo)系與支管O′X′Y′Z′坐標(biāo)系的空間幾何關(guān)系為

(1)

經(jīng)計(jì)算，在支管坐標(biāo)系中，主管內(nèi)壁與支管外壁相交所得的相貫線內(nèi)壁軌跡為

式中，r為支管外徑；R為主管內(nèi)徑；θ為支管坐標(biāo)系相對于主管坐標(biāo)系的偏轉(zhuǎn)角；β為支管的圓周角；e為主管坐標(biāo)系與支管坐標(biāo)系的偏移量。

(2)主管外壁銑削軌跡。圖2中，主管外壁銑削軌跡為以主管內(nèi)壁相貫線軌跡為起點(diǎn)，各點(diǎn)沿坡口向量np向外發(fā)散，與主管外壁相交所得軌跡。在主管開孔的相貫線銑削過程中，坡口角p為坡口向量np與支管中心線的夾角。主管切面法向量nm與支管切面法向量nb所在平面的法向量nf與坡口向量np垂直。

在支管坐標(biāo)系下，設(shè)主管的壁厚為h，根據(jù)主管開孔的空間幾何關(guān)系可求出主管外壁軌跡。設(shè)坡口向量np=(1,bp,cp)，其中，bp、cp分別為坡口向量Y軸分量和Z軸分量；主管外壁軌跡在支管坐標(biāo)系下用(x2,y2,z2)的形式表示，則可列出方程：

(x2+e)2+(z2cosθ-y2sinθ)2=(R+h)2

可以求得支管坐標(biāo)系下的主管外壁軌跡在(x2,y2,z2)：

由于本系統(tǒng)以主管坐標(biāo)系為機(jī)器人的目標(biāo)坐標(biāo)系，為方便機(jī)器人末端執(zhí)行器的運(yùn)動，需要將該坡口模型轉(zhuǎn)換至主管坐標(biāo)系內(nèi)，故將支管坐標(biāo)系下的主管內(nèi)壁相貫線軌跡與主管外壁銑削軌跡分別轉(zhuǎn)換至主管OXYZ坐標(biāo)系下：

當(dāng)主管內(nèi)徑R為400 mm、壁厚h為60 mm、支管外徑r為360 mm時，變換坡口模型中的部分參數(shù)，坡口模型的曲線變化如下：假設(shè)支管與主管垂直相交即偏轉(zhuǎn)角θ為0°，且主管的中心線與支管的中心線垂直相交即偏移量e為0，此時，坡口角分別為0°、30°、60°時的坡口主管外壁銑削軌跡見圖3。

圖3 主支管垂直正交時坡口軌跡曲線Fig.3 Curve of groove from vertical main and branch pipes

假設(shè)支管與主管偏轉(zhuǎn)角θ為15°時，主管的中心線與支管的中心線相交但不偏移(即偏移量e為0)，此時，坡口角分別為0°、30°、60°時的坡口主管外壁銑削軌跡見圖4。

圖4 支管偏轉(zhuǎn)15°時坡口軌跡曲線Fig.4 Curve of groove from 15° in rotational branch pipe

假設(shè)支管與主管垂直相交(即偏轉(zhuǎn)角θ為0°)，當(dāng)支管沿主管坐標(biāo)軸的X軸正方向偏移20 mm(即偏移量e為20 mm時)，坡口角分別為0°、30°、60°時的坡口主管外壁銑削軌跡見圖5。

圖5 支管偏移20 mm時坡口軌跡曲線Fig.5 Curve of groove from 20 mm in translational branch pipe

2.2 銑削厚度分布

在玻璃鋼材料的銑削過程中，機(jī)械力受進(jìn)給速度和切削深度的影響分別為54%和45%[12]。因此，掌握每個軌跡點(diǎn)對應(yīng)的厚度，不僅可以有效避免玻璃鋼管相貫線銑削過程中未切透和過切碰撞的現(xiàn)象，而且可以根據(jù)具體材料成分，選擇與厚度對應(yīng)的銑刀進(jìn)給速度，提高銑削質(zhì)量和效率。

在主管坐標(biāo)系下，根據(jù)主管內(nèi)壁的相貫線軌跡(x3,y3,z3)與主管外壁的銑削軌跡(x4,y4,z4)，可以推導(dǎo)出每一個軌跡點(diǎn)所對應(yīng)的銑削厚度H，即

當(dāng)主管內(nèi)徑R為400 mm、壁厚h為60 mm、支管外徑r為360 mm時，銑削厚度H隨支管圓周角β的變化曲線如下。

(1)假設(shè)支管與主管垂直相交(即偏轉(zhuǎn)角θ為0°)，且主管的中心線與支管的中心線垂直相交(即偏移量e為0)，此時，坡口角分別為0°、30°、60°時的銑削厚度分布見圖6。

圖6 主支管垂直正交時銑削厚度曲線Fig.6 Thickness of groove from vertical main and branch pipes

(2)假設(shè)支管與主管偏轉(zhuǎn)角θ為15°且偏移量e為0，此時，坡口角分別為0°、30°、60°時的銑削厚度分布見圖7。

圖7 支管偏轉(zhuǎn)15°時銑削厚度曲線Fig.7 Thickness of groove from 15° in rotational branch pipe

(3)假設(shè)支管與主管垂直相交(即偏轉(zhuǎn)角θ為0°)，當(dāng)支管沿主管坐標(biāo)軸的X軸正方向偏移20 mm(即偏移量e為20 mm時)，坡口角分別為0°、30°、60°時的銑削厚度分布見圖8。

圖8 支管偏移20 mm時銑削厚度曲線Fig.8 Thickness of groove from 20 mm in translational branch pipe

根據(jù)每個軌跡點(diǎn)對應(yīng)的厚度，既可以確定銑削深入的適合長度，有效規(guī)避了未切透和過切碰撞的風(fēng)險，又可以選擇與之對應(yīng)的刀具進(jìn)給速度，提高了生產(chǎn)質(zhì)量和效率。

3 機(jī)器人控制程序

3.1 機(jī)器人關(guān)節(jié)空間軌跡規(guī)劃

由于上文所求得的主管內(nèi)壁相貫線軌跡(x3,y3,z3)與主管外壁銑削軌跡(x4,y4,z4)所在坐標(biāo)系為主管OXYZ坐標(biāo)系，為方便機(jī)器人關(guān)節(jié)空間的求解，需要將坡口模型轉(zhuǎn)換至機(jī)器人基坐標(biāo)系O0X0Y0Z0內(nèi)，見圖9。

圖9 機(jī)器人各關(guān)節(jié)坐標(biāo)系Fig.9 Each joint coordinate of robot

由于機(jī)器人末端點(diǎn)為銑刀末端的中心點(diǎn)D(圖10)，故需推導(dǎo)出銑刀末端的位姿。

圖10 銑刀位姿Fig.10 Milling position and pose

在主管坐標(biāo)系中，A點(diǎn)為玻璃鋼管道主管內(nèi)壁相貫線軌跡點(diǎn)，B點(diǎn)為銑刀刀頭下端點(diǎn)，C點(diǎn)為銑刀刀頭上端點(diǎn)，D點(diǎn)為銑刀刀頭的中心點(diǎn)，即機(jī)器人銑削系統(tǒng)的末端點(diǎn)，過點(diǎn)D作點(diǎn)A豎直方向的垂線，交點(diǎn)為E。設(shè)銑刀的直徑為d，銑刀的穿透長度AB為L，因此，主管內(nèi)壁相貫線軌跡點(diǎn)A到銑刀刀頭中心點(diǎn)D的距離

根據(jù)三維空間的三角形原理，玻璃鋼管道主管內(nèi)壁相貫線軌跡點(diǎn)A到銑刀刀頭中心點(diǎn)D的豎直距離AE為

lAE=lADcos(p+∠BAD)cosθ

經(jīng)推導(dǎo)得：

lAE=Lcospcosθ-0.5dsinpcosθ

銑刀刀頭中心點(diǎn)D在Z軸方向的坐標(biāo)

DZ=z3-Lcospcosθ+0.5dsinpcosθ

在支管坐標(biāo)系中，銑刀刀頭中心點(diǎn)D在X′方向和Y′方向上的坐標(biāo)分別為

根據(jù)式(3)中的主支管坐標(biāo)轉(zhuǎn)換關(guān)系，將銑刀刀頭中心點(diǎn)D的三維坐標(biāo)均轉(zhuǎn)換至主管OXYZ坐標(biāo)系中：

nx=ayoz-azoyny=azox-axoz

nz=axoy-ayox

ox=-x6/Eoy=-y6/E

ax=(x5-x6)/Fay=(y5-y6)/F

az=(z5-z6)/F

px=x7py=y7pz=z7

D=(axx6+ayy6+azz6)/az-z6

式中,px、py、pz分別為銑刀末端在機(jī)器人基坐標(biāo)系中X、Y、Z軸坐標(biāo)。

根據(jù)機(jī)器人末端銑刀的位姿，運(yùn)用機(jī)器人逆運(yùn)動學(xué)方程，每個銑削軌跡點(diǎn)上可以求出6個關(guān)節(jié)角q1～q6共8組解：

3.2 機(jī)器人銑削軌跡離線編程

圖11為機(jī)器人銑削程序離線編程的流程圖。采用經(jīng)過二次開發(fā)后的VS軟件對玻璃鋼管道坡口模型進(jìn)行前處理，獲得銑削點(diǎn)位信息，再將此信息經(jīng)后處理，生成機(jī)器人末端銑刀位姿信息。根據(jù)機(jī)器人的結(jié)構(gòu)及尺寸建立機(jī)器人的連桿模型，利用D-H法建立機(jī)器人運(yùn)動學(xué)方程。最后，根據(jù)以上信息計(jì)算出機(jī)器人運(yùn)動學(xué)逆解獲得各銑削點(diǎn)的關(guān)節(jié)角，經(jīng)后處理得到機(jī)器人的控制程序。

圖11 機(jī)器人銑削玻璃鋼管道離線編程流程圖Fig.11 Flow chart of off-line programming for robot milling FRP pipe

4 機(jī)器人銑削玻璃鋼相貫線實(shí)驗(yàn)

實(shí)驗(yàn)采用KUKA KR210六自由度機(jī)器人，KR C4控制柜，S7-1200 PLC，臺達(dá)VFD-B系變頻器，HITECO自動換刀電主軸和56°螺旋角硬質(zhì)合金銑刀，見圖12。為驗(yàn)證本系統(tǒng)的銑削玻璃鋼管道相貫線性能，對本銑削系統(tǒng)進(jìn)行實(shí)驗(yàn)驗(yàn)證。

圖12 機(jī)器人銑削玻璃鋼相貫線實(shí)驗(yàn)圖Fig.12 Diagram of robot milling intersecting line of FRP pipe

實(shí)驗(yàn)先后采用手動銑削模式與本系統(tǒng)自動銑削模式，分別對同規(guī)格管件進(jìn)行相同要求銑削。實(shí)驗(yàn)參數(shù)見表1。

表1 實(shí)驗(yàn)參數(shù)

4.1 手動銑削實(shí)驗(yàn)

手動銑削模式即采用機(jī)器人的手動操作模式，在僅掌握玻璃鋼主管內(nèi)壁相貫線軌跡的情況下，根據(jù)過往經(jīng)驗(yàn)在銑削過程中手動調(diào)節(jié)銑刀穿透長度L和坡口角度p，從而完成表1所要求的玻璃鋼管道相貫線的銑削。手動銑削后的成品見圖13。

圖13 手動銑削玻璃鋼管道相貫線效果Fig.13 Effective picture of manual milling intersecting line of FRP pipe

由于在手動銑削過程中較難把握各銑削點(diǎn)的銑削厚度H以及坡口角度p，不易確定銑刀的合適穿透長度L，故在較大程度上影響了銑削軌跡精度，造成圖13中的未切透現(xiàn)象。通過觀察未切透區(qū)域可發(fā)現(xiàn)，此區(qū)域的坡口角度p明顯大于15°。并且由于玻璃鋼低剛度，多處產(chǎn)生圖13中的毛刺現(xiàn)象。

利用納米顯微鏡對手動銑削模式下的玻璃鋼管道相貫線銑削表面進(jìn)行粗糙度測量，玻璃纖維的分布情況見圖14。

圖14 手動銑削玻璃鋼管相貫線表面測量結(jié)果Fig.14 Result of testing of manual milling intersecting line of FRP pipe

坡口表面的各類高度參數(shù)經(jīng)納米顯微鏡測量后的結(jié)果見表2。

表2坡口表面纖維高度參數(shù)(手動銑削)

Tab.2Parametersofheightsoffibrefromgroovesurface(manual milling) μm

4.2 自動銑削實(shí)驗(yàn)

自動銑削模式即采用本系統(tǒng)所規(guī)劃的機(jī)器人銑削玻璃鋼管道相貫線的軌跡，將表1的加工參數(shù)輸入機(jī)器人控制程序中，機(jī)器人控制銑刀的位姿對玻璃鋼管道的相貫線進(jìn)行自動銑削。根據(jù)實(shí)驗(yàn)管件的規(guī)格，可以理論計(jì)算出主管相貫線的銑削厚度分布，見圖15。

圖15 實(shí)驗(yàn)管件相貫線厚度分布Fig.15 Thickness distribution of intersecting line in experimental pipe

由圖15可知，本次實(shí)驗(yàn)所銑削的管件相貫線，最高厚度為9.942 mm，最低厚度為9 mm，故可將銑刀穿透長度L設(shè)置為10 mm，既保證管件的切透，又可以避免銑刀與管件的碰撞，同時保證因?qū)嶒?yàn)地面不水平或管件夾具高度不一致等外部因素導(dǎo)致的誤差。自動銑削后的成品見圖16，可以看出相貫線軌跡連續(xù)光順，表面光滑均整。

圖16 自動銑削玻璃鋼管道相貫線效果Fig.16 Effective of automatic milling intersecting line of FRP pipe

利用納米顯微鏡對自動銑削模式下的玻璃鋼管道相貫線表面進(jìn)行粗糙度測量，玻璃纖維的分布情況見圖17。坡口表面的各類高度參數(shù)經(jīng)納米顯微鏡測量后的結(jié)果見表3。

表3 坡口表面纖維高度參數(shù)(自動銑削)

圖17 自動銑削玻璃鋼管相貫線表面測量結(jié)果Fig.17 Result of testing of automatic milling intersecting line of FRP pipe

4.3 實(shí)驗(yàn)結(jié)論

對比手動銑削和自動銑削的實(shí)驗(yàn)結(jié)果可知，手動銑削后的玻璃鋼管道未能一次性形成開孔，坡口表面多處存在毛刺，玻璃纖維分布雜亂，粗糙度Sa約為26.76 μm。而采用本系統(tǒng)所規(guī)劃的機(jī)器人銑削軌跡，對玻璃鋼管道相貫線進(jìn)行自動銑削后，一次性完成相貫線開孔，坡口表面光滑均整，粗糙度Sa約為18.6 μm，有效降低了表面粗糙度，提高了銑削質(zhì)量。

5 結(jié)論

(1)基于主管內(nèi)壁相貫線軌跡和坡口向量，計(jì)算出外壁銑削軌跡，建立了玻璃鋼管主管相貫線銑削坡口的數(shù)學(xué)模型。

(2)以相貫線坡口模型為基礎(chǔ)，推導(dǎo)出玻璃鋼管相貫線軌跡上每點(diǎn)對應(yīng)的銑削厚度，為確定銑刀合適的切入深度提供了理論依據(jù)。

(3)根據(jù)玻璃鋼管內(nèi)壁相貫線軌跡和外壁銑削軌跡，確定了機(jī)器人末端銑刀位姿，運(yùn)用機(jī)器人逆運(yùn)動學(xué)求解出8種關(guān)節(jié)角的組合，為機(jī)器人銑削玻璃鋼管相貫線的動作提供了合適的姿態(tài)。

(4)實(shí)驗(yàn)結(jié)果表明，本文所規(guī)劃的機(jī)器人銑削玻璃鋼管道相貫線的軌跡能一次性完成開孔作業(yè)，減少了毛刺產(chǎn)生，有效降低了坡口表面粗糙度，提高了銑削質(zhì)量。