劉杰 王韌 朱銘鈞 常宇航 王曼溶 楊秀芳

摘要? ? 為了滿足移苗移栽作業(yè)自動化對精度、速度和靈活性的需求，基于Delta機(jī)構(gòu)設(shè)計了一種并聯(lián)構(gòu)型的穴盤移栽機(jī)械臂，建立了機(jī)械臂的運動學(xué)模型。本文在移栽機(jī)械臂的基礎(chǔ)上增加了視覺識別環(huán)節(jié)，以相機(jī)獲得幼苗圖片，將相片傳遞至中央處理器完成圖片預(yù)處理，對圖像進(jìn)行光滑、增強(qiáng)處理和識別，提取圖片特征，計算出作業(yè)對象中心位置，將中心位置反饋至中央處理器，計算出運動量，中央處理器輸出指令，從而控制末端執(zhí)行器完成作業(yè)。

關(guān)鍵詞? ? Delta機(jī)構(gòu);缽苗移栽;運動學(xué);視覺

中圖分類號? ? TH112? ? ? ? 文獻(xiàn)標(biāo)識碼? ? A

文章編號? ?1007-5739（2019）17-0165-03? ? ? ? ? ? ? ? ? ? ? ? ? ? ? ? ? ? ? ? ? ? ? ? ? ? ? ? ? ? ? ? ? ? ? ? ? ? ? ? ? ? ?開放科學(xué)（資源服務(wù)）標(biāo)識碼（OSID）

Abstract? ? In order to meet the requirements of precision，speed and flexibility in the automation of transplanting，a plug-in robotic arm with parallel configuration based on Delta mechanism was designed，the kinematic model of the robot arm was established.The visual recognition link was added on the basis of the robot arm to obtain the seedling picture by camera，the photo was transmitted to the central processing unit to complete the image preprocessing，the image was smoothed，enhanced and recognized，the picture feature was extracted，and the center of work object was calculated.The center position was fed back to the central processing unit，the amount of exercise was calculated，and the central processor output an instruction to control the end effector to complete the work.

Key words? ? Delta parallel mechanism;seedling transplanting;kinematics; vision

隨著我國農(nóng)業(yè)現(xiàn)代化進(jìn)程的推進(jìn)，農(nóng)業(yè)生產(chǎn)的各個環(huán)節(jié)都在逐步實現(xiàn)自動化和智能化，以設(shè)施農(nóng)業(yè)為主的育苗環(huán)節(jié)也迎來了新的發(fā)展契機(jī)，機(jī)械、電子、通訊等領(lǐng)域的新技術(shù)逐漸應(yīng)用在工廠化育苗過程中[1]。大型移栽設(shè)備在農(nóng)業(yè)發(fā)達(dá)國家廣泛應(yīng)用[2]，我國在移苗的移栽設(shè)備方面也做了大量研究，涵蓋了自主移動溫室機(jī)器人[3]，導(dǎo)軌移動的串聯(lián)、并聯(lián)和混聯(lián)構(gòu)型的移栽機(jī)械臂等[4-6]。并聯(lián)機(jī)構(gòu)的研究及應(yīng)用逐步成熟，為移苗移栽設(shè)備的構(gòu)型設(shè)計提供了新的思路[5]。其中，Delta機(jī)構(gòu)具有優(yōu)異的綜合性能，剛度大、響應(yīng)靈敏，并且無誤差積累，得到了廣泛應(yīng)用[6-9]。

視覺伺服策略對未來的智能農(nóng)業(yè)機(jī)器人具有重要意義，借助機(jī)器視覺，可以對作業(yè)對象精確定位，為機(jī)械臂的軌跡規(guī)劃提供動態(tài)信息[10-11]。本文在前人對Delta并聯(lián)移苗機(jī)械臂運動學(xué)研究基礎(chǔ)上，設(shè)計了視覺伺服系統(tǒng)，通過對所采集圖像處理，對缽體中的幼苗進(jìn)行識別和定位，處理結(jié)果作為機(jī)械臂軌跡規(guī)劃的依據(jù)，再通過反向運動學(xué)計算主動臂的角度變化，即控制量。

1? ? 運動控制的視覺處理

1.1? ? 視覺處理方案設(shè)計

為了使末端執(zhí)行器可以準(zhǔn)確地規(guī)劃路徑抓取目標(biāo)，需要對系統(tǒng)采集到的圖像進(jìn)行處理。由于缽體在同一平面內(nèi)，因而圖像的處理可以忽略高度方向的影響，能夠完成平面定位即可。視覺識別的流程如圖1所示。

