杜金財，尹建軍，賀 坤，余成超

(江蘇大學(xué) 現(xiàn)代農(nóng)業(yè)裝備與技術(shù)教育部重點(diǎn)實(shí)驗(yàn)室，江蘇 鎮(zhèn)江 212013)

0 引言

水果產(chǎn)業(yè)已經(jīng)躍居農(nóng)作物排行榜的第3位[1]，葡萄作為水果產(chǎn)業(yè)的一種得到大家的廣泛喜愛。但是，葡萄采摘的季節(jié)性強(qiáng)、勞動強(qiáng)度大、成本高，成為了農(nóng)業(yè)生產(chǎn)鏈中最費(fèi)時費(fèi)力的環(huán)節(jié)；再加上人口老齡化問題及農(nóng)村勞動力流失等問題，使得從事農(nóng)業(yè)生產(chǎn)的勞動力越來越少。因此，自動化采摘作業(yè)已經(jīng)成為設(shè)施農(nóng)業(yè)生產(chǎn)發(fā)展中的迫切需要[2-4]。

國內(nèi)外對于水果采摘機(jī)器人的設(shè)計(jì)已投入大量科研力量。早期日本近藤(KONTO)[5]等研制的番茄采摘機(jī)器人，采用了7自由度機(jī)械臂，成功率為70%左右，采摘速度大約是15s/個。但該機(jī)械手無法避開葉莖障礙物，被葉莖遮擋的成熟番茄未被采摘，需要在結(jié)構(gòu)和避障等方面加以改進(jìn)。荷蘭IMAG研究所[6]開發(fā)了一種7自由度關(guān)節(jié)型機(jī)械臂，可實(shí)現(xiàn)收獲與摘葉同時進(jìn)行，采摘速度為45s/根，采摘成功率為80%。我國開展水果采摘機(jī)器人的研究時間較晚，但目前科研力度的投入及成果已步入世界前列。桂林電子科技大學(xué)伍錫如、黃國明[7]等進(jìn)行了新型蘋果采摘機(jī)器人的設(shè)計(jì)與試驗(yàn)，采摘成功率為91.31%，平均采摘周期約為29s。中國農(nóng)業(yè)大學(xué)李偉[8]等開發(fā)的4自由度關(guān)節(jié)型機(jī)械臂平均采摘周期為28s，采摘成功率為86%；但視覺識別中陰影、遮擋、亮斑影響較大，末端執(zhí)行器對較粗果梗無法剪斷或容易造成果實(shí)的掉落。對于棚架栽培草莓的采摘，國家農(nóng)業(yè)智能裝備工程中心的馮青春[9]等研發(fā)了一種6自由度的關(guān)節(jié)式機(jī)械臂與雙目視覺系統(tǒng)，平均采摘周期為22.3s，成功采摘周期為31.3s。郭素娜、張麗、劉志剛[10]等基于自主導(dǎo)航設(shè)計(jì)了一種6自由度葡萄采摘機(jī)器人，采用CAN(Controller Area Network)總線對運(yùn)動進(jìn)行控制，對葡萄樹的準(zhǔn)確識別率達(dá)到95%以上，對成熟葡萄的識別率達(dá)到98%以上。盡管對于采摘機(jī)器人的研究取得了重大的進(jìn)步，但同時也存在著結(jié)構(gòu)與控制復(fù)雜、制造成本高及采摘周期長等問題。

針對上述問題，筆者進(jìn)行了葡萄采摘機(jī)器人機(jī)械臂各部分的結(jié)構(gòu)設(shè)計(jì)，通過SolidWorks軟件建立了葡萄采摘機(jī)器人機(jī)械臂的三維整體構(gòu)造模型，利用Matlab與ADAMS進(jìn)行運(yùn)動學(xué)與動力學(xué)仿真，根據(jù)仿真內(nèi)容進(jìn)行基于時間的運(yùn)動及動力分析，為葡萄采摘機(jī)器人機(jī)械臂的電機(jī)選型、調(diào)試和實(shí)際操作提供了依據(jù)。

1 葡萄采摘機(jī)械臂的結(jié)構(gòu)設(shè)計(jì)

1.1 構(gòu)型與自由度的選擇

