王 林 張春燕 全宏杰 張勝文

（江蘇科技大學(xué)機械工程學(xué)院，江蘇 鎮(zhèn)江 212100）

螺旋槳作為水上交通運輸工具的核心部件，它的制造質(zhì)量直接影響著船舶運行性能和水上交通運輸?shù)男蔥1]。大型船用螺旋槳一般是指直徑大于3.5 m的螺旋槳，其葉輪葉片薄、懸壁長和形狀比較復(fù)雜，屬于典型的自由曲面零件。大型螺旋槳加工過程比較復(fù)雜，槳葉作為大型復(fù)雜薄壁件，加工過程中極易產(chǎn)生振動和變形，相鄰葉片間較為狹窄，存在重疊區(qū)域，加工時易發(fā)生干涉和過切。

上世紀大型螺旋槳槳葉的加工一般是通過工人手工打磨或者機械半自動化加工，效率低且槳葉表面質(zhì)量參差不齊，不好管控。打磨過程中，磨屑粉塵污染嚴重，加工作業(yè)時產(chǎn)生的噪聲可達95 dB以上，生產(chǎn)人員工作環(huán)境十分惡劣[2]。近年來，隨著制造技術(shù)的高速發(fā)展，目前大多采用五軸聯(lián)動數(shù)控加工中心來加工螺旋槳葉片以提高螺旋槳葉片的加工質(zhì)量和效率。但是數(shù)控機床造價高、加工柔性差、可重構(gòu)配置性差，生產(chǎn)成本高，一般中小企業(yè)難以實現(xiàn)。在這種背景下，機器人加工備受人們的青睞。機器人加工不僅自動化程度高，制造柔性強，靈活性大，適用于多種型號的螺旋槳的加工，還可以減少人工投入和成本，降低工作人員勞動強度，改善工作環(huán)境。但機器人存在關(guān)節(jié)多，剛性差等問題。諸多專家學(xué)者對機器人加工進行了研究。典型的有：華中科技大學(xué)和中車株洲電力機車研究所聯(lián)合研發(fā)了大型風(fēng)電葉片機器人智能磨削系統(tǒng)，一定程度上解決了大型復(fù)雜曲面測量與磨削方面的多項技術(shù)難題[3]；上海船用柴油機研究所研究出一套船舶螺旋槳銑磨系統(tǒng)，可用來解決磨削整體螺旋槳時出現(xiàn)的槳葉干涉和加工效率低下等難題[4]；沈陽遠大于2018年研發(fā)出一套大型復(fù)雜曲面智能銑磨機器人，采用螺旋槳豎直布局、機器人對稱式布置的方式，實現(xiàn)了葉片高效率高可靠性加工[5]。上述研究中加工螺旋槳的設(shè)備主要是六軸工業(yè)機器人，雖然在一定程度上提升了加工的效率和可靠性，但是由于六軸工業(yè)機器人具有自由度多、剛性差等固有缺陷，一般只能采用端面銑的加工方式，切削參數(shù)較低，否則將會出現(xiàn)顫振現(xiàn)象。所以考慮到加工效率，上述設(shè)備一般采用以磨削加工為主，銑削加工為輔的方式。而且上述研究中的加工對象大多是中小型槳葉，無法應(yīng)用于高效加工大型船用螺旋槳，因此設(shè)計加工大型螺旋槳的機器人結(jié)構(gòu)方案，并研究機器人運動學(xué)問題，判斷其能否滿足大型螺旋槳的加工需求是必要的。

插銑作為在粗加工中實現(xiàn)高切除率金屬切削的加工方法之一，在難加工材料的曲面加工中，切削效率遠高于常規(guī)端面銑削法。本文從大型船用螺旋槳加工要求和加工方式入手，提出插銑加工大型船用螺旋槳的方法?；诓邈娂庸ζ錂C器人結(jié)構(gòu)進行設(shè)計。為了避免冗余自由度對機器人剛度的影響，采用盡可能少的自由度設(shè)計出一種在粗加工階段能夠滿足大型船用螺旋槳插銑加工的工業(yè)機器人。