1.2? ? 視覺處理程序

視覺系統(tǒng)采集到的圖像，通過Matlab進(jìn)行處理，一方面檢測育苗盆中秧苗狀況，另一方面計算作業(yè)對象的位置，例如對缺苗或者病態(tài)的幼苗進(jìn)行甄別與定位。由圖2（a）可以明顯檢測到育苗盤各個缽體的整體狀態(tài)，既有正常幼苗，又有缺苗情況。對圖像進(jìn)行腐蝕處理，過濾缺苗缽體圖像，然后進(jìn)行膨脹處理，最后用黑色掩膜替換原圖背景，得到預(yù)處理效果圖，如圖2（b）所示。其中，腐蝕處理用Imerode函數(shù)實現(xiàn)，膨脹處理用Imdilate函數(shù)實現(xiàn)。

因為育苗盤是標(biāo)準(zhǔn)的，所以幼苗的質(zhì)心位置也是確定的。對圖像進(jìn)行分割處理，然后再對每個方格的幼苗進(jìn)行單獨處理，按照像素對幼苗進(jìn)行分類。通過Bwlabel函數(shù)返回的num值甄別缺苗缽體（圖3）。通過統(tǒng)計各缽體中幼苗的像素，即葉片面積作為幼苗是否健康的判別條件。

求解出幼苗質(zhì)心，通過轉(zhuǎn)換公式，將質(zhì)心轉(zhuǎn)換成三維空間坐標(biāo)。幼苗質(zhì)心的處理圖像如圖4所示。

2? ? Delta機(jī)械臂反向運動學(xué)

2.1? ? 位置逆解

