慶毅輝 王淑青,2 張子蓬,2 周喜悅

(1. 湖北工業(yè)大學(xué)，湖北 武漢 430068；2. 武漢奮進(jìn)智能機器有限公司，湖北 武漢 430205)

中國白酒歷史悠久，獨特的釀造工藝造就其獨具一格的風(fēng)味[1]。發(fā)酵后酒醅的上甑操作直接決定固態(tài)蒸餾的好壞，影響白酒的出酒率和質(zhì)量。傳統(tǒng)的上甑操作由人工探氣上甑，一層層地將釀酒原料輕撒均鋪，其工作強度大、環(huán)境差[2]。半自動化上甑技術(shù)解決了人工上料強度大的問題，有效降低了人工成本，但存在甑筒內(nèi)鋪料不均的問題，需人工不斷地碼平。因此，釀酒行業(yè)急需一批完全代替人工上甑的專用型機器人。上甑機器人大體分為通用式與旋轉(zhuǎn)式兩類，通用式利用多關(guān)節(jié)機器人及末端的撒料裝置可實現(xiàn)多區(qū)域鋪料[3]，但較難實現(xiàn)不間斷鋪料，且對跑氣點補料速度慢[4]。旋轉(zhuǎn)式上甑機器人因其特殊結(jié)構(gòu)，內(nèi)嵌物料輸送腔并裝有布料頭等特殊裝置，通用式上甑機器人可實現(xiàn)連續(xù)性均勻鋪料且補料快，是上甑機器人未來的主要研究發(fā)展對象。試驗擬針對旋轉(zhuǎn)式上甑機器人的運動學(xué)模型及軌跡進(jìn)行研究，通過改進(jìn)Denavit-Hartenberg法建立其正運動學(xué)模型，解析其逆解表達(dá)式并加以驗證，旨在為后續(xù)運動控制及工作空間仿真提供依據(jù)。

1 上甑機器人的運動學(xué)

1.1 結(jié)構(gòu)分析

旋轉(zhuǎn)式上甑機器人結(jié)構(gòu)及其等效關(guān)節(jié)分布如圖1所示。為了將釀酒原料逐層、均勻地撒至甑筒內(nèi)，該機器人設(shè)計4個旋轉(zhuǎn)關(guān)節(jié)，分別為大臂旋轉(zhuǎn)關(guān)節(jié)(Jiont1)、大臂俯仰關(guān)節(jié)(Jiont2)、小臂旋轉(zhuǎn)關(guān)節(jié)(Jiont3)與小臂擺動關(guān)節(jié)(Jiont4)。

圖1 旋轉(zhuǎn)式上甑機器人結(jié)構(gòu)設(shè)計Figure 1 Structural design drawing of rotary upper-retort-robot

為簡化運動學(xué)模型，通過改進(jìn)Denavit-Hartenberg法對特定型號的上甑機器人進(jìn)行坐標(biāo)系建立，如圖2所示。坐標(biāo)系{i}的原點為Jionti軸線和Jionti+1軸線相交點，若Jionti軸線和Jionti+1軸線不相交，則規(guī)定公垂線與Jionti軸線的交點為原點。令Zi軸沿Jionti軸線指向，Xi軸沿Jionti軸線和Jionti+1軸線的公垂線指向，若Jionti軸線和Jionti+1軸線相交，則規(guī)定Xi軸垂直于Jionti軸線和Jionti+1軸線的所在平面。初始狀態(tài)下，設(shè)定參考坐標(biāo)系{0}與坐標(biāo)系{1}重合[5]。相應(yīng)的連桿參數(shù)見表1。

表1 上甑機器人連桿參數(shù)?Table 1 Connecting rod parameters of the upper-retort-robot

圖2 上甑機器人坐標(biāo)系Figure 2 Coordinate system of the upper-retort-robot

1.2 正運動學(xué)分析

在以θi為變量，坐標(biāo)系{i-1}至坐標(biāo)系{i}的變換矩陣的一般表達(dá)式為[6]：

(1)

(5)

(6)

(7)

其中，si=sin(θi)，ci=cos(θi)，式(7)構(gòu)成了上甑機器人運動學(xué)模型。在Matlab環(huán)境下使用RTB工具箱建立機器人模型，使用fkine(q)函數(shù)計算關(guān)節(jié)角度變量qa[pi/6，pi/9，-pi/4，0]和qb[-pi/3，-pi/9，pi/3，pi/6]兩種不同位形的運動學(xué)正解T1和T2[8]。

(8)

(9)

將qa、qb代入式(7)，求得結(jié)果與式(8)、(9)相同，證明了所建上甑機器人模型的正確性[9]。

