蘋果采摘機器人末端執(zhí)行器恒力柔順機構研制.pdf
第 35卷 第 10期 農 業(yè) 工 程 學 報 V ol.35 N o.10 2019年 5月 Transactions of the Chinese Society of Agricultural Engineering M ay 2019 19 蘋果采摘機器人末端執(zhí)行器恒力柔順機構研制苗玉彬,鄭家豐 (上海交通大學機械與動力工程學院,上海 200240) 摘 要:為了減少采摘機器人末端執(zhí)行器在夾持過程中對果實造成的損傷,該文通過在末端執(zhí)行器上設置柔順機構,并 對柔順機構力學性能進行計算,求解果實無損采摘所需的柔順恒力特性。首先,基于形狀函數(shù)建立邊界條件約束下的柔 順梁非線性常微分控制方程;然后,利用打靶法將上述邊值問題重新描述為初值問題,并結合遺傳算法進行初值優(yōu)化求 解,采用序列二次規(guī)劃法優(yōu)化梁的形狀函數(shù),使其在一定變形范圍內實現(xiàn)恒力輸出;最后,在給出求解所需參數(shù)和柔順 機構初始形狀參數(shù)基礎上,以蘋果采摘為例,通過優(yōu)化計算,使柔順梁對果實的夾持力維持在 7.9 N左右,非線性有限元 計算和力-位移特性試驗驗證了計算結果的準確性,多次蘋果夾持試驗的抓取完好率為 95%,驗證了該柔順機構無損夾持 蘋果的可行性。研究結果可為不同類型果實的恒力夾持提供參考。 關鍵詞:機器人;末端執(zhí)行器;設計;恒力柔順機構;打靶法 doi:10.11975/j.issn.1002-6819.2019.10.003 中圖分類號:TP 241 文獻標志碼:A 文章編號:1002-6819(2019)-10-0019-07 苗玉彬, 鄭家 豐. 蘋 果采摘 機 器人末端 執(zhí)行 器恒力柔 順機 構研制J. 農 業(yè)工程學 報,2019 ,35(10) :19 25. doi: 10.11975/j.issn.1002-6819.2019.10.003 http :/www.tcsae.org Miao Yubin, Zheng Jiafeng. Development of compliant constant-force mechanism for end effector of apple picking robotJ. Transactions of the Chinese Society of Agricultural Engineering (Transactions of the CSAE), 2019, 35(10): 1925. (in Chinese w ith Englis h abs tract) doi:10.11975/j.issn.1002-6819.2019.10.003 http :/www.tcsae.org 0 引 言 采摘作業(yè)是果蔬生產中最耗時、費力的一個環(huán)節(jié)。 隨著農業(yè)勞動力的減少,農業(yè)生產成本相應提高,果蔬 采摘機器人逐漸成為農業(yè)機器人領域的研究熱點 1 。 果實 的無損采摘是采摘機器人的關鍵技術之一 2-7 ,主要通過 末端執(zhí)行器和作物果實直接接觸。由于果實一般比較脆 弱柔軟,形狀及生長狀況比較復雜,采摘過程中夾持力 過大容易造成果實表面或內部損傷,而夾持力不足又無 法抓牢果實。因此,合理地優(yōu)化設計末端執(zhí)行器,實現(xiàn) 對果實的柔順抓取,是實現(xiàn)果實無損采摘的研究重點。 目前末端執(zhí)行器無損夾持一般基于力的反饋控制實 現(xiàn),即利用壓力傳感器實時測量對果實的夾持力,將實 際輸出與期望輸出對比構成閉環(huán)控制,使夾持力保持恒 定。 如王學林等 8 提出基于灰色預測的增量式比例積分力 控制算法,根據(jù)預測模型的精度調整預測力偏差所占的 權重,計算出穩(wěn)定控制夾持力的校正量。周俊等 9 以當前 抓取力和滑動信號小波變換的細節(jié)系數(shù)作為控制器的輸 入,末端執(zhí)行器閉合的距離作為控制器的輸出,采用混 合學習算法結合減法聚類算法進行訓練,使抓取力超調 量得到有效限制。Dimeas 等 10 提出基于模糊控制的分層 遞階控制策略,通過模糊控制器調節(jié)采摘草莓的抓取力。 但由于受到成本和使用環(huán)境等因素限制,精確控制的末收稿日期:2018-12-12 修訂日期:2019-01-15 基金項目:上海市科研計劃項目(16391901700) ;滬農科推字(2018)第 1-2 號、 (2015) 第 4-1 號; 上海市工程技術研究中心建設專項 (17DZ2252300) 作者簡介:苗玉彬,副教授,主要從事智能裝備、智能傳感器研究。 Email:ybmiaosjtu.edu.cn 端執(zhí)行器難以在農業(yè)領域得到廣泛應用 11 。 近年來,柔順機構引起廣泛關注。柔順機構是一種 依靠機構中柔性構件的變形來完成全部運動,從而實現(xiàn) 力或能量傳遞的機構 12-16 。柔性構件的應用使得在一定 范圍內可以進行恒力輸出,減少恒力機構對力傳感和控 制的需求。如張贏斌 17 研究了柔順鉗和柔順恒力機構設 計的拓撲優(yōu)化,采用相對密度法和非線性有限元方法對 柔順鉗進行了優(yōu)化設計。 Merriam等 18 借助遺傳算法和有 限元建??刂迫犴樕炜s器的結構參數(shù),使其具有一定范 圍內的恒力輸出。 Wang 等 19 用打靶法設計靜平衡機構和 恒力機構,將它們串聯(lián)得到有穩(wěn)定恒力輸出的恒力夾鉗, 并使用有限元模型和實物模型驗證結果。 Pham等 20 參考 柔性雙穩(wěn)態(tài)機構設計人字形柔順屈曲梁,通過非支配排 序遺傳算法優(yōu)化梁的形狀實現(xiàn)輸出力的調節(jié)。Liu 等 21 采用傾斜的基于彎曲梁的柔性雙穩(wěn)態(tài)機構來構造負剛度 機構,設計了一種新型的柔性鉗,并采用非開關變結構 控制算法克服滯后效應。 顯然,如果能利用恒力柔順機構對果蔬采摘機器人 的末端采摘夾持器進行合理設計,在保持對果實可靠夾 持的同時將夾持力控制在一定范圍,則既可以降低末端 夾持裝置的復雜度,也能減少甚至避免對果實的夾持損 傷。但現(xiàn)有的柔順恒力機構往往存在恒力區(qū)間相對機構 尺寸小的缺陷,難以應用在果實采摘等要求結構設計緊 湊的場合。為此,本文針對果實柔順夾持問題,在末端 執(zhí)行器的驅動機構和夾鉗之間設置柔順屈曲梁,并結合 打靶法、遺傳算法計算求解柔順機構的數(shù)學模型,利用 序列二次規(guī)劃法設計優(yōu)化柔順機構的相關參數(shù),使末端 執(zhí)行器在一定位移輸入范圍內具有恒力輸出特性,并可農業(yè)工程學報(http:/www.tcsae.org) 2019年 20 根據(jù)夾持力大小調整,從而實現(xiàn)對果實的恒力夾持。 1 柔順夾持機構設計與分析 1.1 采摘夾持器柔順設計 末端執(zhí)行器按手爪個數(shù)可分為 2 指和多指型,用 于蘋果等球狀果實的夾持器通常為弧形二指或三指結 構 8,22-23 ,夾持手指采用弧面結構以增大和果實的接觸面 積、減少損傷。這種夾持器一般使用電動或氣動裝置驅 動手指抓取果實,手指弧面上安裝有壓力傳感器獲取夾 持力反饋,用以調節(jié)位移輸入。 以二指式末端執(zhí)行器為例,圖 1 為二指式果實夾持 末端執(zhí)行器模型。當二指機構與果實接觸時,假定 2 指 相對平行,則果實每側所受擠壓合力方向與該側機械手 指的位移輸入方向相同,如圖 1a 所示。如果在驅動機構 和弧面手指之間設置屈曲梁或類似柔順機構,當柔順機 構的形狀滿足特定條件時,在一定位移輸入范圍內柔順 機構變形,產生類似“超彈性”效果,使弧面手指保持恒力 夾持,如圖 1b 所示。 注:F in 為輸入力,N;y in 為位移輸入,cm;L 1 、L 2 分別為 2 段梁的長度, cm;t 為柔順梁寬度,cm;w為柔順梁厚度,cm;n 1 、n 2 、n 3 為柔順梁節(jié)點, 下同 Note: F inis force input, N; y inis the displacement input, cm; L 1 , L 2are the length of two beams, respectively, N; t is the width of compliant beam, cm; w is the thickness of compliant beam, cm;n 1 ,n 2 ,n 3 are joints of compliant beam, respectively. The same below. 圖 1 二指式果實夾持末端執(zhí)行器模型 Fig.1 Model of two-finger fruit clamping end-effector 由于結構的對稱性,取一側柔順機構進行計算,如 圖 1c 所示。柔順機構由長為 L 1 和 L 2 的 2 段柔順梁組成, 記為梁 1 和梁 2,每段柔順梁均具有矩形橫截面,其中梁 厚度為 w,寬度為 t。以點 n 1 為坐標原點保持不動,點 n 3 處有豎直方向的位移量 y in 。 圖 2 為柔順梁的大撓度變形模型,未變形的柔順梁 由形狀函數(shù) (u)描述 24 ,其中 u0,1,是沿中性軸的 無量綱弧長, 表示柔順梁相對 x 軸的傾斜角度,rad。 當受到外部負載時,偏轉梁由另一個函數(shù) (u)表示, rad。 柔順梁受到的 x和 y 方向的外力分別表示為 F x 和 F y , N。 中性軸上的任意點(x, y)表示為: 0 0 00 0 00 0 cos d sin d u u xuxL uu yu y L u u (1) 式中 x(u 0 ),y(u 0 )表示無量綱弧長 u=u 0 時的坐標,cm;L 為梁的長度,cm。 注:F x 和 F y 分別為 x 和 y 方向的支反力,N;u0,1,是沿中性軸的無 量綱弧長; (u)表示未變形梁和 x軸的夾角,rad。 (u)表示變形梁和 x軸的 夾角,rad。 Note: F x and F yare reaction forces in the x and y directions respectively, N; u0,1 is the dimensionless arc length along the neutral axis; (u) represents the angle between the undeformed beam and the x-axis, rad; (u) represents the angle between the deformed beam and the x-axis, rad. 圖 2 柔順梁的大撓度非線性變形模型 Fig.2 Nonlinear large deformation model of compliant beam 將未變形梁的形狀函數(shù) 利用多項式進行參數(shù)化處 理,如式(2)所示。 01 m iii i m cc u cu (2) 其中系數(shù) c i0 c im 表征第 i 段梁的形狀,將其描述為 m+1 次多項式曲線。 根據(jù)文獻25,柔順梁的控制方程為: 2 1d sin cos 0 d EI h v u L (3) 式中 EI 為梁的抗彎剛度,其中 E 是彈性模量,MPa;截 面慣性矩 I=tw 3 /12,cm 4 ;h和 v分別等于 F x 和 F y ,N。 梁上的應力 (MPa)如式(4)所示。 2 Ew L (4) 1.2 柔順梁變形模型的打靶法求解 以無量綱弧長 u 為自變量,由式(1) 、式(3)可得 到控制梁變形的常微分方程組為: 2sin cos ' cos sin ' i i i i iiiii i ii i ii L hv EI x L y L (5) 第 10期 苗玉彬等:蘋果采摘機器人末端執(zhí)行器恒力柔順機構研制 21 式中下標 i=1,2 分別表示圖 1c 中長度為 L 1 和 L 2 的 2 段 梁。根據(jù)梁的力平衡、力矩平衡、轉角連續(xù)和幾何約束 等條件,式(5)須滿足以下初始條件和邊界條件: 1)在點 n 1 處: 1111 000 ,00 xy (6) 2)在點 n 2 處: 2121 1212 11 22 12 1212 01 ,0 1010 '1 '1 '0 '0 , xxyy EI EI LL hhvv (7) 3)在點 n 3 處: 23 2 22 1, 1 , in xy x xn y y hFvF (8) 取梁形狀參數(shù)中 m=2,此時梁形狀曲線為三次多項 式曲線,已能保證梁形狀的多樣性。當梁的控制參數(shù) c 10 , c 11 ,c 12 ,c 20 ,c 21 ,c 22 ,L 1 ,L 2 確定時,記未知初值 1 (0) 為 s,整理得初值條件為 1 10 1 1 1 0'0 0 0 0 0 c s x y (9) 11 01 11 22 0 2 2 2 11 11 22 1 1 2 1 2 1 1 0 '0 '1 2 0 1 0 1 cccc L ccc L x x y y (10) 終值條件為 22 0 2 1 2 2 23 2i n 1 1 1 ccc xx n yy (11) 式(5) 、 (9)(11)組成的非線性二階常微分方 程組中含 2 個未知參數(shù) h、v 和 1 個未知初值 s,其終值 處有 3 個邊界條件,故可求解。本文采用打靶法 26 將邊 值問題轉換為初值問題求解該微分方程組。為保證初值 問題的求解精度,使用 Matlab 中的 ode45 函數(shù) 27 ,即變 步長的龍格庫塔法求解。將求解的結果終值與式(11) 聯(lián)立得到三元非線性方程組。 該三元非線性方程組的求解需要給出適當?shù)某踔担?否則容易陷入局部收斂。為此本文將此方程組的求解視 作優(yōu)化問題,首先使用具有全局優(yōu)化能力的遺傳算法 28 得到一組可行解,并將該組解作為初值,代入到 Matlab 的 fsolve函數(shù),最終得到方程組的解。 方程組的解中 v等于 F y , 為節(jié)點 n 3 在位移至 y in 處時該 點沿位移輸入方向的支反力。將求得的解代入初值問題過 程量中,得到 x、y、 ,進而得到位移輸入下柔順梁的形 狀和梁上應力。柔順梁模型的求解過程如下: 1)給定梁優(yōu)化的初值 1 、 2 、L 1 、L 2 。 2)通過 ode45 函數(shù)建立三元非線性方程組。 3)通過 fsolve 函數(shù)結合遺傳算法求解步驟 2)中的 非線性方程組得到未知參數(shù) h、v 和未知初值 s。 4)將步驟 3)中的解代入 ode45 函數(shù)數(shù)值求解每一 步的函數(shù)值得到 x、y、 。 5)以 v、x、y、 建立 1.3 節(jié)中優(yōu)化的目標和約束。 6)在優(yōu)化過程中重復步驟 1)4) ,直至達到局部 最優(yōu)的 1 、 2 、L 1 、L 2 值,即最優(yōu)柔順梁模型。 1.3 柔順梁模型優(yōu)化 由式(1)(2)可知,柔順梁模型的控制參數(shù)為 c 10 ,c 11 ,c 12 ,c 20 ,c 21 ,c 22 ,L 1 ,L 2 ,為使一定位移輸入 內的輸出力 F y 保持恒定,使 a 和 b 這 2 個位移輸入下的 輸出力盡量接近,定義函數(shù) F(x)表示輸出力和位移輸入 的關系,則柔順梁的優(yōu)化模型可定義如下: 10 22 1 2 min , , , 1 Fb fc cLL Fa (12) n1 n1 n3 n3 11 22 12 0 47 21 2 03 5 12 4 35 7 46 SF cy xy x, y x ., y . .x,.y LL / , (13) 其中 x n1 ,y n1 ,x n3 ,y n3 分別為節(jié)點 n 1 和 n 3 的坐標,x 1 , y 1 ,x 2 ,y 2 分別為 2 段梁各點坐標,在梁模型求解步驟 4) 求得,cm。固定節(jié)點位置可以控制梁的設計邊界和坐標 取值范圍,確保 2 段梁保持在一定邊界內,防止 2 段梁 互相交叉。限制 2 段梁的長度 L 1 和 L 2 ,可以防止梁發(fā)生 自身交叉。上述變量的約束如圖 1c中的虛線框所示,可 根據(jù)柔順梁在末端執(zhí)行器上的尺寸調整。位移輸入為 c 時的應力 c 由式(4)求得,用于限制最大變形時梁的最 大應力不超過許用應力, y 是屈服應力,MPa。SF 是安 全系數(shù)。 式(13)為模型的約束條件,以保證優(yōu)化后的柔順 梁形狀能夠滿足末端執(zhí)行器大小需求。梁模型優(yōu)化為非 線性最優(yōu)化問題,采用序列二次規(guī)劃法(SQP,sequence quadratic program) 29 求解。但 SQP 為局部最優(yōu)化算法, 其初值的選取會影響最終優(yōu)化結果,故此首先需要根據(jù) 柔順機構特點定義梁的相對合理的初始形狀,再利用 SQP 算法進行優(yōu)化。 2 柔順梁優(yōu)化與試驗 2.1 柔順梁模型優(yōu)化 采用前述優(yōu)化算法對蘋果夾持末端執(zhí)行器柔順梁模 型進行優(yōu)化和求解。根據(jù)柔順梁 3D 打印使用的聚甲醛材 料和期望的恒力輸出區(qū)間,設定優(yōu)化的相關參數(shù)為:彈性 模量 E=2.6 GPa,屈服應力 y =76 MPa,安全系數(shù) SF=1.5, a=0.7 cm, b=2 cm,最大允許應力下的位移輸入 c=2.2 cm, 梁寬度 t=10 mm,梁厚度 w=1 mm。 , , 2 11 2 22 2.62 3.57 1.9 5 cm 0.82 2 2.7 4.5 cm uuL uuL (14) 農業(yè)工程學報(http:/www.tcsae.org) 2019年 22 優(yōu)化后得到梁的形狀參數(shù)為: , , 2 11 2 22 2.46 6.46 6.06 4.13 cm 0.45 1.71 1.23 4.54 cm uu L uu L (15) 根據(jù)梁模型求解步驟 4) 得到優(yōu)化后柔順梁的初始形 狀和受到位移輸入作用后的變形形狀,如圖 3 所示。柔 順梁的 3 個節(jié)點位置和 2 段梁的位置受優(yōu)化模型中的約 束條件限制,約束取值可按需求設置。柔順梁的最大應 力出現(xiàn)在節(jié)點 n 1 處。 柔順梁存在恒力輸出段的原因如下: 由圖 4 中梁 2 的變形趨勢可見梁 2 在位移輸入方向上的 剛度(抵抗變形的能力)隨位移輸入而減小,由正剛度 結構變?yōu)樨搫偠冉Y構。由梁 1 變形趨勢可見梁 1 始終為 正剛度結構,梁 1 起到輔助梁 2 變形的作用。當 2 段梁 在位移輸入方向上的剛度之和接近零剛度時,將存在一 段輸出力不隨位移輸入發(fā)生變化的范圍。 圖 3 柔順梁變形過程圖 Fig.3 Deformation process of compliant beam 圖 4 為優(yōu)化前后柔順梁的力-位移曲線,其中 F(a)=3.911 6 N,F(xiàn)(c)=3.960 5 N,并在最大位移 c 處達到 許用應力 48.1 MPa。當夾持器夾取果實時,在 0a 位移 范圍內夾持力持續(xù)增加,在 ac 范圍內夾持力保持基本 恒定,從而在不需要力反饋的條件下,實現(xiàn)了對果實的 恒力柔順夾取。其恒力范圍可根據(jù)式(12) 、式(13)進 行調整。相比之下,優(yōu)化前的柔順梁無“零剛度”段, 夾持力隨位移輸入增大而明顯變化,無法實現(xiàn)恒力夾持。 注:ac表述優(yōu)化時設定的恒力位移區(qū)間。 Note: a-c is the displacement range of constant force setting during optimization. 圖 4 柔順梁力- 位移曲線 Fig.4 Force-displacement curve of compliant beam 此外,由圖 4 中 ac 恒力段數(shù)據(jù),單側柔順梁對蘋 果的夾持力約為 3.95 N 左右,夾持合力約為 7.9 N,波動 誤差不超過 0.1 N。根據(jù)文獻30中的蘋果抓持試驗,以 300 g 蘋果為例,與夾持指摩擦系數(shù)為 0.5 時穩(wěn)定抓取的 力不小于 3 N,當夾持力超過 20 N(生物屈服力)后蘋果 的內部組織將受到損傷,本文的優(yōu)化結果滿足蘋果無損 穩(wěn)定采摘要求。當需要調整恒力大小時,不改變梁優(yōu)化 形狀即可實現(xiàn),由式(3)知相同位移輸入下的支反力大 小與抗彎剛度 EI 正相關。通過改變梁厚度 w 或寬度 t 可 使梁具有不同的抗彎剛度,從而調整優(yōu)化后柔順梁提供 的恒力大小,使其適應不同種類果實的無損采摘需求。 需要注意的是,梁厚度 w 將影響梁受到的應力,當 w 取 較大值時,相同載荷下的應力增大,將限制柔順機構的 操作范圍。 2.2 柔順梁力-位移特性仿真與試驗 為驗證本文方法的正確性,分別利用非線性有限元 仿真和柔順梁力-位移特性試驗對上述結果進行對比驗 證。為了加工方便和便于觀察試驗效果,對恒力結構進 行了適當放大。實際使用時,一方面可結合連桿機構將 柔順梁設置在合理位置而不是夾鉗上,另一方面可以將 恒力結構的尺寸和恒力范圍縮小,通過機構并聯(lián)的方式 實現(xiàn)期望的輸出特性,從而大大減小結構尺寸。 試驗裝置如圖 5 所示,柔順梁形狀參數(shù)與文中優(yōu)化 結果相同,使用聚甲醛材料通過 3D 打印加工而成,其彈 性模量和屈服應力與優(yōu)化時的材料參數(shù)設置一致。位移 輸入裝置為步進電機驅動的線軌滑臺模組(盛斯達 T6/4-200 mm,精度 0.1 mm,水平最大負載 2.5 kg) 。裝 置中柔順梁、 絲桿導軌和數(shù)顯百分表 (型號為 BFQ-350A, 量程 50.8 mm、精度±0.02 mm)均固定,載物平臺在步 進電機驅動下在絲桿導軌上移動并通過拉壓力傳感器 (型號為 JLBS-M2-3KG,量程 3 kg,精度 0.05%)對柔 順梁施加位移輸入,力傳感器測量作用力數(shù)值,數(shù)顯百 分表測量位移數(shù)值, 力與位移一一對應得到力-位移曲線。 1. 數(shù)字百分表 2. 絲杠導軌 3. 載物平臺 4. 力傳感器 5. 柔順梁 1. Digital micrometer 2. Lead screw guide 3. Object stage 4. Force sensor 5. Compliant beam 圖 5 力- 位移測量試驗裝置 Fig.5 Test equipment of force-displacement measurement 非線性有限元仿真在有限元分析軟件 Abaqus 中進 行,以柔順梁優(yōu)化結果的形狀建立梁單元模型,設定彈 性模量為 2.6 GPa(與優(yōu)化參數(shù)相同) ,邊界條件如圖 1c 所示 (n 1 固支, n 3 設置位移輸入且限制其他方向自由度) , 并劃分為 866 個網格單元,記錄 n 3 位移輸入和 n 1 相應 的支反力。 圖 6為 Abaqus仿真結果中位移輸入為 2.2 cm時梁的第 10期 苗玉彬等:蘋果采摘機器人末端執(zhí)行器恒力柔順機構研制 23 應力云圖,其中最大應力 47.87 MPa,與本文算法的實際 計算結果 48.10 MPa 誤差為-0.48%。Abaqus 對梁的力-位 移關系對比驗證結果如圖 7 所示,位移輸入范圍 0.2 2.8 cm,間隔 0.2 cm,共 14 個點。仿真結果與計算相比, 支反力平均誤差為 0.007 N,平均相對誤差 0.18%,最大 誤差為0.038N,最大相對誤差 0.96%,計算結果精度較 高,表明本文梁模型的計算方法理論可行。 測試試驗的位移輸入范圍 0.22 cm,間隔 0.05 cm, 共 37 個測點。與本文模型計算結果相比,試驗測得的支 反力平均誤差為 0.198 N,平均相對誤差 5.06%,最大誤 差為 0.215 N,最大相對誤差 5.8%。試驗結果與計算結果 大致吻合,說明本文梁模型實際可實現(xiàn)。圖中試驗結果 比計算、仿真值稍大,而仿真結果、計算結果吻合,其 主要原因是仿真分析和計算的理論模型只考慮了中性軸 的變形,而實際中存在梁厚度,使得連接處的剛性比理 論模型稍大,同時也存在打印加工誤差和材料彈性模量 誤差,使試驗結果相對理論分析值產生偏差。 圖 6 位移輸入為 2.2 cm 時柔順梁應力云圖 Fig.6 Stress cloud diagram of compliant beam with displacement input of 2.2 cm 圖 7 力- 位移特性驗證結果 Fig.7 Test result of force-displacement characteristics 2.3 蘋果抓取試驗 采用文中機構對蘋果進行柔順夾持,夾持試驗裝置 如圖 8 所示,力傳感器與驗證試驗相同。夾持指固定 不動,夾持指通過力傳感器安裝在載物平臺上。在步 進電機驅動下,載物平臺在絲桿導軌上移動,帶動夾持指 與夾持指合攏夾緊蘋果,載荷大小由力傳感器讀取。 以 1 次抓取試驗為例,圖 9 為抓取蘋果時柔順梁夾 持力隨時間變化曲線,將載荷開始增大的時間記為 0 時 刻。從夾持指開始接觸蘋果時載荷開始迅速增大,當 夾持力大約達到 8 N 時進入柔順梁的恒力范圍;隨時間 增加,步進電機繼續(xù)驅動夾持指夾緊,夾持力基本穩(wěn)定。 取夾持力穩(wěn)定段 47 s 共 150 個數(shù)據(jù)點進行分析,得到 支反力波動范圍為 7.468.42 N,平均支反力為 8.03 N, 與模型計算值的誤差為 1.6%,與 力 -位移驗證試驗結果的 誤差為 0.84%。由此可見,實際蘋果夾持時雖然夾持力 有一定波動,但夾持恒力與計算結果基本相符。 1. 絲杠導軌 2. 載物平臺 3. 力傳感器 4. 夾持指 5. 夾持指 1. Lead screw guide 2. Object stage 3. Force sensor 4. Clamping finger 5. Clamping finger 圖 8 蘋果夾持試驗 Fig.8 Test of apple clamping 圖 9 蘋果抓取試驗夾持力 Fig.9 Clamping force of apple clamping test 為進一步驗證夾持機構的柔順性,選取大小相近、 表面完好的 20 個蘋果進行抓取試驗,夾持持續(xù)時間為 10 s,均沒有發(fā)生滑落現(xiàn)象。將蘋果靜置 24 h,人工觀察 蘋果表皮只有 1個蘋果表面出現(xiàn)壞點抓取完好率為 95%。 由于夾持力未達到蘋果的生物屈服力,該蘋果內部未發(fā) 生損傷,其表面損傷的原因可能是由于表面與夾持指不 貼合,導致局部壓強較大。 3 結 論 1)針對果蔬采摘機器人無損采摘需求,通過在末端 執(zhí)行器上設置柔順機構,并對柔順機構的力學性能進行 優(yōu)化計算,獲取果實無損采摘所需的柔順恒力特性。 2)建立柔順梁的變形控制微分方程組,采用打靶法 將邊值問題重新描述為初值問題,并結合遺傳算法優(yōu)化 求解初值。在此基礎上,采用序列二次規(guī)劃法優(yōu)化計算 梁的形狀函數(shù),使柔順梁對蘋果的恒定夾持力維持在 7.9 N 左右。 3) 分別進行非線性有限元仿真和柔順梁力-位移特性農業(yè)工程學報(http:/www.tcsae.org) 2019年 24 試驗,仿真與模型計算結果相符,試驗與模型計算結果 平均誤差為 5.06%。進行蘋果抓取試驗,夾持力波動為 7.468.42 N,平均恒定夾持力約為 8.03 N,滿足蘋果無 損夾持需求。 4)多次蘋果夾持試驗的抓取完好率為 95%,驗證了 該柔順機構無損夾持蘋果的可行性。通過適當調整柔順 梁的參數(shù),本文算法可適應不同類型果實的恒力夾持需 求,可為柔順機構在果蔬無損夾持采摘中的有效應用提 供參考。 參 考 文 獻 1 宋健,張鐵中,徐麗明,等. 果蔬采摘機器人研究進展與 展望J. 農業(yè)機械學報,2006,37(5):158162. Song Jian, Zhang Tiezhong, Xu Liming, et al. Research actuality and prospect of picking robot for fruits and vegetablesJ. Transactions of the Chinese Society for Agricultural Machinery, 2006, 37(5): 158162. (in Chinese with English abstract) 2 Liu F, Ji W, Tang W, et al. Research on grasping planning for apple picking robots end-effectorC/Proceedings of the 2015 Chinese Intelligent Systems Conference. Berlin Heidelberg: Springer, 2016: 95103. 3 B a c C W , H e m m i n g J , V a n T u i j l J , e t a l . P e r f o r m a n c e evaluation of a harvesting robot for sweet pepperJ. Journal of Field Robotics, 2017, 34(6): 11231139. 4 徐麗明,劉旭東,張凱良,等. 臍橙采摘機器人末端執(zhí)行器 設計與試驗J. 農業(yè)工程學報,2018,34(12):5361. Xu Liming, Liu Xudong, Zhang Kailiang, et al. Design and test of end-effector for navel orange picking robot J. Transactions of the Chinese Society of Agricultural Engineering (Transactions of the CSAE), 2018, 34(12): 53 61. (in Chinese with English abstract) 5 傅隆生,張發(fā)年,槐島芳德,等. 獼猴桃采摘機器人末端執(zhí) 行器設計與試驗J. 農業(yè)機械學報,2015,46(3):18. Fu Longsheng, Zhang Fanian, Yoshinori G, et al. Development and experiment of end-effector for kiwifruit harvesting robotJ. Transactions of the Chinese Society for Agricultural Machinery, 2015, 46(3): 18. (in Chinese with English abstract) 6 Chiu Y C, Yang P Y, Chen S. Development of the end-effector of a picking robot for greenhouse-grown tomatoesJ. Applied Engineering in Agriculture, 2013, 29(6): 10011009. 7 Kondo N, Yamamoto K, Shimizu H, et al. A machine vision system for tomato cluster harvesting robotJ. Engineering in Agriculture Environment & Food, 2009, 2(2): 6065. 8 王學林,姬長英,周俊,等. 基于灰色預測控制的果蔬抓 取系統(tǒng)設計與試驗J. 農業(yè)工程學報,2010,26(3):112 117. Wang Xuelin, Ji Changying, Zhou Jun, et al. Design and experiment of fruit and vegetable grasping system based on grey prediction controlJ. Transactions of the Chinese Society of Agricultural Engineering (Transactions of the CSAE), 2010, 26(3): 112117. (in Chinese with English abstract) 9 周俊,楊肖蓉,朱樹平. 基于自適應神經模糊網絡的果蔬 抓取力控制J. 農業(yè)機械學報,2014,45(7):6772. Zhou Jun, Yang Xiaorong, Zhu Shuping. Fruit and vegetable grasping force control based on adaptive neural fuzzy networkJ. Transactions of the Chinese Society for Agricultural Machinery, 2014, 45(7): 6772. (in Chinese with English abstract) 10 Dimeas F, Sako D V. Design and fuzzy control of a robotic gripper for efficient strawberry harvestingJ. Robotica, 2015, 33(5): 10851098. 11 章軍. 六關節(jié)三指蘋果抓取機械手的自適應柔性分析J. 農業(yè)工程學報,2010,26(1):140144. Zhang Jun. Analysis of adaptive flexibility of three-finger manipulator with six-joint for grasping appleJ. Transactions of the