基于單片機的仿人多指番茄采摘機械手設(shè)計

楊小慶，時　磊，王　娜，鮑秀蘭

(1.重慶工商職業(yè)學(xué)院，重慶　400052；2.河南工業(yè)職業(yè)技術(shù)學(xué)院，河南 南陽　473000；3.華中農(nóng)業(yè)大學(xué)，武漢　430070)

?

基于單片機的仿人多指番茄采摘機械手設(shè)計

楊小慶1，時磊2，王娜2，鮑秀蘭3

(1.重慶工商職業(yè)學(xué)院，重慶400052；2.河南工業(yè)職業(yè)技術(shù)學(xué)院，河南 南陽473000；3.華中農(nóng)業(yè)大學(xué)，武漢430070)

摘要：為了降低番茄采摘過程的破碎率，提高采摘效率，實現(xiàn)自動化采摘過程，利用單片機和PID控制技術(shù)，設(shè)計了一種新型的仿人多指采摘機械手，并采用反饋調(diào)節(jié)控制方案設(shè)計了仿人多指機械手的控制系統(tǒng)?；贏T89S52單片機構(gòu)建了單手指控制器，來對機械手手指夾緊力信號進行采集和處理，并發(fā)出夾緊指令。為了測試機械手的有效性和可靠性，首先對番茄的質(zhì)量尺寸相關(guān)性和電壓產(chǎn)生的夾緊力進行了測試，通過參數(shù)調(diào)整后得到了番茄夾緊力隨時間變化曲線和破碎率隨時間變化曲線，最后對果實采摘的采摘時間和漏采率進行了8次試驗。由測試結(jié)果可以看出：對于單顆番茄的采摘最高用時僅為2.32s，最高漏采率僅為0.42%，采摘作業(yè)效率和采摘精度均較高。

關(guān)鍵詞：多指機械手；番茄采摘；反饋調(diào)節(jié)；單片機；AT89S52；仿人

0引言

自1954年美國成功研制出第一臺可編程控制機器人之后，機器人技術(shù)得到了迅速的發(fā)展。由于機器人的出現(xiàn)及進一步完善，人類傳統(tǒng)的生產(chǎn)模式逐漸發(fā)生改變，即人-機器-自然界過渡到人-機器人-機器-自然界這一新模式，把人從生產(chǎn)崗位逐步解放出來，成為了生成的組織者和指揮者。隨著自動化水平的進一步提高，機器人的應(yīng)用越來越廣泛，而機器人執(zhí)行末端的靈活性和柔性成為機器人自動化水平的重要指標。對于易碎果實的采摘，機器人的柔性和靈活性是降低果實損失率的重要方法，因此對于仿人番茄多指采摘機械手的研究具有重要的實際意義。

1仿人多指番茄采摘機械手總體設(shè)計

仿人多指靈巧手的控制由于涉及到機構(gòu)的運動學(xué)和動力學(xué)分析，并且采取不同的驅(qū)動方式，所對應(yīng)的數(shù)學(xué)模型也不相同，所以建立出來的控制模型比較復(fù)雜。對于番茄采摘多指機械手的設(shè)計，可以使用簡單的PID閉環(huán)反饋控制系統(tǒng)便可以滿足其設(shè)計要求，其總體設(shè)計框架如圖1所示。

圖1　仿人采摘機械手總體設(shè)計框圖

圖1中，各手指動作的協(xié)調(diào)主要通過傳感器信號的反饋來調(diào)節(jié)，傳感器接受信號經(jīng)過濾波后通過A/D轉(zhuǎn)換將信號送給單片機，單片機接受信號使用變頻器進行調(diào)速，調(diào)整夾緊力；然后對果柄進行切斷，將果實移動到果箱，移動過程中利用限位開關(guān)進行啟停；當(dāng)達到果箱時，機械手松開，果實掉落到果箱中。

驅(qū)動系統(tǒng)使用直線步進電機進行操作，驅(qū)動過程如圖2所示。其中，信號檢測元件主要包括光電位置開關(guān)、壓力傳感器和霍爾傳感器。當(dāng)檢測到單片機信號后，開始進行夾持動作，當(dāng)傳感器檢測到夾持力達到一定大小時，步進電機停止動作，等待果柄和果實的分離；分離完成后步進電機反向旋轉(zhuǎn)后復(fù)位，復(fù)位過程以霍爾傳感器標定為基準。

圖2　直線步進電機驅(qū)動過程圖