1.3 逆運動學(xué)分析

(10)

規(guī)定L(i，j)與R(i，j)描述等式左右對應(yīng)的i行j列元素，根據(jù)L(2，4)與R(2，4)相等可得：

θ1=Atan(py/px)。

(11)

聯(lián)立L(1，4)=R(1，4)與L(3，4)=R(3，4)可得：

(12)

(13)

根據(jù)L(2，2)=R(2，2)、L(2，3)=R(2，3)可得：

θ3=Acos(k2),θ4=Asin(k3/s3)。

(14)

其中k2=c1r23-s1r13,k3=c1r22-s1r12。將上述矩陣T2中對應(yīng)元素代入式(11)、(12)、(14)，所得關(guān)節(jié)角度與qb相同，證明了逆解表達(dá)式的正確性。

2 上甑機器人工作空間分析

明確上甑機器人末端執(zhí)行器所能到達(dá)的位置，可為后續(xù)發(fā)酵車間的整體設(shè)備布局提供依據(jù)。在定義上述運動變換時，認(rèn)為上甑機器人的原點位于大臂俯仰機構(gòu)，即坐標(biāo)系{2}的原點，為使模型完整并分析工作空間，進(jìn)行基座變換，將機器人的原點轉(zhuǎn)移至與地面相連的底座下端部，將式(7)中pz表達(dá)式進(jìn)行替換，以改進(jìn)運動學(xué)模型：

(15)

式中：

1 875——坐標(biāo)系{2}的原點距離底座下端部的距離，mm。

式(16)為上甑機器人的運動學(xué)方程，可描述Jiont4固連的坐標(biāo)系{4}的位置和姿態(tài)。

(16)

對于上甑機器人需定義一個工具變換，反映布料頭裝置(末端執(zhí)行器)的頂端相對于坐標(biāo)系{4}的變換，采用的布料頭裝置頂端沿坐標(biāo)系{4}的y軸延伸了845 mm，其坐標(biāo)系模型見圖3，其中Xtool與Ztool為固連布料頭坐標(biāo)系的X軸與Z軸。

圖3 坐標(biāo)系模型Figure 3 Coordinate system model

隨后采用Monte-Carlo法，在各關(guān)節(jié)的變化范圍內(nèi)隨機產(chǎn)生關(guān)節(jié)變量，結(jié)合正運動學(xué)模型，計算得到上甑機器人的工作空間[10]，并為后續(xù)的軌跡生成提供參考，工作空間投影見圖4。

圖4 上甑機器人工作空間Figure 4 Working space of upper-retort-robot

對于半徑1 600 mm、高2 000 mm的甑筒，根據(jù)3個平面的上料范圍投影及相對上甑機器人的位置，可確定上甑機器人能完成全覆蓋的整層鋪料任務(wù)。

3 上甑機器人的軌跡生成

為使布料頭平滑地移動，需進(jìn)行軌跡生成，以保證快速移至跑氣點[11]。采用混合曲線法通過拋物線過渡線性函數(shù)生成平滑運動軌跡，可根據(jù)期望速度提供勻速控制[12]。該方法在給定參數(shù)下的最大速度：

(17)

式中：

θ1、θ2——初始位置與終止位置的角度，°；

(18)

設(shè)定上甑機器人的初始位置為qc[pi/6，pi/12，0，0]，終止位置為qd[pi/3，pi/9，0，0]，混合曲線法生成軌跡曲線如圖5所示。

由圖5可知，混合曲線法在具有初始速度情況下，不存在角位移中間值超過終止值的情況，且平均速度高。實際系統(tǒng)中，混合曲線法占用硬件資源較少，加速度突變造成的機器人震動在允許范圍內(nèi)，適用于對精度要求不高的上甑機器人驅(qū)動。

圖5 軌跡曲線Figure 5 Track curve

4 結(jié)論

試驗建立了上甑機器人的運動學(xué)模型，并驗證了正逆解的正確性。結(jié)合改進(jìn)運動學(xué)模型，對上甑機器人工作范圍進(jìn)行了仿真計算，確定了機器人可對具體尺寸甑筒全覆蓋的整層鋪料，同時說明了上甑機器人連桿參數(shù)合理。在關(guān)節(jié)具有一定初始速度的情況下，利用混合曲線法生成軌跡，并根據(jù)結(jié)果確定該方法適用于上甑機器人。但由于上甑機器人控制的復(fù)雜性，后續(xù)應(yīng)深入研究其動力學(xué)模型，提高軌跡跟蹤控制精度并應(yīng)用至實際系統(tǒng)。