仿蛇嘴咬合式柑橘采摘末端執行器設計與實驗

王 毅 許洪斌 張 茂 馬冀桐 劉 波 何 宇

(1.重慶大學機械工程學院， 重慶 400044； 2.重慶理工大學機械工程學院， 重慶 400054)

0 引言

采摘機器人的概念于1968年由SCHERTZ和BROWN提出后，世界各國學者對采摘機器人紛紛開展了研究[1-2]。但是，由于采摘機器人缺乏強大的果實識別能力和精確采摘能力，目前為止仍然處在實驗室階段[1,3]。末端執行器作為采摘機器人的一個關鍵部件，直接對果蔬進行操作，對果蔬的成功采摘起著關鍵作用，直接影響采摘機器人的采摘能力。

當前對末端執行器的研究，大多針對大棚中生長的水果和蔬菜[4-11]，針對室外環境的研究較少。在大棚中生長的水果和蔬菜，其生長狀態相對可控，對末端執行器的要求相對簡單。在室外環境中生長的果蔬，如柑橘，其生長情況是隨機的，對末端執行器要求更高。目前，末端執行器的采摘原理有利用剪刀剪斷果柄[7,12]、通過3根或4根手指抓住果實扭斷或切斷果柄[7，13-14]以及通過機構夾持住果實再切斷果柄[6,9,15]等。對于自然環境下生長的柑橘來說，果柄的生長方位是隨機的，在自然環境下較難通過視覺系統精確判斷每一個柑橘果實其果柄的空間方位信息。通過剪刀剪斷果柄的方式由于果柄空間方位信息未知則難以準確切斷果柄，通過手指扭斷果柄的方式容易在果柄與果實分離時造成果實表皮破損，通過夾持果實的方式則容易造成果實表面淤傷等問題。因此，對于柑橘采摘機器人來說，有必要設計一款對果實表面損傷較小、未知柑橘果柄空間方位就能進行采摘的末端執行器，以提高柑橘采摘機器人的采摘能力。

本文基于仿生學原理，模擬蛇嘴的咬合動作及其結構設計仿蛇嘴的咬合式末端執行器，對末端執行器進行運動學分析和仿真，研制末端執行器樣機并進行實驗室環境和室外環境的實驗驗證。

1 仿蛇嘴咬合式末端執行器結構設計

1.1 仿蛇嘴咬合式末端執行器的設計目標和要求

為實現在未知柑橘果柄空間方位情況下就能對柑橘果實進行采摘這一技術要求，本文模擬動物吞食咬合動作來設計柑橘采摘末端執行器，即設計的末端執行器的形態類似于動物的嘴部結構，同樣具有上下顎，通過類似于動物咬合的方式剪斷果柄實現柑橘采摘。本文把這種具有上下顎咬合功能的末端執行器稱之為咬合式末端執行器。

在眾多生物中，蛇類的顎部骨骼與其他動物相比有著很大的不同，蛇類顎部骨骼的特殊結構使得蛇嘴能夠擴張3倍，使得蛇能夠捕食體積比自身還大的獵物[16-17]，這樣的結構特點同樣有利于吞咽果實，方便機器人采摘。受蛇嘴結構的啟發，本文根據仿生學原理，仿照蛇嘴的結構設計采摘機器人末端執行器。

一般情況下，柑橘都是自然生長的，其果柄的生長方位也是雜亂無章的(圖1)，而仿蛇嘴咬合式末端執行器的設計目標是在未知柑橘果柄空間具體方位的情況下通過末端執行器實現對柑橘果柄的剪切。通過觀察與分析發現，對于咬合式末端執行器來說，在未知果柄空間方位的情況下剪斷果柄的關鍵有兩點：一是末端執行器張角足夠大，足以包容任何生長方位的柑橘果柄而不與果柄發生碰撞(圖2a)；二是末端執行器能夠在果柄生長范圍內的任意角度實現咬合動作，從而實現對任意生長方位果柄的剪斷(圖2b)。這要求末端執行器的張角要盡可能大，且其上下顎能夠在果柄生長范圍內的任意角度實現咬合動作。

圖1 柑橘果柄生長情況Fig.1 Growth condition of citrus stem