以籬架整枝的食用葡萄為采摘對象，葡萄植株成行種植，一般位于距地面高1～1.8m之間，行距4～6m；植株行之間的壟道即為作業(yè)道，葡萄距AGV(Automated Guided Vehicle)小車位置為0.4～0.5m之間。由于小車可以實(shí)現(xiàn)前后移動，規(guī)定機(jī)械臂可采摘縱向深度為0.4m，則機(jī)械臂需要達(dá)到的工作空間為(0.5×0.4×0.8)m3。

機(jī)械臂的作用是為了通過編程使末端執(zhí)行器運(yùn)動到指定位置完成采摘[11]?；诮Y(jié)構(gòu)簡單、易于控制的要求，葡萄采摘機(jī)械臂采用4 DOF(Degree of Freedom)關(guān)節(jié)型?；谥锌兆呔€要求、結(jié)構(gòu)的穩(wěn)定性及制造成本的高低，采用雙連桿薄壁結(jié)構(gòu)，一側(cè)驅(qū)動，另一側(cè)走線，并對每個關(guān)節(jié)進(jìn)行穿線孔設(shè)計(jì)。

圖1為本文設(shè)計(jì)的具有4自由度的關(guān)節(jié)型機(jī)械臂結(jié)構(gòu)圖。該機(jī)械臂主要由腰關(guān)節(jié)、肩關(guān)節(jié)、肘關(guān)節(jié)和腕關(guān)節(jié)4部分組成，其工作原理設(shè)計(jì)為：腰關(guān)節(jié)通過底板與AGV小車相連，腕關(guān)節(jié)通過連接卡盤與末端執(zhí)行器連接，當(dāng)AGV小車接收到采摘命令運(yùn)動到目標(biāo)位置時，機(jī)械臂按規(guī)劃好的路徑通過腰關(guān)節(jié)、肩關(guān)節(jié)及肘關(guān)節(jié)的旋轉(zhuǎn)將末端執(zhí)行器輸送到指定位置，然后通過腕關(guān)節(jié)的旋轉(zhuǎn)調(diào)整末端執(zhí)行器的姿態(tài)，完成采摘要求，最后回到初始位置。

1.腰關(guān)節(jié) 2.肩關(guān)節(jié) 3.肘關(guān)節(jié) 4.腕關(guān)節(jié)

1.2 基于中空走線要求的關(guān)節(jié)結(jié)構(gòu)設(shè)計(jì)

以腰關(guān)節(jié)與肩關(guān)節(jié)的結(jié)構(gòu)設(shè)計(jì)為例，圖2為本文機(jī)械臂設(shè)計(jì)中腰關(guān)節(jié)與肩關(guān)節(jié)的結(jié)構(gòu)圖。其中心基座固定在底板上，與AGV小車固連；腰關(guān)節(jié)電機(jī)通過腰關(guān)節(jié)小圓柱齒輪將動力傳遞到大圓柱齒輪，進(jìn)而帶動腰關(guān)節(jié)動力法蘭盤以及U型架的旋轉(zhuǎn)，實(shí)現(xiàn)腰關(guān)節(jié)的回轉(zhuǎn)運(yùn)動。肩關(guān)節(jié)主要包括動力模塊和從動模塊兩部分：動力模塊為電機(jī)通過驅(qū)動動力法蘭盤進(jìn)而帶動主動臂運(yùn)動，實(shí)現(xiàn)肩關(guān)節(jié)的仰俯；從動模塊為法蘭盤借助軸承與從動臂相連，從而使從動臂與主動臂實(shí)現(xiàn)同步運(yùn)動。腰關(guān)節(jié)、肩關(guān)節(jié)、肘關(guān)節(jié)、腕關(guān)節(jié)均設(shè)有中心穿線孔，其電機(jī)電源線與數(shù)據(jù)線及末端執(zhí)行器電機(jī)和傳感器的電源線與數(shù)據(jù)線均從中心穿線孔穿過，接入到AGV小車內(nèi)部。

1.腰關(guān)節(jié)電機(jī) 2.腰關(guān)節(jié)穿線孔 3.中心基座 4.底板 5.腰關(guān)節(jié)大圓柱齒輪 6.腰關(guān)節(jié)動力法蘭盤 7.U型架 8.肩關(guān)節(jié)動力模塊 9.肩關(guān)節(jié)軸 10.肩關(guān)節(jié)電機(jī) 11.肩關(guān)節(jié)從動模塊 12.肩關(guān)節(jié)穿線孔 13.腰關(guān)節(jié)小圓柱齒輪

2 4-DOF關(guān)節(jié)型采摘機(jī)械臂的運(yùn)動學(xué)設(shè)計(jì)