圖3表示機械手的硬件系統(tǒng)框架圖。其中，控制中心是單片機，實現(xiàn)接收外部數(shù)據(jù)、處理數(shù)據(jù)和發(fā)出指令的功能；控制面板使用人機交互界面，并且具有液晶顯示功能，通過監(jiān)控系統(tǒng)來實現(xiàn)反饋調(diào)節(jié)和自動化控制。

圖3　硬件系統(tǒng)結(jié)構(gòu)框圖

2多指采摘機械手結(jié)構(gòu)和控制系統(tǒng)設(shè)計

多指仿人番茄采摘機械手的設(shè)計主要采用弧形面手指抓持，設(shè)果實受到的重力為G，施加的載荷力為F；為了防止番茄夾碎，在弧形面里使用橡膠，設(shè)橡膠和果實的摩擦因數(shù)為υ，最大靜摩擦力為Ff，其示意圖如圖4所示。

根據(jù)牛頓第三定律和力學(xué)平衡條件，果實不滑落的條件為重力等于手指產(chǎn)生的最大靜摩擦力，由此可得

(1)

一般的果實和橡膠的摩擦因數(shù)在0.38～0.51之間，于是夾持力的大小與果實的平均質(zhì)量存在較大的關(guān)系，對于機構(gòu)的設(shè)計還與果實的尺寸有關(guān)。因此，可以通過對果實統(tǒng)計計算的方法來分析質(zhì)量和物理尺寸的相關(guān)性，計算后得到了如表1所示的相關(guān)性結(jié)果，其顯著性水平為α=0.05。

圖4　番茄采摘示意圖

mm

由表1可以得到：果實的各項尺寸參數(shù)和果實質(zhì)量存在顯著的相關(guān)性，其后幾項的絕對系數(shù)R2均大于 0.9，P=0<α。利用這些相關(guān)參數(shù)可以對機械結(jié)構(gòu)和夾緊力進行優(yōu)化設(shè)計，其機械手的總體功能設(shè)計如圖5所示。

圖5　末端執(zhí)行器結(jié)構(gòu)示意圖

機械手執(zhí)行末端，利用電機驅(qū)動帶動絲杠的旋轉(zhuǎn)，絲杠和螺紋的連接帶動手指的閉合和張開，內(nèi)置的電熱絲將番茄的果柄進行加熱切斷，其拇指的設(shè)置如圖6所示。

圖6　拇指結(jié)構(gòu)示意圖

拇指結(jié)構(gòu)根據(jù)仿生原理，將尺寸設(shè)計為人手指尺寸的1.5倍，共有3個關(guān)節(jié)和3個自由度，實現(xiàn)了手指的彎曲和側(cè)擺動。對于手指的控制，可以使用簡單的PID閉環(huán)反饋系統(tǒng)進行控制，閉環(huán)輸出可以用u(t)來表示，其公式為

(2)

其中，Kp表示比例系數(shù)；Ki表示積分時間常數(shù)；Kd表示微分時間常數(shù)；e(t)表示控制誤差。對式(1)進行拉氏變換，可以得到傳遞函數(shù)為

(3)

對于PID反饋閉環(huán)調(diào)節(jié)系統(tǒng)，需要對控制過程進行離散化，變?yōu)閿?shù)字式的控制。假設(shè)T為采樣周期，使用許多采樣點kT替代時間t，將積分形式用求和來替代，將微分使用后項差分來替代，用求和代替積分，用后項差分代替微分，并令t=kT(k=0,1,2…)，則離散化的微分方程為

(4)

PID控制類型使用位置型PID控制算法，其第k次采樣計算機的輸出值u(k)為

(5)

其中，k表示采樣序號，k=0,1,2…；e(k)表示第k次采樣測得的偏差值；e(k-1)表示第k-1次采樣測得的偏差值。采用信號的輸入與輸出可以采用單片機來進行控制。

作為整個系統(tǒng)的控制核心，單片機的性能及技術(shù)參數(shù)將影響到整個系統(tǒng)的構(gòu)建及運行，為了降低功耗，使用了Atmel公司生產(chǎn)AT89S52 的單片機。其具有8位CMO工藝處理器，使用8K 在線可編程 Flash 存儲器，該單片機性價比較高，使用靈活，可以作為許多嵌入式系統(tǒng)的單片機，并且具有較好的兼容性，后續(xù)可以進行功能的擴充。

3多指番茄采摘機械手性能測試

為了驗證設(shè)計的仿人多指番茄采摘機械手的有效性和可靠性，通過番茄采摘試驗對其性能進行測試。由于番茄屬于易碎果實，因此主要測試項目主要包括定位準確度和果實的破碎率。