圖2 咬合式末端執行器剪切過程示意圖Fig.2 Schematic diagrams of shearing process of bite-model end-effector

以上要求都和果柄與水平面在空間中的夾角有關，為更加清楚地描述柑橘果柄空間方位，定義柑橘果柄與水平面在空間中的夾角為果柄傾角θcar。針對果柄傾角的分布情況在某柑橘栽培基地進行了實地測量和統計，統計方式如圖3所示，得到果柄傾角與果實密度的關系圖，如圖4所示，其中μ為傾角范圍內的果實數所占百分比。

圖3 果柄傾角測量圖Fig.3 Measurement diagram of stem inclination

圖4 果柄傾角與果實密度直方圖Fig.4 Histogram of relationship between inclination of stem and fruit density

由圖4可以發現，果柄傾角的范圍分布較廣，從5°～90°都有分布，在30°～90°范圍分布較多，但無明顯集中的區域。每5°取一個采樣點，在每個采樣點附近的柑橘算作此采樣點處的樣本。通過分析還發現，當果柄傾角為5°時，果柄接近水平位置，此時實現果柄的剪切較為容易，末端執行器只要能夠順利吞入果實并在水平位置附近咬合即可完成對果柄的剪切(圖5a)。傾角逐漸增大，末端執行器剪切的難度也隨之逐漸增大，當傾角為90°時，剪切難度達到最大(圖5b)。此時果柄與水平面垂直，若要求果柄在采摘前不與末端執行器發生碰撞，則要求末端執行器上顎同樣也與水平面垂直，即要求末端執行器張角為180°，在此位置能夠實現咬合。

圖5 不同果柄傾角下末端執行器剪切情況Fig.5 End-effector shear condition at different stem inclinations

1.2 結構設計

1.2.1蛇嘴咬合過程與蛇頭骨結構分析

蛇嘴的咬合過程大致可分為對準、伸出、張嘴與咬合4個步驟(圖6)。咬合式末端執行器采摘果實時大致也分為這4個步驟，其中對準與伸出動作可由機械臂完成，而張嘴與咬合動作由咬合式末端執行器完成。

圖6 蛇嘴的咬合過程Fig.6 Snake bite process

圖7 蛇頭骨骼結構圖[18] Fig.7 Snake head skeleton map [18]1.腦顱骨 2.上顳骨 3.方形骨 4.翼狀骨 5.外翼狀骨 6.上頜骨 7.前額 8.上顎骨 9.下頜骨

KARDONG等[18]將蛇類中具有代表性的響尾蛇頭部作為研究對象，發現蛇頭部上顎各骨骼可組成一個封閉的機構，而下顎與上顎的運動則相對獨立，蛇頭骨骼結構如圖7a所示。進一步對該結構進行簡化，用連桿表示各骨骼，用鉸鏈表示骨骼的連接部，將蛇頭結構簡化為一個通過各關節鉸接的鉸鏈連桿機構，如圖7b所示。

1.2.2蛇頭骨骼結構簡化與仿蛇嘴咬合結構設計

根據末端執行器的設計目標和要求，對蛇頭骨骼結構進行分析和簡化。由圖7b所示的蛇頭骨骼簡化連桿結構圖可知，桿件9(下頜骨)運動相對獨立，桿件8(上顎骨)和桿件5(外翼狀骨)均和桿件6(上頜骨)及桿件4(翼狀骨)連接，連接關系上有一定的重疊。據此，本文提出2種設計思路：

(1)忽略桿件8，蛇頭骨骼的上顎部分可簡化為如圖8a所示的7連桿機構。

(2)忽略桿件5，同時將桿件6與桿件8視為一個桿件，蛇頭骨骼的上顎部分可簡化為如圖8b所示的6連桿機構。

圖8 蛇頭骨上顎部分簡化機構圖Fig.8 Simplified mechanisms of upper jaw part of snake skull

對設計思路(1)提出的7連桿機構進行分析，如圖8a所示，共有7個桿件，同時有7個轉動副，但沒有確定活動構件數、原動件類型和數目。若確定一個桿件為機架，則剩下6個桿件為活動件，同時具有7個轉動副，根據自由度計算公式

F=3n-2p5-p4

(1)

式中F——自由度n——活動構件數

p5——5級平面低副數

p4——4級平面高副數