1 船用螺旋槳加工機器人結(jié)構(gòu)設(shè)計

大型船用螺旋槳插銑機器人加工系統(tǒng)如圖1所示。加工系統(tǒng)中螺旋槳槳轂水平放置，螺旋槳葉片表面近似垂直于水平面放置于地坑中，機器人位于地坑的一邊加工單側(cè)葉面，另一側(cè)葉面由位于地坑另一側(cè)的輔助支撐桿支撐，防止其在加工過程中發(fā)生振動和變形。螺旋槳加工機器人如圖2所示，主要是由傳動機構(gòu)、機身和機械臂組成。移動關(guān)節(jié)A可以實現(xiàn)機器人沿X方向的移動，移動關(guān)節(jié)B可以實現(xiàn)機器人沿Y方向的移動，轉(zhuǎn)動關(guān)節(jié)C可以實現(xiàn)機身繞Z方向的轉(zhuǎn)動，轉(zhuǎn)動關(guān)節(jié)D可以實現(xiàn)機械臂繞X方向的擺動。機器人插銑加工螺旋槳主要有3個加工階段，分別為進給切削、軸向抬刀和水平移刀。沿著Z方向和X方向的移刀過程分別由移動關(guān)節(jié)A和轉(zhuǎn)動關(guān)節(jié)D實現(xiàn)；插銑加工時的沿Y方向的進給和抬刀過程由移動關(guān)節(jié)B實現(xiàn)。由于槳葉和葉根槳轂區(qū)域可能存在重疊區(qū)域，所以在機身下方加一個繞X方向轉(zhuǎn)動的回轉(zhuǎn)臺來實現(xiàn)對干涉區(qū)域的加工。不同于一般機器人端面銑的加工方式和自由度，圖2所示的機器人采用插銑的方式對螺旋槳進行加工，沒有冗余自由度，加工時剛性更好，主切削力是由移動關(guān)節(jié)B直接提供且方向相同，所以切削用量遠高于端面銑的機器人，銑削效率會有質(zhì)的突變。綜上，4個自由度較為合理地滿足了插銑加工方式和大型螺旋槳加工的需求。

圖 1 螺旋槳加工系統(tǒng)

圖 2 螺旋槳加工機器人

插銑時，通過機器人的4個關(guān)節(jié)配合運動加工完當前區(qū)域，然后轉(zhuǎn)動螺旋槳漿轂，將槳葉上另一片待加工區(qū)域旋轉(zhuǎn)到當前位置進行加工。螺旋槳轉(zhuǎn)動3～4次即可加工完一整片槳葉。重復(fù)以上步驟直至加工完全部槳葉。

加工系統(tǒng)的布局和插銑加工的方式及機器人結(jié)構(gòu)相配合，實現(xiàn)了加工時主切削力的方向與機器人結(jié)構(gòu)剛度最優(yōu)的方向一致，在一定程度上防止了加工過程中的顫振現(xiàn)象，最大程度地避免了加工件的變形。

2 機器人運動學(xué)分析

2.1 機器人 D-H 模型建立

機器人的正逆運動學(xué)通常與工具變換無關(guān)，所以在運動學(xué)分析中只需研究機器人本體。本文所設(shè)計的機器人末端關(guān)節(jié)是機械臂轉(zhuǎn)動，但是加工時需要機械臂末端電主軸上的銑刀工作，此結(jié)構(gòu)與六軸工業(yè)機器人腕部關(guān)節(jié)類似。若按照四自由度機器人分析，則會出現(xiàn)在運動學(xué)模型中不能準確表示臂長等參數(shù)的問題，所以把機器人末端刀具的轉(zhuǎn)動作為其第五自由度，將該機器人作為五自由度機器人進行正運動學(xué)分析更加準確。

