張娓娓,袁路路
(河南工業(yè)職業(yè)技術(shù)學(xué)院,河南 南陽 473000)
?
基于滑覺檢測(cè)的農(nóng)業(yè)機(jī)器人果蔬柔性抓取控制研究
張娓娓,袁路路
(河南工業(yè)職業(yè)技術(shù)學(xué)院,河南 南陽 473000)
果蔬采摘是水果蔬菜生產(chǎn)種植中最繁瑣、最耗時(shí)間、最費(fèi)精力的部分之一,直接影響果蔬日后的價(jià)值和銷售。隨著經(jīng)濟(jì)的快速發(fā)展、外出務(wù)工人員增多及農(nóng)業(yè)勞動(dòng)力減少,勞動(dòng)力在果蔬種植成本所占比例越來越大。實(shí)現(xiàn)果蔬自動(dòng)化采摘是降低成本、釋放農(nóng)業(yè)勞動(dòng)力的重要舉措。20世紀(jì)80年代,美國(guó)成功生產(chǎn)了世界上第1臺(tái)西紅柿采摘機(jī)器人。近年來,隨著信息技術(shù)和自動(dòng)化技術(shù)的高速發(fā)展,農(nóng)業(yè)采摘機(jī)器人的研究和開發(fā)取得了很大進(jìn)步,但對(duì)果蔬柔性抓取的研究進(jìn)展較慢。為此,基于滑覺傳感檢測(cè)技術(shù)與果蔬損傷機(jī)理,以農(nóng)業(yè)機(jī)器人采摘控制系統(tǒng)為研究平臺(tái),運(yùn)用離散小波變換算法,從傳感器和抓取力控制著手,深入研究和設(shè)計(jì)了農(nóng)業(yè)機(jī)器人柔性無損采摘控制系統(tǒng)。試驗(yàn)表明:系統(tǒng)運(yùn)行穩(wěn)定,可靠性強(qiáng),對(duì)實(shí)現(xiàn)果蔬柔性采摘具有十分重要的應(yīng)用意義。
果蔬采摘;柔性抓??;滑覺檢測(cè);小波變換
隨著經(jīng)濟(jì)的不斷發(fā)展,社會(huì)生活水平有了顯著提高,人們開始重視水果蔬菜的質(zhì)量,農(nóng)業(yè)種植生產(chǎn)結(jié)構(gòu)開始逐漸調(diào)整。果蔬的采摘作業(yè)費(fèi)時(shí)費(fèi)力,而且危險(xiǎn)性高。由于信息技術(shù)與機(jī)電一體化的高速發(fā)展,以及機(jī)器人的研究與應(yīng)用逐漸深入,人們開始用機(jī)器人去替代這些簡(jiǎn)單、繁瑣的勞動(dòng),并要求機(jī)械采摘手臂在采摘果蔬時(shí)不造成損傷,因此采摘手臂在作業(yè)過程中既要能穩(wěn)穩(wěn)抓住果蔬,又要盡量減少對(duì)果蔬的損傷。而各種果蔬的形狀大小以及成熟度不同,夾持力太大容易損害果蔬,夾持力太小果蔬容易滑落,因此夾持力要根據(jù)果蔬的大小進(jìn)行靈活調(diào)整。本文將從滑覺檢測(cè)技術(shù)出發(fā),以機(jī)器手臂夾持力度控制為基礎(chǔ),根據(jù)果蔬的特定性質(zhì)和機(jī)械損傷機(jī)理,設(shè)計(jì)和研究農(nóng)業(yè)機(jī)器人果蔬柔性抓取控制系統(tǒng),實(shí)現(xiàn)對(duì)果蔬柔性的無損采摘。
機(jī)械手臂采摘果蔬時(shí),最理想的狀態(tài)是機(jī)械手臂能夠以最小的夾持力穩(wěn)定采摘果蔬。在采摘果蔬過程中,機(jī)械手臂會(huì)對(duì)果蔬有一定的夾力,由于力的相互作用,果蔬也會(huì)受到一對(duì)方向相反的外力;而由于受到重力的作用,果蔬還要受到一對(duì)向上的摩擦力。對(duì)于果蔬來說,夾持力給果蔬的摩擦力是果蔬不掉落的重要因素。采摘過程中果蔬受力作用如圖1所示。
圖1 采摘過程中果蔬的受力作用圖Fig.1 Stress function of fruits and vegetables during picking process
圖1中,假設(shè)采摘手臂左右指對(duì)果蔬的力滿足水平方向,果蔬不掉落必須滿足的條件為
2uF≥G
(1)
即
(2)
式(1)、式(2)中,u為采摘手臂左右指與果蔬之間的摩擦因數(shù);F為采摘手臂左右指對(duì)果蔬的夾持力;G為果蔬自身的重力。
農(nóng)業(yè)采摘機(jī)器人在工作中,采摘對(duì)象種類較多,工作環(huán)境也復(fù)雜多變。對(duì)于任何待摘對(duì)象,無法提前知道其質(zhì)量和與采摘手臂左右指的摩擦因數(shù)。根據(jù)彈性摩擦重力公式,具有彈性的物體摩擦力為
FC=(KFα-1)F
(3)
其中,F(xiàn)為采摘手臂左右指對(duì)果蔬的正壓力;KFα-1相當(dāng)于摩擦因數(shù)μ;α為一個(gè)小于1的數(shù)。式(3)表明:采摘手臂左右指對(duì)待摘對(duì)象壓力越大,它們之間的有效摩擦因數(shù)越小。因此,對(duì)于待摘對(duì)象,其有效靜摩擦因數(shù)是變化的,無法人為設(shè)定最小夾持力去采摘目標(biāo)對(duì)象。
利用農(nóng)業(yè)機(jī)器人采摘收獲果蔬時(shí),常常需要依靠采摘手臂進(jìn)行采摘工作。為了穩(wěn)定柔性地抓取果蔬,又不至于造成果蔬機(jī)械損傷,采摘手臂左右指的夾持力要調(diào)節(jié)得非常合適、準(zhǔn)確,因此滑覺檢測(cè)對(duì)采摘機(jī)器人柔性抓取目標(biāo)對(duì)象及減少機(jī)械損傷有著重要作用。想要采摘手臂以最小的夾持力抓取物體,必須要檢測(cè)被摘對(duì)象表皮與采摘手爪之間的初始滑覺。本文采用壓敏傳感器作為壓控電路的重要部分,設(shè)計(jì)了一款靈敏程度非常高的滑覺傳感器,用來測(cè)量采摘過程中的初始滑覺。
2.1 滑覺檢測(cè)機(jī)構(gòu)
滑覺傳感器是滑覺檢測(cè)機(jī)構(gòu)的重要部分,是主要用于檢測(cè)采摘手的手爪與被摘對(duì)象之間相對(duì)滑動(dòng)的裝置。其通過實(shí)時(shí)檢測(cè)待摘對(duì)象表面的相對(duì)滑動(dòng),判斷采摘過程中的握力,在不損傷目標(biāo)物體的情況下逐漸增加力量,采摘目標(biāo)物體。本文設(shè)計(jì)的滑覺傳感器主要包括力敏導(dǎo)電硅膠、有機(jī)玻璃基板、聚合物薄膜力敏電阻及放大電路等部分?;X傳感器結(jié)構(gòu)如圖2所示。
圖2 滑覺傳感器結(jié)構(gòu)圖Fig.2 Slip sensor structure
滑覺傳感器的正負(fù)電極相互交替盤繞成螺旋結(jié)構(gòu),水平安放在環(huán)氧樹脂玻璃基板上,力敏導(dǎo)電硅膠安裝在正負(fù)電極的正上方。滑覺傳感器工作時(shí),放大電路將檢測(cè)正負(fù)電極的電壓信號(hào)放大,并通過ADC芯片轉(zhuǎn)化成數(shù)字信號(hào),最終交由處理器進(jìn)行信號(hào)分析與處理,進(jìn)而判斷物體是否產(chǎn)生滑動(dòng)。該滑覺傳感器結(jié)構(gòu)簡(jiǎn)單,傳感區(qū)接觸面積大,線路精簡(jiǎn)可靠,干擾少,且后續(xù)處理容易。
2.2 滑覺傳感器的信號(hào)輸出
機(jī)器人采摘手臂兩指上都裝有壓力和滑覺傳感器。壓力傳感器結(jié)構(gòu)和滑覺傳感器大致一樣,其核心也是壓敏電阻及放大電路等。在實(shí)驗(yàn)過程中,將測(cè)試的蘋果放在采摘手兩指間,并以2N左右的力閉合。待閉合穩(wěn)定后,來回拖動(dòng)蘋果滑動(dòng)時(shí),滑覺傳感器將有信號(hào)輸出,如圖3所示。
圖3 滑覺傳感器的電壓信號(hào)輸出Fig.3 Voltage signal output of slip sensor
圖3中,A點(diǎn)之前為靜摩擦區(qū)域,B點(diǎn)之后為動(dòng)摩擦區(qū)域;A點(diǎn)表示蘋果在受力情況下要移動(dòng)但還沒實(shí)際位移,B點(diǎn)表示蘋果已經(jīng)開始移動(dòng)。在A時(shí)刻,蘋果受切向力產(chǎn)生切向變形,電壓信號(hào)V變大;在B時(shí)刻,受外力的作用,蘋果沿著滑覺傳感器表面發(fā)生滑動(dòng)的瞬間,壓敏電阻值不穩(wěn)定,傳感器輸出的電壓信號(hào)V有比較復(fù)雜的波動(dòng)現(xiàn)象。由圖3可以看出:在靜摩擦力區(qū)域,滑覺信號(hào)已經(jīng)出現(xiàn)明顯波動(dòng),結(jié)合準(zhǔn)確的算法,完全可以在蘋果出現(xiàn)明顯滑動(dòng)時(shí)檢測(cè)出其初始摩擦力。
2.3 滑覺傳感器頻譜分析
為了在靜摩擦區(qū)域獲取有效滑動(dòng)的電壓信號(hào),檢測(cè)物體的靜摩擦力,需要獲得適合的算法,將信號(hào)準(zhǔn)確反饋給控制系統(tǒng)對(duì)夾持器進(jìn)行抓取力控制;然后,對(duì)輸出信號(hào)進(jìn)行短拉斯變換,以觀察其頻譜成分。滑覺傳感器的信號(hào)輸出和短拉斯變換的結(jié)果分別如圖4、圖5所示。
圖4 滑覺傳感器的信號(hào)Fig.4 Slip sensor signal
圖5中,橫坐標(biāo)表示時(shí)間,顏色的深淺說明頻譜能量大小程度。結(jié)合圖4、圖5可以看出:在0.15s前,物體沒有實(shí)際位移,拉力較小,滑覺傳感器輸出的信號(hào)無明顯變化,在這區(qū)間的信號(hào)中只有少量高頻成分和能量;在物體移動(dòng)的瞬間,拉力增大,切向變形變大,輸出信號(hào)波動(dòng)幅度大,出現(xiàn)大量的高頻成分和能量;在物體停止移動(dòng)時(shí)刻,高頻成分和能量同時(shí)大量減少。
圖5 滑覺傳感器信號(hào)的頻譜分析Fig.5 Spectrum analysis of sensor signal
由滑覺傳感器頻譜分析可知:當(dāng)夾持器與采摘對(duì)象發(fā)生滑動(dòng)、產(chǎn)生動(dòng)摩擦力時(shí),頻譜信號(hào)中會(huì)出現(xiàn)大于2Hz高頻成分;當(dāng)只有靜摩擦力時(shí),頻譜信號(hào)中的頻率成分都小于2Hz。因此,可以通過離散小波變換檢測(cè)滑覺傳感器輸出信號(hào)瞬間的頻率分布,判斷初始滑動(dòng)。
離散小波變換是一種比較方便、好用的時(shí)域分析方法,是結(jié)合傅里葉變換和拉斯變換的優(yōu)缺點(diǎn)形成的,已廣泛應(yīng)用于信號(hào)處理、機(jī)器視覺、圖像處理、模式識(shí)別及機(jī)器學(xué)習(xí)等領(lǐng)域。離散小波變換在時(shí)域和頻域具有很好地局部化特征,可以采集處理信號(hào)并提供各個(gè)頻率子端的頻譜能量或者頻率信息。利用小波基函數(shù)可以將ψ(t)進(jìn)行收縮和平移,則
(4)
其中,j為尺度系數(shù);t為平移系數(shù)。
任意L2(R)空間中的函數(shù)f(t)離散小波變換為
(5)
離散小波信號(hào)是在尺度-位移的平面上,它對(duì)應(yīng)的是一些離散的信號(hào)點(diǎn)。離散小波信號(hào)點(diǎn)分布如圖6所示。
圖6 離散小波信號(hào)點(diǎn)分布圖Fig.6 Discrete wavelet signal point distribution
采用離散小波變換技術(shù)對(duì)傳感器輸出的信號(hào)進(jìn)行收集、處理,并提取電信號(hào)中的高頻分量,設(shè)定合適的閾值,然后通過比較離散小波變換的小波系數(shù)和閾值的關(guān)系,判斷物體是否發(fā)生初始滑動(dòng)。
農(nóng)業(yè)機(jī)器人末端夾持器在作業(yè)過程中,在法向力加載和卸載期間也會(huì)產(chǎn)生滑覺信號(hào),在檢測(cè)時(shí)要注意將其與待測(cè)物體滑動(dòng)引起的滑動(dòng)信號(hào)區(qū)別開來。法向力作用下的頻譜分析如圖7所示。
圖7 法向力作用下的頻譜分析Fig.7 Spectrum analysis under normal force
結(jié)合圖5和圖7進(jìn)行分析,可以發(fā)現(xiàn)兩者小波系數(shù)值差別很小,在法向力作用下,裝載和卸載時(shí)同時(shí)伴有高頻成分存在。因此,不能單單只從頻率特性判斷待摘物體的滑動(dòng)信號(hào)。但是,在加載時(shí)輸出信號(hào)的幅值因子小于零,卸載時(shí)幅值因子大于零,而待測(cè)物體滑動(dòng)時(shí)滑覺傳感器輸出信號(hào)幅值因子有正值和負(fù)值。因此,在判斷過程中,加載法向力時(shí),只要是離散小波信號(hào)幅值因子大于0.15,則認(rèn)定待摘物體發(fā)生滑動(dòng);卸載法向力時(shí),只要是離散小波信號(hào)幅值因子小于-0.15,則認(rèn)定待摘物體發(fā)生滑動(dòng);無法向力作用時(shí),離散小波信號(hào)幅值因子大于0.15,則認(rèn)定為有滑動(dòng)產(chǎn)生。
本文設(shè)計(jì)了實(shí)物抓取實(shí)驗(yàn),測(cè)試抓取力控制的靈敏度,測(cè)試過程如圖8所示。實(shí)驗(yàn)在單一機(jī)械手的單向運(yùn)動(dòng)中進(jìn)行,機(jī)械采摘手左右兩指都裝有滑覺傳感器,測(cè)試過程中控制周期為10ms。首先,機(jī)械采摘手以最小抓力夾持空塑料瓶,機(jī)械手處于夾緊狀態(tài);然后,向空塑料瓶逐漸加水,即慢慢加大被抓物體的質(zhì)量;當(dāng)塑料瓶整體質(zhì)量接近由抓取力產(chǎn)生的摩擦力時(shí),塑料瓶開始有滑落的跡象;在出現(xiàn)滑動(dòng)跡象時(shí),滑覺傳感器輸出信號(hào)被控制系統(tǒng)檢測(cè)到,并迅速增大機(jī)械采摘手抓取力夾緊被抓物體。
圖8 機(jī)械采摘手抓取實(shí)驗(yàn)Fig.8 Mechanical picking hand grab experiment
機(jī)械采摘手抓取空瓶調(diào)節(jié)結(jié)果與離散小波信號(hào)細(xì)節(jié)因子分析如圖9、圖10所示。
圖9 機(jī)械采摘手抓取空瓶調(diào)節(jié)結(jié)果Fig.9 Mechanical picking hand grab empty bottle adjustment results
圖10 離散小波信號(hào)細(xì)節(jié)因子分析Fig.10 Discrete wavelet signal detail factor analysis
由圖9、圖10可知:在整個(gè)過程中,機(jī)械手可以實(shí)現(xiàn)以最小抓力抓取該物體,被抓物體沒有發(fā)生滑落,向下滑動(dòng)位移只有0.5mm,抓取力調(diào)節(jié)比較穩(wěn)定,能有效減少采摘過程中對(duì)果蔬的機(jī)械損傷。
隨著采摘機(jī)器人作業(yè)環(huán)境的復(fù)雜化,對(duì)末端執(zhí)行器性能要求越來越高,自動(dòng)化代替作業(yè)的同時(shí),還要要求其對(duì)果蔬減少損傷。本文基于滑覺傳感器技術(shù),以末端執(zhí)行器為研究對(duì)象,運(yùn)用離散小波變換算法,設(shè)計(jì)和研究了農(nóng)業(yè)機(jī)器人無損抓取控制系統(tǒng)。測(cè)試結(jié)果表明:末端執(zhí)行器在抓取過程中,對(duì)抓取力控制非常精準(zhǔn),抓取力調(diào)節(jié)比較穩(wěn)定,減少了末端執(zhí)行器中對(duì)果蔬的機(jī)械損傷。這一研究對(duì)實(shí)現(xiàn)果蔬柔性采摘具有重要的實(shí)際應(yīng)用意義。
[1] 馮良寶.基于滑覺和力外環(huán)控制的水果抓取控制算法研究[D].南京:南京農(nóng)業(yè)大學(xué),2010.
[2] 朱樹平.基于滑覺檢測(cè)的農(nóng)業(yè)機(jī)器人果蔬抓取研究[D].南京:南京農(nóng)業(yè)大學(xué),2012.
[3] 尹云.基于觸滑覺控制的智能假手關(guān)鍵問題研究[D].大連:大連理工大學(xué),2004.
[4] 胡燕清,陳進(jìn)軍,胡國(guó)清.一種聲電式滑覺傳感器的實(shí)現(xiàn)與測(cè)試[J].傳感器與微系統(tǒng),2011(3):128-131.
[5] 尚振東,王恒迪,馬偉,等.一種高實(shí)時(shí)性滑覺傳感器滑動(dòng)程度判別模式[J].傳感器技術(shù),2005(2):16-18.
[6] 陳衛(wèi)東,董艷茹,陳穎.一種新型觸滑覺傳感器的試驗(yàn)研究[J].壓電與聲光,2010(4):571-573,577.
[7] 楊鵑.多傳感器信息融合技術(shù)在移動(dòng)機(jī)器人避障中的應(yīng)用[D].哈爾濱:哈爾濱理工大學(xué),2005.
[8] 王光國(guó).基于DSP+FPGA機(jī)器人敏感皮膚實(shí)時(shí)信號(hào)處理的研究[D].哈爾濱:哈爾濱工業(yè)大學(xué),2006.
[9] 蔡春風(fēng).人體表面肌電信號(hào)處理及其在人機(jī)智能系統(tǒng)中的應(yīng)用研究[D].杭州:浙江大學(xué),2006.
[10] 童利標(biāo).多傳感器手爪數(shù)據(jù)融合與數(shù)據(jù)傳輸?shù)难芯縖D].合肥:合肥工業(yè)大學(xué),2002.
[11] 羅志增.機(jī)器人多感覺傳感器系統(tǒng)與多信息融合技術(shù)[D].杭州:浙江大學(xué),1998.
[12] 張玉.近地面果蔬采摘機(jī)器人末端執(zhí)行器及機(jī)械臂的研究[D].沈陽:沈陽工業(yè)大學(xué),2014.
[13] 何建凱.基于觸滑覺反饋的假手控制系統(tǒng)研究[D].大連:大連理工大學(xué),2006.
[14] 姬偉,羅大偉,李俊樂,等.果蔬采摘機(jī)器人末端執(zhí)行器的柔順抓取力控制[J].農(nóng)業(yè)工程學(xué)報(bào),2014(9):19-26.
[15] 周俊,楊肖蓉,朱樹平.基于自適應(yīng)神經(jīng)模糊網(wǎng)絡(luò)的果蔬抓取力控制[J].農(nóng)業(yè)機(jī)械學(xué)報(bào),2014(7):67-72.
[16] 王學(xué)林.農(nóng)業(yè)機(jī)器人末端執(zhí)行器抓持力控制研究[D].南京:南京農(nóng)業(yè)大學(xué),2009.
[17] 丁媛媛,金寅德. 采摘機(jī)器人柔性末端執(zhí)行器抓取策略研究[J].制造業(yè)自動(dòng)化,2013(24):19-22.
[18] 丁俊香. 一種基于理想可流動(dòng)成型導(dǎo)電橡膠的三維柔性觸覺陣列傳感器若干問題的研究[D].合肥:中國(guó)科學(xué)技術(shù)大學(xué),2011.
[19] 劉旭東.氣動(dòng)安全柔性關(guān)節(jié)的設(shè)計(jì)及其在機(jī)器人手指中的應(yīng)用研究[D].鎮(zhèn)江:江蘇大學(xué),2008.
[20] 周韶威.仿生機(jī)器人觸須傳感器的建模與仿真研究[D].南京:南京航空航天大學(xué),2010.
[21] 金寅德.基于FPA的氣動(dòng)柔性蘋果采摘末端執(zhí)行器研究[D].杭州:浙江工業(yè)大學(xué),2010.
[22] 惠耀.基于IPMC型人造肌肉的柔性機(jī)械手設(shè)計(jì)與測(cè)試[D].南京:南京航空航天大學(xué),2011.
[23] 向婷,陳進(jìn)軍.基于新型壓阻觸滑覺傳感器軟抓取機(jī)械手的研究[J].制造業(yè)自動(dòng)化,2013(6):69-71.
[24] 陳娟,楊奇科,周晶杰.基于LabVIEW的小波變換在信號(hào)濾波中的應(yīng)用[J].技術(shù)與市場(chǎng),2013(5):51-52.
[25] 謝娜.基于PVDF的三維觸覺/熱覺傳感器的設(shè)計(jì)與仿真[D].重慶:重慶大學(xué),2014.
[26] 王明.基于小波分析的聲發(fā)射信號(hào)處理在損傷診斷中的應(yīng)用[D].鎮(zhèn)江:江蘇大學(xué),2009.
[27] 王學(xué)林,肖永飛,畢淑慧,等.機(jī)器人柔性抓取試驗(yàn)平臺(tái)的設(shè)計(jì)與抓持力跟蹤阻抗控制[J].農(nóng)業(yè)工程學(xué)報(bào),2015(1):58-63.
Design of the Control System of Fruit and Vegetable Flexible Grasping of Agricultural Robot Based on Slip Detection
Zhang Weiwei, Yuan Lulu
(Henan Polytechnic Institute, Nanyang 473000, China)
Fruit and vegetable picking fruit cultivation of vegetable production in the most complicated, the most time consuming, the cost of effort on the part of the one, which has a direct impact on the future value and sales of fruit and vegetable. With the rapid development of economy, migrant workers increased, reduced agricultural labor force, labor in the fruit and vegetable planting costs accounted for an increasingly large proportion. Fruit and vegetable automatic picking is an important measure to reduce the cost and release the agricultural labor force. In the 1980s, the United States has succeeded in producing the first Tomato Picking Robot, in recent years, with the rapid development of information technology and automation technology, agricultural harvesting robot research and development has made great progress, but research on fruit and vegetable soft grasping into development is slow. This paper based on slipping sensing detection technology of fruits and vegetables, damage mechanism, the agricultural robot picking control system as the research platform, the use of discrete wavelet transform algorithm, from the start of sensor and grasping force control, in-depth study and design the agricultural robot flexible nondestructive picking control system. The experiments show that the control system stable operation, high reliability, for the fruit flexible pick has very important significance.
fruit and vegetable picking; flexible grasping; slip detection; wavelet transform
2016-03-03
河南省自然科學(xué)基金項(xiàng)目(2015ZCB115);南陽市科技攻關(guān)項(xiàng)目(2012GG029)
張娓娓(1985-),女,河南南陽人,助教,碩士。
袁路路(1982-),女,河南南陽人,講師,碩士,(E-mail)wwandll80@qq.com。
S225.92;TP391.41
A
1003-188X(2017)06-0228-05