可計算得自由度為4，而原動件不可能為4個，此機構運動不能確定。若確定兩個桿件如桿件4和桿件5為機架，此時活動構件數為5個，但轉動數也相應減少1個，變為6個，由式(1)計算得自由度為3，運動同樣不能確定。因此，必須對該結構進行一定的改進。

考慮到末端執行器的總重量不能超過機械臂的負重限制，末端執行器不能選用過重的設備和材料，因此選擇動力輸入設備為質量較小的氣缸，則有輸入為直線移動的直線氣缸和輸入為回轉運動的手指氣缸可供選擇。將桿件3和桿件4鉸接處的轉動副改為移動副，作為直線氣缸的輸入，將桿件3帶動此移動副提前至桿件1處，將桿件7和桿件2視為同一桿件，將桿件4和原桿件3視為機架，則有了改進后的上顎機構a，如圖9a所示。此機構共有5個活動構件，7個平面低副，由式(1)計算得自由度為1，由直線氣缸作為原動件。

圖9 改進后的上顎機構Fig.9 Improved upper jaw mechanisms

對設計思路(2)提出的6連桿機構進行分析，如圖8b所示，若指定桿件4為機架，則有5個活動桿件和6個轉動副，由式(1)計算得自由度為3。若指定2個桿件如桿件4和桿架3為機架，則有4個活動桿件和5個轉動副，由式(1)計算得自由度為2，在只有一個原動件的條件下機構運動無法確定，同樣需對該結構進行一定的簡化和改進。

通過觀察發現，構件1為蛇頭的腦顱骨，而桿件2和桿件7均為連接腦顱骨的構件，這3個構件之間的相對運動對主要運動影響不大， 于是將這3個構件簡化為1個桿件，則蛇頭骨骼機構可簡化為1個平面四桿機構，為改進后的上顎機構b，如圖9b所示。確定桿件4為機架，則有3個活動件和4個轉動副，由式(1)計算得自由度為1，由手指氣缸作為原動件。

1.2.3咬合式末端執行器結構仿真

咬合式末端執行器要實現咬合剪斷果柄，必須要上下額以相同軌跡同時運動，而蛇頭骨骼結構的下顎運動則相對獨立，為保證剪切效果，本文對咬合式末端執行器的下顎采用與上顎相同且對稱的機構，根據前文提出的兩種設計思路，設計出咬合式末端執行器的兩種機構，機構簡圖如圖10a和圖10b所示，機構運動仿真圖如圖11和圖12所示。

圖10 咬合式末端執行器機構簡圖Fig.10 Schematic diagrams of bite-model end-effector mechanism

圖11 咬合式末端執行器機構a運動仿真圖Fig.11 Motion simulation diagram of bite-model end-effector mechanism a

圖12 咬合式末端執行器機構b運動仿真圖Fig.12 Motion simulation diagram of bite-model end-effector mechanism b

根據機構簡圖，結合柑橘尺寸，利用幾何圖形法對機構尺寸進行優化，在Solidworks軟件中建立兩種末端執行器的初步模型，如圖13和圖14所示。

圖13 咬合式末端執行器初步模型aFig.13 Initial model a of bite-model end-effector1.上顎支架 2.上顎刀片 3.主架 4.下顎刀片 5.下顎支架 6.傳動桿 7.支撐長桿 8.動力推桿 9.隨動支撐鈑金 10.基座

圖14 咬合式末端執行器初步模型bFig.14 Initial model b of bite-model end-effector1、10.手指氣缸 2、7、9、11.傳動桿 3.上顎 4.下顎 5.上刀片 6.主架 8.下刀片 12.連接法蘭

將模型a和模型b導入ADAMS軟件中進行初步運動分析，設置運動時間，分別導出兩種模型的末端執行器執行咬合動作時上、下顎的速度與加速度變化曲線以及角速度與角加速度變化曲線，如圖15和圖16所示。

圖15 模型a上、下顎速度與角速度及加速度與角加速度變化曲線Fig.15 Changing curves of velocity and angular velocity, acceleration and angular acceleration of upper and lower jaws in model a

圖16 模型b上、下顎的速度與加速度及角速度與角加速度變化曲線Fig.16 Changing curves of velocity and acceleration, angular velocity and angular acceleration of upper and lower jaws in model b