圖7為仿人多指的番茄采摘執(zhí)行末端測試示意圖。在測試過程中，首先利用手指對番茄進行夾緊，番茄屬于易碎番茄類，因此在采摘過程中需要施加相應(yīng)的壓力，如果壓力過大會造成果實的破碎。使用不同的電壓對手指的壓力進行控制，通過測試得到了如圖8所示的壓力隨電壓變化曲線。

圖7　番茄采摘末端執(zhí)行器

圖8　果實壓力隨電壓變化曲線

為了實現(xiàn)番茄采摘的無損性，對果實的夾持力度進行了測試，使用FSR402壓力傳感器測試執(zhí)行末端夾持力，采用壓力加載標定的方式對檢測系統(tǒng)進行標定。試驗時，采用砝碼加載的形式對傳感器加載，間隔加載量是50g，重復(fù)次數(shù)為4次，取平均值后得到了如圖9所示的結(jié)果變化曲線。

圖9　抓緊力隨時間變化曲線

由圖9可以看出：加載力在6ms時可以調(diào)整出穩(wěn)定的結(jié)果，超調(diào)量較低，調(diào)整時間很短，達到了精確控制的目的。

圖10表示破碎率隨采摘時間的變化曲線。由圖10可以看出：隨著采摘時間的增加，破碎率也有所增加；但是增加負幅度不大，在1 800min時，破碎率僅為0.046 8，符合番茄采摘的需求。

圖10　破碎率隨采摘時間變化曲線

表2表示通過8次測試得到的果實的采摘時間和漏采率的測試結(jié)果。由表2可以看出：對于單顆番茄的采摘時間較短，最高用時僅為2.32s，采摘作業(yè)效率較高；多指機械手的漏采率也很低，最高僅為0.42%，采摘精度較高。

表2　果實采摘時間和漏采率測試

4結(jié)論

1)采用單片機技術(shù)和PID閉環(huán)反饋調(diào)節(jié)控制技術(shù)，設(shè)計了一款新型的仿人多指采摘機械手，并設(shè)計了機器人的控制系統(tǒng)。其中，控制系統(tǒng)的核心采用了一款性價比較高、使用靈活的AT89S52單片機。通過測試發(fā)現(xiàn)，單片機可以實現(xiàn)機械手指夾緊力信號的收集、處理，并能夠發(fā)出動作指令。

2)為了進一步驗證機械手的有效性和可靠性，對機械手進行了果實采摘試驗，得到了果實采摘的破碎率、果實采摘時間及果實的漏采率等性能指標。其中，破碎率在1 800min時僅為0.046 8，單顆番茄的采摘最高用時僅為2.32s，最高漏采率僅為0.42%，符合番茄采摘作業(yè)高效率高精度的要求，為番茄采摘機器人的設(shè)計提供了較有價值的參考。

參考文獻：

[1]陳軍,王虎,蔣浩然，等.獼猴桃采摘機器人末端執(zhí)行器設(shè)計[J].農(nóng)業(yè)機械學(xué)報, 2012,43(10):151-154.

[2]陳燕,蔡偉亮,鄒湘軍,等.荔枝的力學(xué)特性測試及其有限元分析[J].農(nóng)業(yè)工程學(xué)報, 2012,27(12): 358-363.

[3]陳燕,蔡偉亮,向和平，等.面向機器人采摘的荔枝果梗力學(xué)特性[J].農(nóng)業(yè)工程學(xué)報,2011,28(21): 53-58.

[4]顧寶興,姬長英,王海青，等.智能移動水果采摘機器人設(shè)計與試驗[J].農(nóng)業(yè)機械學(xué)報,2012,43(6): 153-160.

[5]李秦川,胡挺,武傳宇，等.番茄采摘機器人末端執(zhí)行器研究綜述[J].農(nóng)業(yè)機械學(xué)報, 2008,39(3): 175-179.

[6]劉繼展,李萍萍,李智國.番茄采摘機器人末端執(zhí)行器的硬件設(shè)計[J].農(nóng)業(yè)機械學(xué)報,2008,39(3):109-112.

[7]劉繼展,李萍萍,倪齊，等.番茄采摘機器人真空吸盤裝置設(shè)計與試驗[J].農(nóng)業(yè)機械學(xué)報,2010,41(10):171-172.

[8]李智國,劉繼展,李萍萍.機器人采摘中番茄力學(xué)特性與機械損傷的關(guān)系[J].農(nóng)業(yè)工程學(xué)報,2010,26(5):112-116.