本文采用建立D-H坐標系的方法分析螺旋槳加工機器人運動學(xué)，從而確定機器人各關(guān)節(jié)的位姿及聯(lián)系。對圖1所示的機器人采用改進D-H法建立其廣義連桿坐標系[6]，如圖3所示，定義螺旋槳加工機器人Z方向移動關(guān)節(jié)為第一關(guān)節(jié)，關(guān)節(jié)變量為d1；Y方向移動關(guān)節(jié)為第二關(guān)節(jié)，關(guān)節(jié)變量為d2；腰部轉(zhuǎn)動關(guān)節(jié)為第三關(guān)節(jié)，關(guān)節(jié)變量為 θ3；機械臂擺動關(guān)節(jié)為第四關(guān)節(jié)，關(guān)節(jié)變量為 θ4；末端刀具為第五偽關(guān)節(jié)，關(guān)節(jié)變量為 θ5。

圖 3 機器人 D-H 坐標系

根據(jù)機器人結(jié)構(gòu)和坐標系可得D-H參數(shù)如表1所示。其中：i為連桿標號，ai-1表示相連關(guān)節(jié)軸之間的距離即連桿長度， αi-1表示連桿扭轉(zhuǎn)角， θi表示關(guān)節(jié)角，di表示連桿偏距。

表1 螺旋槳加工機器人D-H參數(shù)

2.2 正向運動學(xué)

正運動學(xué)是在已知螺旋槳加工機器人各關(guān)節(jié)變量來求解機器人末端刀具參考坐標系的位置和姿態(tài)[7]。建立相鄰連桿兩坐標系的變換，齊次變換矩陣由4 個連桿參數(shù)構(gòu)成，可以用來表示{i}坐標系在{i-1}坐標系中的位姿，一般表達式如下。

式中： cθi=cos(θi)，sθi=sin(θi)，cαi-1=cos(αi-1),sαi-1=sin(αi-1)。利用表1中的機器人D-H參數(shù)和式（1），可以求出相鄰兩關(guān)節(jié)坐標系之間的齊次變換矩陣如下所示。

則機器人末端刀具參考點相對于基坐標系的齊次變換矩陣為

式（2）中：

機器人的位置與姿態(tài)參數(shù)如表2所示。

表2 位姿矩陣參數(shù)

機器人末端刀具參考點在基坐標系中的位置用TP表示，TR則表示其在基坐標系中的姿態(tài)。

2.3 逆向運動學(xué)

機器人的逆向運動學(xué)用于將機器人的末端刀具位姿信息傳輸?shù)綑C器人控制中心，通過驅(qū)動程序?qū)C器人末端刀具的軌跡進行規(guī)劃和優(yōu)化，并且將各關(guān)節(jié)的未知量信息以脈沖的形式傳輸?shù)娇刂浦行?，以此來控制機器人各關(guān)節(jié)的變化[8]。因此，求機器人運動學(xué)逆解就是已知機器人末端刀具坐標系的位置和姿態(tài)，計算滿足要求的機器人關(guān)節(jié)角或者連桿偏距。

很多專家學(xué)者對機器人逆向運動學(xué)進行了研究，并且探索出了很多求機器人運動學(xué)逆解的方法，比如反變換法、幾何法、解析法和數(shù)值法等，各種方法都有自己的適用范圍。經(jīng)比較，解析法求解速度更快、準確度更高，而且本文設(shè)計的機器人關(guān)節(jié)較多，采用解析法求取機器人逆解更為合適。

螺旋槳加工機器人機械臂末端刀具旋轉(zhuǎn)角度θ5對機器人末端刀具在基坐標系中的位置姿態(tài)沒有影響，機器人末端刀具位姿信息取決于前面4個關(guān)節(jié)變量，因此可以將5個關(guān)節(jié)變量的求解簡化為前4個關(guān)節(jié)變量的求解過程。逆運動學(xué)求解公式為