通過分析對比圖15、16，模型a在運動過程中上下顎刀片的速度、加速度、角速度和角加速度均存在突變，容易造成較大的沖擊。而模型b的運動曲線除了啟動瞬間，其余階段均較為平穩，無明顯突變，具有較好的運動特性；比較2個模型的張角，模型b的張角明顯比模型a的張角要大，更符合設計要求；同時模型b的結構更簡單。經綜合比較，根據模型b的結構設計咬合式末端執行器。

1.3 仿蛇嘴咬合式末端執行器機構建模

以圖14所示的模型b為基礎，對末端執行器機構進行細化。咬合式末端執行器的上、下顎分別為平面四桿機構，如圖10b所示，點B處連接剪切刀片，桿AB為執行剪切動作的從動桿，桿CD為主動桿，桿AD為機架，桿BC為連架桿。選用SMC MHY2-16D型氣動手指氣缸為末端執行器動力源，安裝在機架AD上，其尺寸參數見文獻[19]。手指氣缸的初始狀態為手指與缸體平行，最終狀態為手指與缸體垂直。而作為剪切桿件的從動桿，其初始狀態為保證張角為180°，需與機架垂直，最終的剪切狀態為與機架平行的水平狀態。據此，畫出末端執行器連桿初始狀態和最終剪切狀態的機構圖，如圖17所示。

圖17 末端執行器連桿的初始狀態和最終狀態機構圖Fig.17 Initial and final state mechanism diagrams of end-effector linkage

桿AB需要完全包絡柑橘，因此桿AB長度需大于柑橘半徑，但又不能過大致使無法剪切到果柄。經調研得到的柑橘實際尺寸，設定桿AB長度為40 mm。同時根據手指氣缸大小和柑橘直徑確定機架AD長度為75 mm，可計算出CD桿長為40 mm,BC桿長為122 mm，同時根據果柄直徑和工作實際確定其他零件尺寸，得出咬合式末端執行器三維模型，如圖18所示。

圖18 咬合式末端執行器三維模型Fig.18 Three-dimensional model of bite-model end-effector1.機架 2.上顎支架 3.上刀片 4.下刀片 5.下顎支架 6.上顎連桿 7.氣缸支架 8.下顎支架 9.手指氣缸 10.下顎驅動桿 11.上顎驅動桿

1.4 仿蛇嘴咬合式末端執行器機構優化

將末端執行器三維模型導入ADAMS軟件進行咬合剪切運動的仿真，在進行咬合動作時發現，由于果柄存在傾角，上顎會先于下顎接觸果柄，而上顎在接觸果柄后，由于作為動力源的手指氣缸的兩個手指為同時運動，上顎接觸果柄后不再運動，使連接上顎的手指停下，從而使連接下顎的手指也停下，造成下顎也停止運動，無法形成咬合剪切動作，造成剪切果柄失敗。咬合動作仿真圖如圖19所示。

圖19 模型咬合動作仿真圖Fig.19 Simulation diagram of model bite motion

仔細分析蛇頭骨骼機構，發現蛇頭骨骼的下顎部分與上顎的運動相對獨立，能夠保證上顎在咬住獵物的同時下顎繼續運動形成咬合。對比所設計的末端執行器，上下顎的運動完全同步是造成無法咬合的主要原因。將咬合機構與主架的連接由兩顆螺釘連接變為一個軸承連接，可釋放咬合機構自行運動的自由度。自由度釋放后，由于重力作用，手指氣缸會帶動咬合機構沿此軸承形成擺動，同時在主架上增加一個擋塊形成限制擺動的位置。根據前期研究成果，采摘姿態在45°左右時有較好的采摘效果[20]，調整擋塊位置，將擺動的角度限定在45°，可具有較好的采摘效果。優化后的末端執行器三維模型如圖20所示。

圖20 優化后的末端執行器三維模型Fig.20 Three-dimensional model of optimized end-effector1.機架 2.擋塊 3.上顎支架 4.上刀片 5.下刀片 6.下顎支架 7.上顎連桿 8.氣缸支架 9.下顎支架 10.手指氣缸 11.下顎驅動桿 12.上顎驅動桿

2 仿蛇嘴咬合式末端執行器運動分析