機(jī)械臂運(yùn)動學(xué)研究的是各關(guān)節(jié)的變量與末端執(zhí)行器在空間上的位置、姿態(tài)之間的關(guān)系，并為后期的機(jī)械臂軌跡規(guī)劃提供良好的理論依據(jù)和研究方法[12],主要分為正運(yùn)動學(xué)及逆運(yùn)動學(xué)兩大類問題。其中，正運(yùn)動學(xué)是解決已知各連桿的幾何關(guān)系及關(guān)節(jié)角矢量，求末端執(zhí)行器相對于基坐標(biāo)系的位置的姿態(tài)問題；逆運(yùn)動學(xué)是解決已知末端執(zhí)行器相對于基坐標(biāo)系的位置和姿態(tài)，求滿足運(yùn)動到指定位置和姿態(tài)時各連桿的幾何關(guān)系及關(guān)節(jié)角矢量[13]。

2.1 機(jī)械臂連桿坐標(biāo)系

本文中的4自由度關(guān)節(jié)型串聯(lián)機(jī)械臂由腰關(guān)節(jié)、肩關(guān)節(jié)、肘關(guān)節(jié)及腕關(guān)節(jié)組成，且4個關(guān)節(jié)均為旋轉(zhuǎn)關(guān)節(jié)。為了完成該機(jī)械臂數(shù)學(xué)模型的建立，利用D-H表示法[14]來對機(jī)械臂的各關(guān)節(jié)添加參考坐標(biāo)系。同時，為使運(yùn)算簡單，將第1關(guān)節(jié)坐標(biāo)系與基坐標(biāo)系重合，建立機(jī)械臂的連桿坐標(biāo)系，如圖3所示。

其中，確定Zi軸的基本原則是Zi軸沿關(guān)節(jié)i的軸向；確定原點(diǎn)Oi的基本原則是Oi在過Zi和Zi+1軸的公垂線上；確定Xi軸的基本原則是Xi沿過Zi和Zi+1軸的公垂線方向，由Zi指向Zi+1；如果Zi和Zi+1軸相交，Xi軸垂直于Zi和Zi+1軸所在的平面。連桿長度Li定義為：沿Xi軸、從Zi移動到Zi+1的距離；連桿轉(zhuǎn)角αi定義為：沿Xi軸、從Zi旋轉(zhuǎn)到Zi+1的角度；關(guān)節(jié)偏距di定義為：沿Zi軸由Xi移動到Xi+1的距離；關(guān)節(jié)轉(zhuǎn)角θi定義為：沿Zi軸由從Xi-1旋轉(zhuǎn)到Xi的角度。

圖3 機(jī)械臂的連桿坐標(biāo)系

2.2 采摘機(jī)械臂關(guān)節(jié)參數(shù)確定

前面已經(jīng)對全部連桿規(guī)定坐標(biāo)系，按由兩個旋轉(zhuǎn)和兩個平移順序來建立相鄰兩連桿i-1與i之間的相對關(guān)系[15]。這種關(guān)系可由表示連桿i對連桿i-1相對位置的4個齊次變換來描述，稱作Ai矩陣。此關(guān)系式為

Ai=Rot(z,θi)Trans(0,0,di)Trans(αi,0,0)Rot(x,αi)

(1)

機(jī)械手的末端裝置即為連桿4的坐標(biāo)系，它與連桿i-1坐標(biāo)系的關(guān)系可由i-1T4表示為

i-1T4=AiAi+1...A4

可得連桿變換通式為

(2)

機(jī)械臂末端執(zhí)行器的坐標(biāo)系相對于基座標(biāo)系的變換矩陣為

(3)

其中，c1=cosθ1，s1=sinθ1，c23=cos(θ2+θ3)，s23=sin(θ2+θ3)，以此類推。

2.3 機(jī)械臂關(guān)節(jié)參數(shù)的確定

1)各關(guān)節(jié)轉(zhuǎn)角范圍的確定。腰關(guān)節(jié)的作用是為了使機(jī)械臂實(shí)現(xiàn)回轉(zhuǎn)運(yùn)動來達(dá)到采摘要求，理論上可取±180°，但實(shí)際裝配中考慮到雙目攝像頭的存在，故取轉(zhuǎn)角范圍為±170°；腕關(guān)節(jié)是為了調(diào)整末端執(zhí)行器的位姿，故其轉(zhuǎn)角范圍取±180°；由于葡萄采摘為高空作業(yè)，故肩關(guān)節(jié)轉(zhuǎn)角范圍取0°～90°；因要保持末端執(zhí)行器水平采摘要求，根據(jù)幾何關(guān)系知肘關(guān)節(jié)轉(zhuǎn)角范圍為-90°～0°。