式 中 ：nx、ny、nz、ox、oy、oz、px、py、pz是 機器人末端刀具的信息，都是已知量。將上述逆運動學(xué)求解公式左乘逆矩陣進行變量分離，就可以求解出各個關(guān)節(jié)變量的轉(zhuǎn)角。得到下列矩陣方程式

各關(guān)節(jié)變量求解結(jié)果為

因為螺旋槳加工機器人整體結(jié)構(gòu)由移動關(guān)節(jié)和轉(zhuǎn)動關(guān)節(jié)組成，并且關(guān)節(jié)角的變化范圍比較有限，所以不存在多組解和奇異位姿。

3 仿真驗證

3.1 正運動學(xué)仿真

插銑機器人仿真使用Matlab及其機器人工具箱模塊，給定工作空間限制范圍和各關(guān)節(jié)初始值就可以得到機器人的仿真模型，其效果如圖4所示。

圖 4 機器人仿真模型

在圖4的基坐標系中，X方向為機器人的機械臂上下豎直擺動的方向，Y方向為機器人的進給方向，Z方向為機器人左右水平移刀的方向。用teach函數(shù)來調(diào)節(jié)關(guān)節(jié)變量，模擬機器人末端刀具達到擬定加工位置，驗證了機器人運動學(xué)模型的正確性。

3.2 機器人工作空間分析

機器人的工作空間是指機器人末端刀具參考點所能到達的范圍，它體現(xiàn)了機器人加工系統(tǒng)的工作區(qū)域范圍大小，是衡量機器人設(shè)計是否可行的最直觀依據(jù)之一[9]。

蒙特卡洛法求解工作空間具有簡單、準確和快速的優(yōu)點[10]。當機器人所有關(guān)節(jié)都在其關(guān)節(jié)變量范圍內(nèi)隨機取值一次后，根據(jù)機器人正運動學(xué)模型，可以算出一個相對應(yīng)的機器人末端刀具參考點的位置[11]。經(jīng)過多次的取值計算，末端刀具參考點所達到的位置的集合就是此機器人的工作空間。

機器人設(shè)計是否可行的標準之一就是看機器人是否滿足加工對象的加工范圍。本文所設(shè)計的機器人加工范圍是大型螺旋槳整個葉片，因此只需要保證機器人工作空間可以將目標加工區(qū)域完全包容，則說明所設(shè)計的機器人可以滿足大型螺旋槳的加工范圍。本文用最直觀的曲面擬合與空間包容的方法進行驗證。首先從三維模型中將要加工的螺旋槳槳葉導(dǎo)出，通過Matlab進行曲面擬合，并且將擬合出來的結(jié)果放到機器人的工作空間結(jié)果中進行比對，觀察工作空間是否能將待加工槳葉完全包絡(luò)。圖5為螺旋槳加工機器人的工作空間點云圖以及螺旋槳葉片曲面擬合圖。

為更直觀判斷所設(shè)計的機器人工作空間是否滿足所需，將機器人工作空間及螺旋槳葉片曲面圖分別在xoy、xoz、yoz平面內(nèi)進行投影，所得如圖5～7所示。

從圖5～8可以直觀看出本文設(shè)計的螺旋槳加工機器人在Z和Y方向是滿足工作需求的，X方向為機械臂擺動方向加工完當前區(qū)域后，螺旋槳轉(zhuǎn)動4次即可加工完整片槳葉，所以機器人工作空間滿足加工要求。

圖 5 機器人工作空間空間及槳葉曲面圖

圖 6 xoy 平面投影圖

圖 7 xo z平面投影圖

圖 8 yo z平面投影圖

3.3 機器人軌跡規(guī)劃及驗證

機器人的軌跡規(guī)劃分為關(guān)節(jié)空間軌跡規(guī)劃和笛卡爾空間軌跡規(guī)劃。其中，關(guān)節(jié)空間軌跡規(guī)劃是以關(guān)節(jié)角的函數(shù)來描述軌跡的軌跡生成方法，能比較直觀地看出機器人的運動情況。