2.1 平面模型的建立

根據末端執行器的三維模型，建立末端執行器的平面連桿機構模型，如圖21所示，兩個相同的四連桿機構帶動刀片作為咬合式末端執行器的上下顎執行剪切咬合動作，兩個四桿機構共用機架和動力源。

圖21 末端執行器平面連桿機構模型Fig.21 Model of end-effector plane link mechanism

2.2 咬合式末端執行器上顎運動學分析

由2.1節可知，設計的末端執行器是由兩個相同的四連桿機構組成的咬合機構和機架構成，咬合機構能夠在機架上轉動，M點和N點為上、下顎刀尖，M和N點重合時即對果柄進行剪切，M點和N點一方面由氣缸驅動進行剪切運動，另一方面隨同咬合機構在重力作用下進行旋轉運動，為兩個運動的合成。由于M點和N點的運動過程類似，僅列出M點的計算方程。

首先考慮咬合機構在氣缸驅動下進行剪切運動時M點的運動特性，圖22所示為咬合機構上半部分機構圖，CD桿為原動件。

以角速度ω驅動四連桿機構運動，其加速度為ε，則有

α=ωt

(2)

圖22 咬合機構上顎部分機構簡圖Fig.22 Upper jaw mechanism sketch of occlusion mechanism

式中α——CD軸與x反方向的夾角

t——運動時間

根據前文設計要求，有

(3)

式中ψ——桿AB與x軸的夾角

則B點位移為

xB=l4cosψ+l2

(4)

yB=l4sinψ+l3

(5)

式中xB、yB——B點在x、y軸方向位移

l2——A點距原點的x軸方向距離

l3——A點距原點的y軸方向距離

l4——桿AB的長度

B點速度為

(6)

(7)

式中vBx、vBy——B點在x、y軸方向速度

B點加速度為

(8)

(9)

式中aBx、aBy——點B在x、y軸方向的加速度

ε——桿CD的初始加速度

則由B點的運動學方程可求出M點的運動學方程，M點位移為

xM=xB+l5sinψ

(10)

yM=yB-l5cosψ

(11)

式中xM、yM——點M在x、y軸方向的位移

l5——桿BM的長度

M點速度為

(12)

(13)

式中vMx——點M在x軸方向的速度

vMy——點M在y軸方向的速度

M點加速度為

(14)

(15)

式中aMx——點M在x軸的加速度

aMy——點M在y軸的加速度

再考慮咬合機構在重力作用下進行旋轉運動的運動特性, 如圖23所示為咬合機構在機架上轉動示意圖，將咬合機構視為一個整體，其質心為P，質量為m，質心距原點O的距離為l,質心P與原點O的連線與y軸的夾角為α′，則在開始咬合動作的時間為t，ω′為機架在t時間內轉動的角速度，ε′為機架在t時間內轉動的角加速度，則有

(16)

圖23 咬合機構在機架上轉動示意圖Fig.23 Schematic diagram of occlusion mechanism rotating on frame

其勢能V為

V=mgl(1-cosα′)

(17)

式中g——重力加速度

動能T為

(18)

式中JC——咬合機構繞O點旋轉的轉動慣量

根據機械能守恒定律，有

(19)

將式(17)、(18)代入式(19)，有

(20)

(21)

(22)

對ε′進行時間的積分，可得

(23)

由于α′的初始值為45°，則有

(24)

式(24)為α′關于時間t的函數，對應每一個時間即有確定的α′，即可確定咬合機構在重力下旋轉的運動規律。

最后考慮兩個運動的合成。機架坐標系為xaOya坐標系，咬合機構坐標系為xbOyb坐標系，咬合機構在機架上的運動即為咬合機構坐標系在機架坐標系中的運動，如圖24所示。

圖24 咬合機構在機架上的運動合成示意圖Fig.24 Schematic diagram of movement of occlusion mechanism on frame

由于咬合機構上下完全對稱，其質心在xbOyb坐標系的x軸上，因此α′為xbOyb坐標系的x軸與xaOya坐標系的y軸的夾角，xbOyb坐標系可認為是xaOya坐標系繞z軸旋轉了θ，則同一矢量由xbOyb坐標系轉換到xaOya坐標系的轉換關系為[21]