2)各連桿長度的確定。為了滿足機(jī)械臂工作空間為(500×400×800)mm3的采摘要求，結(jié)合機(jī)械臂的連桿坐標(biāo)系以及轉(zhuǎn)角范圍可得不等式為

(4)

實(shí)際裝配時，腕關(guān)節(jié)長度a3和腰關(guān)節(jié)的高度d1與安裝尺寸要求有關(guān)，取a3=310mm，d1=370mm。由式(4)可得：a2的取值范圍為a2>255.69mm，可取a2=300mm，通過工作空間進(jìn)行驗(yàn)證是否滿足采摘要求。

2.4 采摘機(jī)械臂的工作空間驗(yàn)證

對于求解機(jī)器人機(jī)械臂工作空間的方法主要有解析法、數(shù)值法及圖解法。解析法是通過奇異曲面推導(dǎo)出工作空間界限曲面，是通過代數(shù)方法求解，但該方法十分繁瑣且直觀性不強(qiáng)。圖解法是通過幾何作圖原理求出工作空間剖切面，這種方法雖然直觀性強(qiáng)，但當(dāng)機(jī)械臂自由度增加時分析就變得復(fù)雜了。數(shù)值法是以優(yōu)化方法與極值理論為基礎(chǔ)，按一定的規(guī)律選取盡可能多的關(guān)節(jié)變量組合，末端執(zhí)行器參考點(diǎn)坐標(biāo)值構(gòu)成的邊界曲面就為機(jī)械臂的工作空間[16]。數(shù)值法主要包括迭代法、搜索法及蒙特卡洛法。

采用的求解機(jī)械臂工作空間的方法為數(shù)值法里的蒙特卡洛法[17]，是一種基于隨機(jī)數(shù)的計(jì)算機(jī)模擬法。工作原理為：給它一個數(shù)學(xué)問題，首先構(gòu)造一個概率過程，使其某些參數(shù)為所求問題的解；然后，根據(jù)生成的已知概率分布的隨機(jī)變量計(jì)算所求參數(shù)的統(tǒng)計(jì)特征；最后，求得所求問題的解，通常求得的解為在規(guī)定誤差范圍內(nèi)的近似解。

利用數(shù)值算法，在MatLab中編寫簡單的程序進(jìn)行工作空間的仿真。N值越大，生成的機(jī)械臂的工作空間點(diǎn)越多，得到的工作空間越精確，工作空間邊界越清晰?？紤]到仿真速度的影響，選取樣本n=1000，得到機(jī)械臂的工作空間三維點(diǎn)云圖及工作空間分別在xoy、xoz、yoz平面上的投影圖，如圖4所示。

圖4 機(jī)械臂工作空間點(diǎn)云圖

由圖4可知：機(jī)械臂的工作空間近似為一個橢球體，且因?yàn)楣ぷ鞣秶募s束，該橢球體存在一個扇形的缺口，還有一個靠近z軸的空心區(qū)域。此空心區(qū)域是由于機(jī)械尺寸的限制，對實(shí)際的采摘效果沒有影響。該工作空間覆蓋了機(jī)械臂所要求的(0.5×0.4×0.8)m3的任務(wù)空間，獲得的采摘機(jī)械臂D-H參數(shù)如表1所示。

3 采摘機(jī)械臂末端沿直線軌跡運(yùn)動的路徑規(guī)劃

3.1 采摘機(jī)械臂逆運(yùn)動學(xué)建模

對于機(jī)械臂的逆運(yùn)動學(xué)求解，可以考慮依次將位姿矩陣的逆矩陣左乘機(jī)器人的運(yùn)動學(xué)方程，使矩陣的左右兩端只包含一個或兩個待求關(guān)節(jié)角度變量，通過對應(yīng)位置相等來求出各關(guān)節(jié)角度變量。

(5)

展開得

為使表達(dá)清楚，記(i,j)L為等式左邊矩陣的第i行第j列元素，(i,j)R為等式右邊矩陣的第i行第j列元素。根據(jù)式(5)的(2,4)L=(2,4)R，可得

c1py-s1px=d2=0

(6)

由式(6)可得

θ1=arctan2(py,px)

(7)

同理，可求出