在關(guān)節(jié)空間的軌跡規(guī)劃中，利用jtraj函數(shù)寫入機器人初始位置和加工中末位置的關(guān)節(jié)角，并且設(shè)置好時間，即可得到機器人各個關(guān)節(jié)和末端刀具的位移、速度圖像。為了區(qū)分顯示末端刀具，將末端刀具的初末位置設(shè)定成不變，在圖像中顯示為1條直線，結(jié)果如圖9～10所示。

圖 9 各關(guān)節(jié)位移隨時間變化圖

圖 10 各關(guān)節(jié)速度隨時間變化圖

為驗證Matlab中軌跡規(guī)劃的正確性，將機器人三維結(jié)構(gòu)模型導(dǎo)入到Adams中，設(shè)置機器人材料，添加運動副，用step函數(shù)驅(qū)動，設(shè)置路徑跟Matlab中相同。機器人末端刀具在此路徑下的軌跡如圖11所示。

圖 11 機器人末端刀具軌跡

用移動平臺質(zhì)心的位移和速度代表第一關(guān)節(jié)的位移和速度、回轉(zhuǎn)臺的位移和速度代表第二關(guān)節(jié)的位移和速度，以此類推，得到機器人關(guān)節(jié)的位移和速度變化曲線如圖12和圖13所示。

圖 12 機器人各關(guān)節(jié)位移圖像

圖 13 機器人各關(guān)節(jié)速度圖像

圖12和圖13中，0～3 s是機器人位姿初始化過程，3～7 s為按設(shè)定路徑工作過程。對照圖8和圖9，因為在Adams中的坐標系跟Matlab中的不同，時間設(shè)定也不一致，所以位移和速度圖像在方向等細節(jié)上會有所差別，但是在變化趨勢上基本相同：位移從開始到結(jié)束都是平緩的增加，速度呈現(xiàn)出對稱的光滑曲線，先增大后減小。在3～7 s中，在機器人從初始位置到終止位置的運動過程中，無論是位移還是速度曲線都比較平滑，變化都比較平緩，沒有發(fā)生突變，說明所設(shè)計的機器人在粗加工過程中可以滿足實際插銑加工要求。

4 結(jié)語

（1）本文從機器人設(shè)計需求和加工方法入手，在粗加工階段提出了插銑加工方法。分析裝備自由度，設(shè)計出一種基于插銑的四自由度機器人加工方案，用盡可能少的自由度設(shè)計機器人來實現(xiàn)對大型螺旋槳葉片的加工，避免了冗余關(guān)節(jié)自由度對機器人剛度的影響，并且在保證粗加工的加工質(zhì)量基礎(chǔ)上大幅提高了螺旋槳的加工效率。

（2）采用改進D-H法對螺旋槳加工機器人進行運動學(xué)建模，將機器人末端刀具視為機器人的偽自由度，求得機器人末端刀具參考點相對于基坐標系的正運動學(xué)解；根據(jù)運動學(xué)模型在已知末端刀具參考點位姿的情況下，求得機器人的各關(guān)節(jié)角，即求得機器人逆運動學(xué)的解。

（3）在Matlab機器人工具箱模塊中，建立了機器人仿真模型，驗證了建立的機器人運動學(xué)模型的正確性；在運動學(xué)模型的基礎(chǔ)下，用蒙特卡洛法取大量隨機值求解出機器人的工作空間，將擬合出的目標工件曲面放至工作空間中，驗證了本文設(shè)計的機器人滿足大型螺旋槳槳葉的加工范圍；在確定機器人初末位置的條件下，對機器人進行關(guān)節(jié)空間的軌跡規(guī)劃，得到了各個關(guān)節(jié)位移、速度與時間之間的關(guān)系，并且通過Adams仿真軟件，基于虛擬樣機對機器人的軌跡規(guī)劃進行驗證，兩者軌跡大致相同。仿真驗證的過程說明了機器人結(jié)構(gòu)方案的合理性，同時也為后續(xù)的機器人動力學(xué)分析等方面研究做了鋪墊。