[9]散鋆龍,劉旋峰,牛長河，等.杏果實成熟度特性參數(shù)與果柄分離力的相關(guān)性分析[J].農(nóng)業(yè)工程學(xué)報,2013,29(23):62-68.

[10]紀晴,段培永,李連防，等.移動機器人全覆蓋路徑規(guī)劃算法綜述[J].山東建筑大學(xué)學(xué)報,2007,22(4):354-358.

[11]謝志勇,張鐵中,趙金英.基于 Hough 變換的成熟草莓識別技術(shù)[J].農(nóng)業(yè)機械學(xué)報,2007,38(3): 106-109.

[12]王儉,陳衛(wèi)東,趙鶴鳴.移動機器人全覆蓋路徑規(guī)劃優(yōu)化方法[J].計算機工程,2005,31(22):162-163.

[13]吳修文,馮曉霞,孫康嶺,等.農(nóng)用機器人導(dǎo)航電子地圖的研究[J].農(nóng)業(yè)裝備與車輛工程,2010,(3):40-42.

[14]朱向慶,陳志雄.采用GPS 和GPRS 的移動目標監(jiān)控導(dǎo)航系統(tǒng)設(shè)計[J].計算機測量與控制,2011,19(5):1133-1136.

[15]李界家,陳浩,李穎.神經(jīng)網(wǎng)絡(luò)迭代算法解耦控制在中央空調(diào)系統(tǒng)中的應(yīng)用[J].沈陽建筑大學(xué)學(xué)報,2012,28(1):182-186.

[16]徐文兵,高飛.天寶Trimble AgGPS 332 單點定位在林業(yè)測量中的應(yīng)用探析[J].浙江林學(xué)院學(xué)報,2010,27(2):310-315.

[17]張楠，董曉晶，張健.WGS-84 坐標系與BJ-54 坐標系的轉(zhuǎn)換方法及精度探討[J].制造業(yè)自動化,2009,31(12):162-164.

[18]李紅，沈冬.基于ArcGlS Engine 的地理信息數(shù)據(jù)庫設(shè)計與實現(xiàn)[J].測繪與空間地理信息,2009,32(4):74-76.

[19]陳文良,謝斌,宋正河，等.拖拉機電控液壓動力轉(zhuǎn)向系統(tǒng)的研究[J].農(nóng)業(yè)工程學(xué)報,2006,22(10):122-124.

[20]韓高樓.GPS 定位技術(shù)的優(yōu)缺點[J].陜西建筑,2010(2):56-58.

[21]李洪欣,楊建中.基于兩參數(shù)的表冷器建模方法研究[J].建筑熱能通風(fēng)空調(diào),2009,28(6):15-17.

[22]孟慶山.水源熱泵機組變流量水系統(tǒng)節(jié)能優(yōu)化探討[J].制冷與空調(diào),2010,10(1):84-89.

Design and Implementation of a New Type of Humanoid Multi Finger Tomato Picking Manipulator Based on SCM

Yang Xiaoqing1, Shi Lei2, Wang Na2, Bao Xiulan3

(1.Chongqing Technology and Business Institute, Chongqing 400052，China; 2.Henan Polytechnic Institute, Nanyang 473000，China; 3.Huazhong Agricultural University,Wuhan 430070,China)

Abstract：In order to reduce tomato picking broken rate, improve the picking efficiency, realize automatic picking process, by MCU and PID control technology design a new type of humanoid multi fingered picking manipulator, and the feedback control scheme, the humanoid multi-fingered manipulator control system.The single finger controller is constructed based on the AT89S52 microcontroller, and the finger clamping force signal of the manipulator is collected and processed, and the clamping instruction is issued. For mechanical testing of validity and reliability, are first generated on tomato quality dimension relativity and voltage clamping force were tested through adjusting the parameters obtained the tomato clamping force with time change curve and broken rate versus time curve, at the end of the fruit picking picking time and loss rate of 8 experiments,by the test results can be seen, for single tomato picking with the highest is only 2.32s,maximum loss rate is only 0.42%, picking operation efficiency and picking accuracy is higher.

Key words：multi finger manipulator; tomato picking; feedback regulation; SCM; AT89S52; human like

文章編號：1003-188X(2016)07-0080-05

中圖分類號：S225.92

文獻標識碼：A

作者簡介：楊小慶(1984-)，女，湖北宜昌人，講師，碩士。通訊作者：王娜(1980-),女，河南焦作人，講師，碩士，(E-mail)wangna0377@163.com。

基金項目：湖北省自然科學(xué)基金項目(2014CFB322)

收稿日期：2015-06-16