Pa=RPb

(25)

(26)

(27)

式中Pa——xaOya坐標系中的矢量

Pb——xbOyb坐標系中的矢量

R——xbOyb坐標系相對于xaOya坐標系的表達

根據式(14)、(15)、(24)、(25)，即可求出M點在xaOya坐標系中的運動規律。

2.3 咬合式末端執行器上下顎運動學仿真

2.3.1運動學參數仿真結果

將優化后的末端執行器三維模型導入ADAMS軟件，并設置約束條件和驅動，分別導出末端執行器動作時上、下顎的位移、速度和加速度曲線，如圖25所示。

由圖25可以看出，下顎位移比上顎大，上、下顎速度和加速度變化基本同步，但下顎速度大于上顎速度，剪切瞬間下顎加速度變化較為劇烈，這都與咬合機構在機架上的運動合成和剪切瞬間的碰撞有關，與預期基本相符。

圖25 上、下顎的位移、速度和加速度曲線Fig.25 Displacement, velocity and acceleration curves of upper and lower jaws

2.3.2完整咬合周期運動學仿真

通過ADAMS軟件對末端執行器模型進行完整剪切周期的運動學仿真，仿真效果如圖26所示，由圖可以看出，末端執行器開始剪切任務后，先完成剪切運動、再完成旋轉運動，完成旋轉運動后剪切機構與機架垂直，機構復位運動順利，整個運動過程平穩無干涉現象，能夠順利完成剪切周期的剪切動作和復位動作。

圖26 咬合式末端執行器運動過程圖Fig.26 Movement process diagram of bite-model end-effector

3 末端執行器制作與實驗

3.1 實驗平臺搭建

根據分析結果制作末端執行器，圖27為末端執行器俯視圖與左視圖。

圖27 末端執行器Fig.27 End-effector prototype

將末端執行器安裝在課題組自行研制的柑橘采摘機器人上進行實驗驗證。柑橘采摘機器人的控制系統框圖如圖28所示，該系統基于機器人操作系統(Robot operation system，ROS)在Ubuntu操作系統下為機械臂和末端執行器搭建運動控制系統，同時基于QT開發平臺搭建雙目視覺平臺，機械臂選用敖博(北京)智能科技有限公司研制的AUBO-i5型六自由度機械臂。工作原理為視覺平臺利用OpenCV 3.2.0視覺開源庫對柑橘進行識別，基于雙目立體視覺原理，計算出柑橘表面形心在機械臂坐標系的三維坐標，完成柑橘果實的定位。上位機利用ROS軟件開發平臺，接收視覺系統提供的果實空間信息后，對機械臂進行運動學求解、完成場景規劃、運動規劃等工作。由驅動接口將ROS輸出的數據通過CAN總線發送給驅動器，由驅動器驅動電動機轉動完成機械臂的運動。機械臂上的傳感器將采集的位置、速度等信息實時反饋給上位機，上位機根據反饋信息與根據逆運動學求解所得的各關節值進行比較，判斷機械臂當前位置是否處于終點位置，進而通過串口發送控制信號給下位機Arduino，通過Arduino實現對末端執行器的咬合控制。

圖28 采摘機器人控制系統框圖Fig.28 Control system block diagram of picking robot

末端執行器驅動系統的構成元件主要包括氣動三聯件、電磁閥、節流閥、執行氣缸以及空氣壓縮機等，具體見圖29。

圖29 柑橘采摘末端執行器驅動氣路Fig.29 Pneumatic driving of end-effector 1.氣動三聯件 2.電磁閥 3、5.調速閥 4.手指氣缸 6.壓力表 7.空氣壓縮機

在執行器作業過程中，控制系統需要同時完成執行器兩個執行氣缸的控制，以期執行末端執行器的咬合動作，從而切斷柑橘果柄，完成收獲任務。采用Arduino作為電磁閥的控制芯片，將其接入ROS軟件開發平臺，完成執行器的硬件系統搭建。

實驗平臺搭建完成后的柑橘采摘機器人如圖30所示。

圖30 柑橘收獲機器人實驗平臺Fig.30 Citrus harvesting robot experiment platform

3.2 實驗室環境下實驗與結果分析

3.2.1果柄傾角為0°時的實驗結果與分析