由表1知，θ2只能取正值，則

(8)

θ3=-arccos(-az)-θ2

(9)

(10)

其中，式(7)～式(10)為機(jī)械臂運(yùn)動學(xué)逆解表示。

3.2 采摘機(jī)械臂逆運(yùn)動學(xué)仿真

借用Robotics Toolbox中的ikine( )函數(shù)，可以對機(jī)械臂逆運(yùn)動學(xué)進(jìn)行求解，調(diào)用格式為Qi=ikine(R,T,Q,M)。其中，R為機(jī)械臂對象，T為要求的反解變換矩陣，Q為初始點(diǎn)的關(guān)節(jié)向量，M與機(jī)械臂自由度有關(guān)。由于本文機(jī)械臂自由度小于6，所以M=[1 1 1 1 0 0 ]。為此，定義機(jī)械臂的初始位置A的關(guān)節(jié)向量q=[0 0 0 0]，要求的機(jī)械臂終點(diǎn)B的坐標(biāo)變換為

在MatLab中調(diào)用Qi=ikine(R,T,Q,M)函數(shù)，得到要求的機(jī)械臂終點(diǎn)B的關(guān)節(jié)向量qb=[-0.3491 0.5236 -0.6283 0]。然后，將終點(diǎn)B的齊次變換矩陣T的數(shù)值帶入到運(yùn)動學(xué)逆解中，求得關(guān)節(jié)向量相同，表明逆解求解正確。

3.3 采摘機(jī)械臂末端的直線路徑規(guī)劃

為提高采摘效率，基于路徑最短進(jìn)行如圖5(a)所示的末端直線路徑規(guī)劃：①采用插補(bǔ)法選取初始點(diǎn)到終止點(diǎn)之間的40個軌跡點(diǎn)；②為使關(guān)節(jié)運(yùn)動平緩，設(shè)置腰關(guān)節(jié)、肩關(guān)節(jié)、肘關(guān)節(jié)的角速度如圖5(b)所示，角加速度如圖5(c)所示；③利用MatLab/Robotics Toolbox中的jtraj函數(shù)進(jìn)行機(jī)械臂的空間直線軌跡規(guī)劃，獲得各關(guān)節(jié)角位移與軌跡點(diǎn)的關(guān)系。

jtraj函數(shù)調(diào)用格式為[q,qd,qdd] =jtraj(init_ang,targ_ang,step)，jtraj函數(shù)采用的是7次多項(xiàng)式插值算法，且默認(rèn)初始以及終止的速度為0。其中，q為從初始位置到終點(diǎn)位置的關(guān)節(jié)空間軌跡，qd為規(guī)劃軌跡運(yùn)動的關(guān)節(jié)角速度，qdd為規(guī)劃軌跡運(yùn)動的角加速度，init_ang為初始位置時各關(guān)節(jié)角度，targ_ang為終點(diǎn)位置時各關(guān)節(jié)角度，step為軌跡規(guī)劃點(diǎn)。本文取初始位置A的關(guān)節(jié)向量init_ang=[pi/3 -pi/4pi/6 0]，終點(diǎn)位置B的關(guān)節(jié)向量targ_ang=[-pi/9pi/6 -pi/5 0]。圖6為腰關(guān)節(jié)、肩關(guān)節(jié)、肘關(guān)節(jié)轉(zhuǎn)角與軌跡點(diǎn)數(shù)的曲線關(guān)系。

圖5 軌跡規(guī)劃條件圖

圖6 腰關(guān)節(jié)、肩關(guān)節(jié)、肘關(guān)節(jié)轉(zhuǎn)角與軌跡點(diǎn)數(shù)的曲線關(guān)系

通過軌跡規(guī)劃仿真，可以得到腰關(guān)節(jié)、肩關(guān)節(jié)、肘關(guān)節(jié)角位移與軌跡點(diǎn)數(shù)的曲線關(guān)系，為ADAMS虛擬樣機(jī)技術(shù)的機(jī)械臂采摘葡萄仿真提供依據(jù)。表2為腰關(guān)節(jié)、肩關(guān)節(jié)、肘關(guān)節(jié)部分軌跡點(diǎn)所對應(yīng)的角位移。

表2 腰關(guān)節(jié)、肩關(guān)節(jié)、肘關(guān)節(jié)部分角位移與軌跡點(diǎn)的關(guān)系

Table 2 The relationship between angular displacement and trajectory points of lumbar, shoulder, and elbow joints rad

