陳小明,魏玉瑩,張一帆,李 皎,陳 利
(1.天津工業(yè)大學(xué)紡織科學(xué)與工程學(xué)院,天津 300387;2.天津工業(yè)大學(xué)先進紡織復(fù)合材料教育部重點實驗室,天津 300387;3.天津工業(yè)大學(xué)機械工程學(xué)院,天津 300387)
縫合織物增強復(fù)合材料具有優(yōu)異的層間性能,在航空航天、國家防御和軌道交通等領(lǐng)域得到廣泛的應(yīng)用[1]。國內(nèi)外研究人員對縫合技術(shù)開展了較為廣泛的研究。文立偉等[2]、郭勇等[3]和Verma等[4]研究了縫合復(fù)合材料層合板的層間斷裂韌性,結(jié)果表明:復(fù)合材料的Ⅰ型和Ⅱ型層間斷裂韌性通過縫合技術(shù)得到了顯著的提高;Xuan等[5]提出了一種基于中空毛細管的縫合線無損傷的縫合方法。單面縫合裝備技術(shù)近幾年得到了快速的發(fā)展,姬靈超[6-7]研制了一種碳/碳復(fù)合材料三維預(yù)制體單邊縫合裝置;Gnaba等[8]和Bortoluzzi等[9]分別設(shè)計了不同構(gòu)型的簇絨頭,實現(xiàn)了高性能纖維織物的縫合成型;德國KSL公司研制了簇絨機器人[10-11],用于復(fù)雜自由曲面預(yù)制體的縫合;封橋橋等[12]研究了復(fù)合材料預(yù)制體單邊彎針縫合裝備;董九志等[13]對預(yù)制體縫合針的穩(wěn)定性進行了分析;田會方等[14]設(shè)計了復(fù)合材料單面雙線縫合技術(shù);張勁松等[15]研究了自動縫合關(guān)節(jié)機器人的本體結(jié)構(gòu);Choi等[16-18]發(fā)明了1-fiber新型縫合技術(shù)。此外,王靜[19]、武永盛等[20-21]、何俊杰等[22]和李金鐘等[23]基于機器視覺實現(xiàn)了預(yù)制體縫合接縫的提取和路徑規(guī)劃。然而,大尺寸不規(guī)則平板預(yù)制體的縫合點數(shù)量多,且縫合路徑復(fù)雜,現(xiàn)有的縫合路徑規(guī)劃方法難以滿足高效、可靠的軌跡規(guī)劃要求。
本文提出一種適用于大尺寸不規(guī)則平板預(yù)制體的機器人輔助縫合路徑規(guī)劃方法。首先研究離散點位置設(shè)計和坐標批量輸出方法,進一步構(gòu)建離散點自動排序和縫合點篩選CAD模塊,以及機器人可執(zhí)行程序自動生成CAM模塊;最后,通過實驗驗證機器人輔助縫合路徑規(guī)劃方法的可行性。該方法可應(yīng)用國家重點領(lǐng)域重大工程中大尺寸不規(guī)則構(gòu)件預(yù)制體的縫合成型,將具有廣闊的應(yīng)用前景。
機器人輔助縫合路徑規(guī)劃系統(tǒng)主要包括離散點位置設(shè)計和批量輸出模塊、基于Python的離散點自動排序和縫合點篩選CAD模塊以及機器人可執(zhí)行程序自動生成CAM模塊,如圖1所示。
圖1 機器人輔助縫合路徑規(guī)劃系統(tǒng)示意圖Fig.1 Schematic diagram of robot-assisted stitching path planning system
依據(jù)縫合密度或縫合點間距S,基于AutoCAD將軌跡線等間距離散,離散間距為d,其中10d≤S,并通過“數(shù)據(jù)提取”命令實現(xiàn)點位置的批量輸出,如圖2所示,輸出格式選擇Excel文件格式。
圖2 離散點位置設(shè)計和批量輸出示意圖Fig.2 Schematic diagram of stitching points design and batch output
AutoCAD輸出的離散點處于無序的狀態(tài),需要進一步對離散點進行排序,以滿足縫合先后順序的要求。定義初始點P0,按照最短距離算法,搜索最近點P1,P1再繼續(xù)搜索尋找最近點P2,以此類推將所有的離散點(P0-Pn)按順序排列出來,兩點間距離公式如式(1):
進一步,根據(jù)縫合間距S要求從這些離散點中按順序選擇輸出目標縫合點An的坐標值,其原理圖如圖3所示。
圖3 離散點自動排序和縫合點篩選原理圖Fig.3 Schematic of automatic sorting of discrete points and screening of stitched points
通過Python語言構(gòu)建離散點自動排序和縫合點篩選CAD模塊,算法流程圖如圖4所示。
圖4 離散點自動排序和縫合點篩選CAD模塊運行流程圖Fig.4 Operation flow chart of CAD module for automatic sorting of discrete points and screening of stitched points
具體流程如下:
(1)定義初始點P0,讀取輸出點“OutputPoints.xlsx”,其中“OutputPoints.xlsx”為1.2節(jié)AutoCAD的輸出文件;
(2)根據(jù)公式(1)計算P0與其他點的距離,求得最近點P1;
(3)重新以P1為初始點,在剩余的點中搜索得到最近點P2,以此循環(huán)搜索,遍歷所有離散點,最后搜索得到最終離散點Pn,并生成已排序“l(fā)isanPointsPaixu.xlsx”文件;
(4)最后,按照S=N×d,隔幾個點篩選出一個縫合點,輸出篩選縫合點“fenghePoints.xlsx”文件。開發(fā)的離散點自動排序和縫合點篩選的Python主要代碼如下:
本文的縫合機器人為川崎RS030N機器人,根據(jù)其可執(zhí)行程序的程序格式,包括運動指令和位姿數(shù)據(jù),基于Python語言構(gòu)建機器人可執(zhí)行程序自動生成CAM模塊,其運行流程圖如圖5所示。
圖5 CAM模塊運行流程圖Fig.5 Operation flow chart of CAMmodule
具體流程為:
(1)運行“CAM模塊.py”;
(2)程序自動打開“fenghe.txt”,寫入機器人的直線運動指令“LMOVE”,包括所有縫合點;
(3)打開“fengheweizi.txt”,Python操作EXCEL,讀取篩選縫合點“fenghePoints.xlsx”數(shù)據(jù)和機器人工作姿態(tài)OAT信息,寫入所有縫合點的位姿信息Pn(X,Y,Z,O,A,T),其中機器人工作姿態(tài)信息可以通過示教器直接讀取獲得。
開發(fā)的機器人可執(zhí)行程序自動生成CAM模塊的Python主要代碼如下:
本部分通過機翼翼面縫合實驗進行機器人輔助縫合路徑規(guī)劃方法的可行性驗證,如圖6所示。
翼面具有大尺寸不規(guī)則特征,如圖6(a)所示,縫合點間距設(shè)計為5 mm×5 mm,共計5 083個縫合位置點。S=5 mm,d=0.5 mm,基于本文1.2節(jié)的離散點輸出方法輸出所有離散點位置坐標,運行圖4所示的離散點自動排序和縫合點篩選CAD模塊.py,生成篩選縫合點“fenghePoints.xlsx”,如圖6(b)所示;進一步運行“CAM模塊.py”,生成機器人運動指令和位姿文件,如圖6(c)和6(d)所示,將機器人運動指令和位姿文件合并為一個文檔,并存儲成.pg格式,即是機器人可執(zhí)行程序;最后,開展翼面縫合實體機驗證,基于Xuan等[2]提出的縫合線無損傷縫合工藝,如圖7所示。
圖6 CAD/CAM模塊驗證Fig.6 Verification of CAD/CAMmodule
圖7(a)中,首先植入中空毛細管,然后再穿過縫合線,有效減少縫合線與織物的摩擦,進而減小縫合線的損傷;機器人輔助中空毛細管的植入,如圖7(b)所示,機器人運行上述方法生成的可執(zhí)行程序,輔助完成翼面縫合,如圖7(c)所示。實驗研究結(jié)果表明:本文構(gòu)建的CAD/CAM模塊成功實現(xiàn)縫合點的自動排序和機器人可執(zhí)行程序的自動生成,并實現(xiàn)機翼翼面的縫合。本文提出的大尺寸不規(guī)則平板預(yù)制體的機器人輔助縫合路徑規(guī)劃方法是可行的,路徑規(guī)劃方法是高效、可靠的。本文的路徑規(guī)劃方法具有通用性,適用于復(fù)雜形狀的軌跡線,可拓展至大尺寸不規(guī)則平板預(yù)制體的三維針刺、I纖維縫合和簇絨成型的路徑規(guī)劃。
圖7 翼面縫合實體機驗證Fig.7 Experimental verification of wing surface stitching
(1)本文提出一種大尺寸不規(guī)則平板預(yù)制體的機器人輔助縫合路徑規(guī)劃方法,構(gòu)建了軌跡規(guī)劃CAD/CAM模塊,并通過實驗驗證了方法的可行性。研究結(jié)果表明:本文構(gòu)建的CAD/CAM模塊成功實現(xiàn)離散點設(shè)計和坐標批量輸出、離散點坐標自動排序和縫合點篩選,以及機器人可執(zhí)行程序的生成,并實現(xiàn)機翼翼面的縫合。本文提出的大尺寸不規(guī)則平板預(yù)制體的機器人輔助縫合路徑規(guī)劃方法是可行的。
(2)本文提出的路徑規(guī)劃方法具有通用性,直線、曲線或者直線曲線混合的縫合軌跡均能適用,可拓展至大尺寸不規(guī)則平板預(yù)制體的機器人三維針刺、機器人1-fiber縫合和機器人簇絨成型的路徑規(guī)劃。