根據柑橘果柄生長的實際情況，將柑橘果柄直徑按每間隔0.5 mm為一組分為6個組，分別進行實驗。同時，由于剪切的動力由氣壓系統提供，而氣壓系統能夠提供的氣壓總是在一個范圍內波動，本文同時也對氣壓大小與采摘成功率的關系進行了實驗，由于選用的SMC MHY2-16D型氣動手指氣缸的操作壓力為0.1～0.6 MPa，因此將氣壓系統提供的氣壓以0.1 MPa為間隔，從小于0.4 MPa到等于0.6 MPa分為4組，對不同的柑橘果柄直徑分別進行實驗，共進行了24組實驗，每組剪切相應直徑的果柄20次，統計一次性切斷果柄的成功率，結果如表1所示。

實驗結果表明，當果柄傾角為0°、氣壓系統提供壓力為0.6 MPa、果柄直徑不超過4.0 mm時，切斷成功率不小于95%。根據調查統計結果，一般柑橘果柄直徑均不超過4.0 mm，即本文設計的咬合式末端執行器在執行實際收獲任務時，具有較好的切斷成功率，能夠較好地完成收獲的切斷任務。

3.2.2不同果柄傾角的實驗結果與分析

由統計數據得知，果柄傾角分布范圍較廣，因此將果柄傾角(0,90°]的分布范圍按照15°間隔分為6個組，即(0°,15°]、(15°,30°]、(30°,45°]、(45°,60°]、(60°,75°]、(75°,90°]，分別進行剪切實驗，根據上節實驗結果，剪切時氣壓設定為0.6 MPa，果柄直徑不超過4 mm，每組實驗20次，統計每組成功率如表2所示,計算得總體成功率為97.5%。

3.3 室外環境下實驗與結果分析

課題組于2018年3月在重慶某果園內進行了室外環境的采摘實驗，實驗環境如圖31所示，末端執行器作業過程如圖32所示，由于受到條件限制，共對40個自然生長的柑橘果實進行了采摘實驗，采摘前首先對每個柑橘的果柄直徑、果柄傾角、果實縱、橫徑等具體參數進行了測量，每個柑橘的具體參數和采摘結果如表3所示。

表2 不同果柄傾角的剪斷成功率Tab.2 Shear success rate of different inclinations of stem %

圖31 室外實驗環境Fig.31 Outdoor experiment environment

圖32 末端執行器采摘作業過程圖Fig.32 Process diagram of end-effector picking operation

由實驗結果可以看出，對于果柄傾角較大或較小的柑橘，使用本文設計的咬合式末端執行器進行采摘時切斷成功率仍然有待提高，對于果柄傾角在中間部分的柑橘，則有比較好的切斷成功率。室外實驗的總體成功率達87.5%，比實驗室環境下實驗的成功率有所降低，但基本可以實現在未知柑橘果柄方位下對柑橘的采摘。

4 結論

(1)提出了通過模擬蛇嘴結構設計咬合式末端執行器來實現未知柑橘果柄空間方位下對柑橘進行采摘，增強了采摘機器人的采摘能力。

(2)對柑橘果柄生長情況進行了調研，定義了果柄傾角并進行了統計，對果柄極限位置的剪切要求進行了分析，并得出了末端執行器的設計要求，一是咬合式末端執行器的張角盡可能大，二是咬合式末端執行器上下顎能夠在果柄生長范圍內的任意角度實現咬合動作。

表3 室外采摘實驗數據及結果Tab.3 Outdoor picking experimental data and results

(3)對蛇頭骨骼的結構進行了簡化，提出了兩種設計思路，分別設計了機構初步模型，經過分析確定了較優方案并進行了優化和運動學分析，根據三維模型制作了咬合式末端執行器樣機。

(4)在實驗室環境和自然環境下分別進行了采摘實驗。在實驗室環境下，果柄傾角為0°，氣壓為0.6 MPa、果柄直徑不超過4.0 mm條件下的切斷成功率不小于95%；對于不同傾角果柄，總體切斷成功率為97.5%。在自然環境下，柑橘采摘總體成功率為87.5%。實驗結果表明，本文設計的咬合式末端執行器能夠實現未知柑橘果柄空間方位下的柑橘采摘。