基于Delta并聯(lián)機(jī)構(gòu)的機(jī)械臂模型由3條支鏈、靜平臺和動平臺組成，驅(qū)動電機(jī)安裝在靜平臺上，每條支鏈?zhǔn)怯蓴[桿帶動，進(jìn)而帶動平臺運動（圖5）。在靜平臺中心建立坐標(biāo)系，動平臺以P作為參考點，所以等邊三角形A1A2A3表示靜平臺，AiBi（i=1，2，3）表示擺桿，AiBi=l1;PBi（i=1，2，3）表示支鏈，PBi=l2，OAi=R，基礎(chǔ)坐標(biāo)系O-xyz固結(jié)在靜平臺上，θi是（i=1，2，3）擺桿AiBi（i=1，2，3）和靜平臺的夾角。

在已知作業(yè)對象位置情況下，并聯(lián)機(jī)構(gòu)的路徑規(guī)劃實際上是運動學(xué)逆解，即已知末端位置求解主動關(guān)節(jié)的關(guān)節(jié)變量。本文未將運動學(xué)正解列出，完整的運動學(xué)分析過程已經(jīng)另一篇文章中敘述[12]。根據(jù)圖6，參考點P的位置矢量：

3? ? 作業(yè)軌跡規(guī)劃

3.1? ? 作業(yè)路線分析

根據(jù)設(shè)定場景，如剔除病態(tài)幼苗作業(yè)，育苗區(qū)的圖像經(jīng)CCD采集并處理，獲取缽體位置信息，經(jīng)過運動學(xué)反解出控制量，末端執(zhí)行器執(zhí)行剔苗操作[15]。根據(jù)具體的作業(yè)過程，作業(yè)軌跡包括抓取與放置時的豎直方向運動，能夠避開障礙物，常選擇簡單的直線運動。

剔除過程包括取苗和放置，整個過程優(yōu)先保證效率，既要快速，又要平穩(wěn)無剛性沖擊。根據(jù)上述分析，一個典型的作業(yè)過程中，作業(yè)軌跡的起點（取苗）與終點（放置）速度及加速度均為0，送苗過程中，位移對時間的一、二階導(dǎo)數(shù)連續(xù)，三階導(dǎo)數(shù)為有限值。為此，本文采用5次多項式光滑階躍函數(shù)規(guī)律。

3.2? ? 運動學(xué)仿真分析

穴盤寬度為280 mm，2個穴盤間距為100 mm，起點與終點在X和Y方向上相對距離均為340 mm，機(jī)械臂的動平臺位于2點連線中點的垂直上方。多體系統(tǒng)動力學(xué)仿真軟件RecurDyn中提供了5次多項式逼近海塞（Heaviside）階躍函數(shù)STEP5，能夠滿足“平穩(wěn)無剛性沖擊”的條件。圖7（a）為動平臺運動軌跡在X、Y、Z方向的投影，X向與Y向位移變化相似。根據(jù)動平臺位移曲線，主動臂的控制量。3個關(guān)節(jié)角變化曲線如圖7（b）所示，整個過程平滑無沖擊，反映了與動平臺之間的映射關(guān)系。圖7（c）分別為3個主動臂角速度變化曲線，在整個作業(yè)過程中，同樣為平滑無突變。圖7（d）為3個擺桿角加速度，作業(yè)過程中能夠無突變地過渡。

4? ? 結(jié)語

本文結(jié)合了并聯(lián)機(jī)構(gòu)與機(jī)器視覺2個熱門研究領(lǐng)域，通過圖像分析幼苗狀況并定位作業(yè)目標(biāo)，規(guī)劃并聯(lián)機(jī)械臂末端執(zhí)行器的軌跡，再通過反向運動學(xué)解算出主動臂的關(guān)節(jié)角。通過仿真分析可知，基于視覺和反向運動學(xué)的控制策略，能夠高效率、高精度實現(xiàn)運動控制。

5? ? 參考文獻(xiàn)

[1] 魏旭東，史穎剛，劉利付，等.基于ZigBee的溫室環(huán)境檢測系統(tǒng)設(shè)計[J].內(nèi)蒙古農(nóng)業(yè)大學(xué)學(xué)報（自然科學(xué)版），2016（4）：90-99.

[2] 于曉旭，趙勻，陳寶成，等.移栽機(jī)械發(fā)展現(xiàn)狀與展望[J].農(nóng)業(yè)機(jī)械學(xué)報，2014，45（8）：44-53.

[3] 劉濤，張賓，鄭承云.溫室機(jī)器人導(dǎo)航系統(tǒng)設(shè)計與性能測試[J].內(nèi)蒙古農(nóng)業(yè)大學(xué)學(xué)報（自然科學(xué)版），2013（2）：108-111.

[4] 趙大旭，壽國忠，顧玉琦，等.6自由度3P3R溫室服務(wù)機(jī)械臂運動學(xué)分析[J].機(jī)床與液壓，2015，43（5）：9-12.

[5] 胡建平，靳合琦，常燕超，等.基于Delta并聯(lián)機(jī)構(gòu)缽苗移栽機(jī)器人尺度綜合與軌跡規(guī)劃[J].農(nóng)業(yè)機(jī)械學(xué)報，2017，48（5）：28-35.

[6] KIM S M，KIM W，YI B J.Kinematic analysis and optimal design of a 3T1R type parallel mechanism[C]//IEEE International Conference on Robotics and Automation.IEEE Press，2009：3737-3742.

[7] PIERROT F，NABAT V，COMPANY O，et al.Optimal design of a 4-DOF parallel manipulator：From academia to industry[J].IEEE Transactions on Robotics，2009，25（2）：213-224.

[8] 史振靈，張國英.Delta機(jī)器人工作空間與力矩傳遞性能分析[J].機(jī)床與液壓，2016，44（17）：8-11.

[9] ZHANG L M，MEI J P，ZHAO X M，et al.Imensional synthesis of the delta robot using transmission angle constraintsDimensional synthesis of the delta robot using transmission angle constraints[J].Robotica，2012，30（3）：343-349.

[10] 宋家慧，孔令美.采摘機(jī)器人視覺伺服策略研究：基于回歸數(shù)據(jù)挖掘的[J].農(nóng)機(jī)化研究，2016（12）：81-85.

[11] 張璐，郭奇青.采摘機(jī)器人選擇性作業(yè)信息獲取研究：基于無標(biāo)定視覺伺服系統(tǒng)[J].農(nóng)機(jī)化研究，2017，39（5）：241-245.

[12] 王韌，趙大旭，楊秀芳，等.Delta型并聯(lián)移苗移栽機(jī)械臂運動學(xué)分析[J].內(nèi)蒙古農(nóng)業(yè)大學(xué)學(xué)報（自然科學(xué)版），2018，39（6）：79-83.

[13] 張利敏.一種三平動高速并聯(lián)機(jī)械手設(shè)計方法研究[D].天津：天津大學(xué)，2009.

[14] 楊秀芳，孫有朝，趙大旭，等.Delta并聯(lián)3D打印機(jī)運動學(xué)分析[J].重慶理工大學(xué)學(xué)報（自然科學(xué)版），2019，33（2）：75-81.

[15] 趙杰，朱延河，蔡鶴皋.Delta型并聯(lián)機(jī)器人運動學(xué)正解幾何解法[J].哈爾濱工業(yè)大學(xué)學(xué)報，2003，35（1）：25-27.