4 基于虛擬樣機(jī)技術(shù)的機(jī)械臂采摘葡萄仿真

4.1 樣機(jī)的建立

為獲得樣機(jī)在采摘葡萄過程中的受力及運(yùn)動情況，為物理樣機(jī)的設(shè)計(jì)與制造提供各種參數(shù)依據(jù)(包括電機(jī)的選型)，借助虛擬樣機(jī)技術(shù)中的ADAMS[18-19]軟件來完成動力學(xué)的仿真。利用ADAMS進(jìn)行動力學(xué)仿真的一般步驟為：①通過solidwords進(jìn)行三維建模；②將三維模型導(dǎo)入到adams中；③進(jìn)行工作環(huán)境、零件屬性的設(shè)置；④添加約束、驅(qū)動、負(fù)載等，本文選取的負(fù)載為重2kg的葡萄；⑤進(jìn)行動力學(xué)仿真分析，得到輸出角速度、轉(zhuǎn)矩等曲線圖。

4.2 仿真與分析

模擬葡萄采摘情況，結(jié)合表2中腰關(guān)節(jié)、肩關(guān)節(jié)及肘關(guān)節(jié)軌跡點(diǎn)所對應(yīng)的角位移，通過添加step驅(qū)動函數(shù)，進(jìn)行葡萄采摘的動力學(xué)仿真。圖7、圖8為負(fù)載為2kg時末端執(zhí)行器的直線軌跡及數(shù)據(jù)。

圖7 Adams軌跡仿真實(shí)驗(yàn)Fig.7 Adams trajectory simulation experiment

圖8 4自由度機(jī)械臂模擬葡萄采摘虛擬樣機(jī)仿真數(shù)據(jù)

由圖8分析可知：①各關(guān)節(jié)運(yùn)動較平滑，無運(yùn)動沖擊，末端執(zhí)行器能夠按規(guī)定直線路徑到達(dá)指定位置；②各關(guān)節(jié)所需驅(qū)動力矩腰關(guān)節(jié)最大，腕關(guān)節(jié)最小。其中，腰關(guān)節(jié)所需最小驅(qū)動力矩約為95N·m，肩關(guān)節(jié)所需最小驅(qū)動力矩約為52N·m，肘關(guān)節(jié)所需最小驅(qū)動力矩約為48N·m，腕關(guān)節(jié)所需最小驅(qū)動力矩約為12N·m。

4.3 電機(jī)與減速器的確定

為使機(jī)械臂能夠按照規(guī)劃好的路徑進(jìn)行運(yùn)動，完成采摘要求，結(jié)合仿真所得各關(guān)節(jié)所需最小驅(qū)動力矩，進(jìn)行電機(jī)與減速器的選型。本文選擇安川伺服器與伺服電機(jī)進(jìn)行驅(qū)動，并配套以行星齒輪減速器。表3為本文所選伺服電機(jī)與減速器參數(shù)。

表3 伺服電機(jī)與減速器參數(shù)表

由表3知：腰關(guān)節(jié)電機(jī)輸出力矩是所需力矩的1.67倍，肩關(guān)節(jié)電機(jī)輸出力矩是所需力矩的2.44倍，肘關(guān)節(jié)電機(jī)輸出力矩是所需力矩的1.32倍，腕關(guān)節(jié)電機(jī)輸出力矩是所需力矩的2.65倍，滿足采摘要求，電機(jī)與減速器選型合理。

5 結(jié)論

1)基于中空走線要求設(shè)計(jì)了關(guān)節(jié)型4自由度葡萄采摘機(jī)械臂，應(yīng)用D-H法確定了滿足葡萄采摘空間要求的各關(guān)節(jié)參數(shù)。

2)應(yīng)用MatLab/Robotics Toolbox獲得機(jī)械臂末端走直線軌跡的各關(guān)節(jié)轉(zhuǎn)角，聯(lián)合ADAMS虛擬樣機(jī)技術(shù)仿真了機(jī)械臂末端夾持葡萄的采摘運(yùn)動過程，獲得夾持2kg葡萄時腰關(guān)節(jié)、肩關(guān)節(jié)及肘關(guān)節(jié)所需驅(qū)動力矩分別為95、52、48、12N·m，可指導(dǎo)關(guān)節(jié)驅(qū)動電機(jī)與減速器選型，為采摘機(jī)械臂的物理樣機(jī)制造與采摘試驗(yàn)提供技術(shù)參考。