基于Delta并聯(lián)機構(gòu)缽苗移栽機器人尺度綜合與軌跡規(guī)劃

胡建平 靳合琦 常燕超 劉 偉 韓綠化 楊啟志

(江蘇大學(xué)現(xiàn)代農(nóng)業(yè)裝備與技術(shù)教育部重點實驗室， 鎮(zhèn)江 212013)

基于Delta并聯(lián)機構(gòu)缽苗移栽機器人尺度綜合與軌跡規(guī)劃

胡建平 靳合琦 常燕超 劉 偉 韓綠化 楊啟志

(江蘇大學(xué)現(xiàn)代農(nóng)業(yè)裝備與技術(shù)教育部重點實驗室， 鎮(zhèn)江 212013)

Delta并聯(lián)機構(gòu)具有速度快、運動精度高、靈活性強等特點，非常適合穴盤育苗過程中的移缽作業(yè)及補苗需要。基于三自由度Delta并聯(lián)機構(gòu)和氣動取苗爪，設(shè)計了一種高速缽苗移栽機器人。通過建立Delta并聯(lián)機構(gòu)的單支鏈約束方程，求解出缽苗移栽機器人的可達(dá)工作空間；為使其可達(dá)工作空間盡可能接近設(shè)計工作空間，以機構(gòu)雅可比矩陣條件數(shù)作為懲罰條件，建立起兼顧缽苗移栽機器人整機尺寸與運動學(xué)性能的尺度綜合目標(biāo)函數(shù)，并應(yīng)用遺傳算法得到機構(gòu)最優(yōu)尺寸參數(shù)。根據(jù)盤到盤缽苗移栽的運動要求，對移栽軌跡進(jìn)行規(guī)劃并選取五次多項式作為移栽動平臺的運動規(guī)律函數(shù)?；跈C構(gòu)尺度綜合和軌跡規(guī)劃設(shè)計物理樣機，并進(jìn)行盤到盤的缽苗移栽和健壯苗補苗性能試驗，結(jié)果表明：隨著移栽動平臺攜苗運動最大加速度的提高，缽?fù)疗扑槁手饾u加大，缽苗移栽合格率逐漸降低，在最大加速度amax為30 m/s2時，缽苗移栽合格率可達(dá)95.5%，移栽速率可達(dá)2 149株/h，在此加速度下進(jìn)行健壯苗補苗試驗，補苗合格率可達(dá)92%，證明了將Delta并聯(lián)機構(gòu)用于缽苗移栽機器人的可行性，以及尺度綜合和軌跡規(guī)劃的合理性。

缽苗移栽； 并聯(lián)機構(gòu)； 尺度綜合； 軌跡規(guī)劃； 性能試驗

引言

缽苗移栽是溫室穴盤育苗生產(chǎn)中的重要環(huán)節(jié)，人工作業(yè)繁重，正逐步被機械化移栽設(shè)備所取代[1]。近年來，荷蘭、美國、韓國等研制了多種用于溫室作業(yè)生產(chǎn)線的大型缽苗移栽機，其作業(yè)效率達(dá)800～1 000次/h，最多可擴展32組移栽手爪,但其結(jié)構(gòu)復(fù)雜、價格昂貴、體積大，與我國現(xiàn)階段設(shè)施農(nóng)業(yè)生產(chǎn)模式不適應(yīng)[2-3]。目前，國內(nèi)馮青春等[4]、周婷等[5]針對蔬菜缽苗自動移栽機也進(jìn)行了相關(guān)研究，并取得一定進(jìn)展，但其移栽動平臺多采用伺服電機驅(qū)動的門型結(jié)構(gòu)，采用這種結(jié)構(gòu)的移栽機，一方面，高速移苗時會產(chǎn)生較大震動，重復(fù)精度差；另一方面，機構(gòu)的運動靈活性較差，功能單一，相對產(chǎn)業(yè)化應(yīng)用要求仍存有諸多技術(shù)瓶頸需要突破[4]。

Delta并聯(lián)機構(gòu)具有3個運動自由度，整體結(jié)構(gòu)簡單、緊湊，驅(qū)動部分均布于固定平臺，具有速度快、剛性好、震動小、累計誤差小的優(yōu)點?；谄涮攸c，本文設(shè)計一種基于Delta并聯(lián)機構(gòu)的缽苗移栽機器人，實現(xiàn)健壯缽苗移栽、補苗等功能。相比傳統(tǒng)門框式溫室移栽機，基于Delta并聯(lián)機構(gòu)的缽苗移栽機器人具有震動小、重復(fù)精度高、三自由度移栽的優(yōu)點。適合在我國中小型溫室育苗工廠推廣使用[6]。

1 缽苗移栽機器人尺度綜合

1.1 缽苗移栽機器人工作原理

如圖1所示,高速缽苗移栽機器人由定平臺、主動臂、從動臂、動平臺和安裝在動平臺上的取苗爪組成。主動臂安裝在定平臺上，由伺服電機驅(qū)動，通過從動臂，驅(qū)動動平臺在工作空間內(nèi)完成移苗運動。供植苗盤通過傳送帶進(jìn)給到缽苗移栽機器人的工作空間，經(jīng)過視覺識別裝置，確定供苗盤中健壯苗的坐標(biāo)信息或植苗盤中需要補苗的穴孔坐標(biāo)信息。當(dāng)缽苗移栽機器人處于健康苗移栽工況時， Delta并聯(lián)機構(gòu)驅(qū)動取苗爪將健壯苗從高密度供苗盤移栽到低密度植苗盤；當(dāng)缽苗移栽機器人處于補苗工況時，Delta并聯(lián)機構(gòu)驅(qū)動取苗爪順序抓取供苗盤中的缽苗，移栽到植苗盤中需要補苗的穴孔中。

圖1 高速缽苗移栽機器人結(jié)構(gòu)簡圖Fig.1 Sketch of high-speed plug transplanting robot1.定平臺 2.主動臂 3.從動臂 4.動平臺 5.取苗爪 6.缽苗 7.植苗盤 8.供苗盤 9.傳送帶

1.2 缽苗移栽機器人可達(dá)工作空間分析

圖2 Delta并聯(lián)機構(gòu)結(jié)構(gòu)簡圖Fig.2 Sketch of Delta parallel translation mechanism

作為缽苗移栽機器人的驅(qū)動單元，Delta并聯(lián)機構(gòu)由定平臺、3條相同的支鏈、動平臺組成。主動臂通過轉(zhuǎn)動副安裝在定平臺上，從動臂通過球鉸上端與主動臂連接，下端通過球鉸與動平臺連接，其結(jié)構(gòu)簡圖如圖2所示。在定平臺中心建立直角坐標(biāo)系Oxyz，對于每一條支鏈，設(shè)定平臺半徑lOAi=R,從動臂lBiCi=L1,主動臂lAiBi=L2,動平臺半徑lPCi=r,動平臺中心P點坐標(biāo)為(xp,yp,zp),Bi和Ci在坐標(biāo)系中的位置矢量可以表示為

由lBiCi=L1,得并聯(lián)機構(gòu)的單支鏈約束方程

(1)

其中xi=L2cosφicosθi+ecosφiyi=L2sinφicosθi+esinφizi=L2sinθi

將式(1)改寫成關(guān)于θi的方程

kicosθi+misinθi+ni=0

(2)

其中ki=2eL2-2L2xpcosφi-2L2ypsinφi

當(dāng)且僅當(dāng)

即

(3)

方程(2)有解，即已知動平臺中心P點坐標(biāo)(xp,yp,zp),可求得各主動臂轉(zhuǎn)角。將機構(gòu)參數(shù)代入方程(3)，得到

(4)

圖3 Delta并聯(lián)機構(gòu)可達(dá)工作空間Fig.3 Workspace of Delta parallel mechanism

1.3 缽苗移栽機器人尺度綜合

已知單個穴盤的尺寸為560 mm×280 mm，兩穴盤間距100 mm，移苗時提升高度150 mm,因機構(gòu)的設(shè)計工作空間要大于實際工作空間，取缽苗移栽機器人的設(shè)計工作空間為長800 mm、寬800 mm、高200 mm的長方體W。

缽苗移栽機器人的尺度綜合問題為已知設(shè)計工作空間W的大小，確定缽苗移栽機器人的尺寸參數(shù)L1、L2、e,以及工作空間上表面距離缽苗移栽機器人定平臺的高度H，使缽苗移栽機器人的可達(dá)工作空間包含設(shè)計工作空間W，同時在保證缽苗移栽機器人運動性能的前提下使缽苗移栽機器人的可達(dá)工作空間的邊界盡可能接近設(shè)計工作空間W，從而使缽苗移栽機器人的整機尺寸較小。

利用Matlab遺傳算法求解缽苗移栽機器人的最優(yōu)尺寸參數(shù)(L1,L2,e,H)[8-10]。

1.3.1 主函數(shù)建立

如圖4所示，缽苗移栽機器人的設(shè)計工作空間W可以用QK(K=1，2，…，8)8個點表示，要保證缽苗移栽機器人的可達(dá)工作空間包含設(shè)計工作空間W，只需保證缽苗移栽機器人的可達(dá)工作空間包含QK8個點即可，即hi(QK)≤0(i=1,2,3;K=1，2，…，8)。同時，當(dāng)QK位于可達(dá)工作空間內(nèi)時，|hi(QK)|為QK與可達(dá)工作空間表面距離的權(quán)值，QK距離表面越近，|hi(QK)|越小，當(dāng)QK位于工作空間的邊界上時，|hi(QK)|=0?，F(xiàn)定義主函數(shù)

F1被定義為QK與可達(dá)工作空間邊界距離權(quán)值的和。F1越小，缽苗移栽機器人的可達(dá)工作空間的邊界越接近設(shè)計工作空間W[11-13]。

圖4 設(shè)計工作空間簡圖Fig.4 Sketch of design workspace

1.3.2 基于空間點位置的懲罰函數(shù)建立

尺度綜合中，為保證缽苗移栽機器人的可達(dá)工作空間包含QK各點，定義懲罰函數(shù)

式中cf——無窮大的正數(shù)

1.3.3 基于并聯(lián)機構(gòu)運動學(xué)性能的懲罰函數(shù)建立

Delta并聯(lián)機構(gòu)的雅可比矩陣條件數(shù)cond(J)通常被用于衡量并聯(lián)機構(gòu)在某點的運動學(xué)性能，在缽苗移栽機器人設(shè)計工作空間W內(nèi)，當(dāng)cond(J)<5時機構(gòu)具有較優(yōu)的運動學(xué)性能[14]。將式(1)對時間t求導(dǎo)，可得機構(gòu)的雅可比矩陣

J=A-1B

其中

對缽苗移栽機器人設(shè)計工作空間W內(nèi)的條件數(shù)cond(J)進(jìn)行搜索，構(gòu)建第2個懲罰函數(shù)

當(dāng)存在大于5的情況時，F(xiàn)3取無窮大的正數(shù)。

1.3.4 目標(biāo)函數(shù)建立及最優(yōu)尺寸參數(shù)求解

定義目標(biāo)函數(shù)

F=F1+F2+F3

利用Matlab遺傳算法工具箱求解目標(biāo)函數(shù)F的最小值，使Delta并聯(lián)機構(gòu)可達(dá)工作空間盡可能接近缽苗移栽機器人設(shè)計工作空間W。懲罰函數(shù)F2保證設(shè)計空間W內(nèi)的各點包含在Delta并聯(lián)機構(gòu)的可達(dá)工作空間內(nèi)；懲罰函數(shù)F3保證在設(shè)計工作空間W內(nèi)，缽苗移栽機器人具有較優(yōu)的運動學(xué)性能。遺傳算法參數(shù)為:種群規(guī)模Ps=70、進(jìn)化代數(shù)n=100、變量個數(shù)N=4、交叉率Pc=0.95、變異率Pm=0.01。尺寸變量的取值范圍為：0

為方便加工安裝，將得到的(L1,L2,e,H)圓整，得(L1,L2,e,H)=(800，325，160，545)mm。為驗證所得最優(yōu)尺寸的合理性，分別繪制缽苗移栽機器人設(shè)計工作空間W上工作表面(z=545 mm)和下工作表面(z=745 mm)的工作空間截面圖和條件數(shù)cond(J)的分布圖，如圖5、6所示。

圖5 設(shè)計工作空間W上表面截面圖Fig.5 Cross-section of upper surface of design workspace W

圖6 設(shè)計工作空間W下表面截面圖Fig.6 Cross-section of lower surface of design workspace W

圖7 設(shè)計工作空間W上表面條件數(shù)分布圖Fig.7 Distribution of cond(J) on upper surface of design workspace W

圖8 設(shè)計工作空間W下表面條件數(shù)分布圖Fig.8 Distribution of cond(J) on lower surface of design workspace W

由圖5、6可以得出，設(shè)計工作空間的上、下表面包含在缽苗移栽機器人的3條支鏈的圓環(huán)空間內(nèi)；圖7、8表明，設(shè)計工作空間W上、下表面的條件數(shù)cond(J)分布在1～5之間，說明缽苗移栽機器人在設(shè)計工作空間W內(nèi)具有良好的運動學(xué)性能。證明了所得缽苗移栽機器人尺寸參數(shù)(L1,L2,e,H)=(800，325，160，545)mm的合理性。

2 缽苗移栽機器人運動軌跡規(guī)劃

2.1 運動軌跡規(guī)劃

穴盤缽苗移栽過程中，缽苗移栽機器人根據(jù)工作需求，在供苗盤和植苗盤的任意兩穴孔間進(jìn)行健壯苗移栽或補苗操作[15]，每個缽苗的移栽需經(jīng)過取苗s1、送苗s2、植苗s33個直線運動過程，如圖9所示。

圖9 缽苗移栽示意圖Fig.9 Sketch of plug seeding transplanting

對于每段直線軌跡，設(shè)定取苗爪的運動規(guī)律為停止→加速→減速→停止。要實現(xiàn)這個規(guī)律，必須滿足：

(1)動平臺的速度和加速度在軌跡的起點和終點處為零。

(2)位移運動規(guī)律關(guān)于時間的一階和二階導(dǎo)數(shù)必須是連續(xù)的。

(3)位移運動規(guī)律三階導(dǎo)數(shù)﹙即加速度導(dǎo)數(shù)﹚是有限的，否則將引起震動，以保證取苗機械手不受到?jīng)_擊。

2.2 運動規(guī)律的選擇

在不超過給定最大加速度條件下，滿足上述運動軌跡要求的運動規(guī)律有正弦規(guī)律、擺線規(guī)律、梯形曲線、五次和七次多項式運動規(guī)律[16-19]。由于五次多項式運動規(guī)律具有周期短、速度波動小等優(yōu)點[20]，本文以五次多項式運動規(guī)律為動平臺取苗爪各階段運動規(guī)律，它們在已知位移s和最大加速度amax的條件下，計算公式為

(5)

(6)

(7)

(8)

式中s——直線位移t——動平臺運動時間a——動平臺加速度v——動平臺速度T——完成位移s所需時間

對于每次移栽，缽苗的提升和下降高度s1=s3=150 mm,s2為每次移栽的穴孔中心距，故s1、s2、s3為已知量?，F(xiàn)需確定最大加速度amax，便能得到每段位移的速度v、加速度a和時間T。在缽苗移栽過程中，如果動平臺末端最大加速度amax過大，會出現(xiàn)缽?fù)疗扑榈那闆r，因此可通過缽苗移栽試驗得到缽苗移栽的最大加速度amax。

3 移栽補苗性能試驗

3.1 移栽性能試驗

缽苗移栽機器人在工作空間內(nèi)良好的運動學(xué)性能是實現(xiàn)健康苗移栽、補苗等功能的基礎(chǔ)；現(xiàn)以動平臺末端最大加速度amax作為試驗變量，進(jìn)行缽苗移栽試驗，檢驗缽苗移栽機器人在設(shè)計工作空間內(nèi)是否具有良好的運動學(xué)性能。

3.1.1 試驗設(shè)計與步驟

(1)試驗?zāi)康模捍_定最適合缽苗移栽的動平臺最大加速度amax；驗證缽苗移栽機器人尺度綜合、軌跡規(guī)劃的合理性，證明缽苗移栽機器人具有良好的運動學(xué)性能。

(2)試驗對象：苗齡為20 d的津優(yōu)1號黃瓜苗，缽?fù)梁蕿?5%～50%，平均高度為113.6 mm。

(3)試驗方案：以五次多項式運動規(guī)律作為動平臺的運動規(guī)律，將攜苗運行段的最大加速度amax依次設(shè)為10、20、30、40、50 m/s2，空載運行段的最大加速度設(shè)為50 m/s2，取苗爪提升高度設(shè)為150 mm，穴盤間距設(shè)為100 mm，進(jìn)行72(6×12)穴孔到50(5×10)穴孔的缽苗移栽試驗，穴盤規(guī)格見表1。

表1 穴盤規(guī)格參數(shù)Tab.1 Parameters of plug trays

取苗爪自供苗盤中按從內(nèi)側(cè)到外側(cè)的順序依次取苗，再到植苗盤中按從外側(cè)到內(nèi)側(cè)的順序依次植苗，如圖10、11所示；其中，每次移栽包括取苗、運苗、植苗3個階段，若在一次移栽過程中沒有出現(xiàn)掉苗、缽?fù)疗扑榈那闆r，則本次移栽合格。當(dāng)植苗盤中的50株幼苗被全部植滿，更換新的供苗盤和植苗盤，重復(fù)試驗4次。試驗結(jié)果見表2。

圖10 缽苗移栽示意圖Fig.10 Sketch of plug transplanting

圖11 缽苗移栽試驗Fig.11 Plug seeding transplanting tests

3.1.2 試驗結(jié)果分析

由表2可以看出，缽苗移栽的最大加速度amax

超過30 m/s2時，掉苗數(shù)和缽?fù)疗扑槁拭黠@增加，移栽合格率顯著降低，另一方面，缽苗移栽時取苗爪的張合、出針、收針過程占據(jù)移栽過程較多時間，最大加速度amax繼續(xù)增大對移栽效率的提升意義較小，因此選取缽苗移栽的最佳最大加速度amax為30 m/s2。在該最大加速度下運行的缽苗移栽機器人的缽苗移栽合格率為95.5%，缽?fù)疗扑槁瘦^低，移栽速率為2 149株/h,證明缽苗移栽機器人能在設(shè)計工作空間內(nèi)具有良好的運動學(xué)性能。

3.2 補苗試驗

缽苗移栽機器人進(jìn)行補苗操作時，由于需要補苗的穴孔無規(guī)律地分散在育苗穴盤中，在實際補苗過程中，會出現(xiàn)取苗穴孔和補苗穴孔中心距較大的情況，在這些移苗路徑上，缽苗移栽機器人的運動學(xué)性能會發(fā)生較大的變化，這對補苗成功率具有一定影響，現(xiàn)通過模擬補苗過程中可能出現(xiàn)的最遠(yuǎn)路徑進(jìn)行補苗試驗，驗證缽苗移栽機器人補苗穩(wěn)定性。

表2 缽苗移栽試驗結(jié)果Tab.2 Test results of plug transplanting

注：缽?fù)疗扑槁蕿槔復(fù)疗扑橹陻?shù)與試驗總數(shù)之比；移栽合格率為(試驗總數(shù)-缽?fù)疗扑橹陻?shù)-掉苗株數(shù))與試驗總數(shù)之比。

3.2.1 試驗設(shè)計與步驟

(1)試驗?zāi)康模候炞C缽苗移栽機器人的補苗穩(wěn)定性。

(2)試驗對象：苗齡為20 d的津優(yōu)1號黃瓜苗，缽?fù)梁蕿?5%～50%，平均高度為113.6 mm。

(3)試驗方案：以五次多項式運動規(guī)律作為動平臺的運動規(guī)律，將攜苗運行段的最大加速度amax設(shè)為30 m/s2，空載回程運行段的最大加速度設(shè)為50 m/s2，取苗爪提升高度設(shè)為150 mm，穴盤間距設(shè)為100 mm，進(jìn)行72(6×12)穴孔到50(5×10)穴孔的補苗試驗。

選取植苗盤中a、b、c、d4個對角點作為補苗點(圖12)，取苗爪自供苗盤中按從內(nèi)側(cè)到外側(cè)的順序依次取苗，將A1、B1、C1、D1分別移栽到a、b、c、d4個穴孔中，隨后將a、b、c、d4個穴孔中的缽苗取出，再將A2、B2、C2、D2分別移栽到a、b、c、d4個穴孔中，重復(fù)上述步驟直至供苗盤中的缽苗被全部取完，更換新的供苗盤重復(fù)試驗4次，試驗結(jié)果為：試驗總數(shù)288株，缽?fù)疗扑閿?shù)16株，掉苗數(shù)7株，缽?fù)疗扑槁?.6%，補苗合格率92%。

3.2.2 試驗結(jié)果分析

由試驗結(jié)果可以看出，在取苗穴孔和補苗穴孔中心距較遠(yuǎn)情況下，缽苗移栽機器人進(jìn)行補苗操作時的缽?fù)疗扑槁蕿?.6%，補苗合格率為92%,說明缽苗移栽機器人在設(shè)計工作空間能夠可靠、平穩(wěn)地實現(xiàn)補苗操作，驗證了缽苗移栽機器人尺度綜合和軌跡規(guī)劃的合理性。

圖12 補苗示意圖Fig.12 Sketch of plug seedling filling

4 結(jié)論

(1)基于Delta并聯(lián)機構(gòu)設(shè)計一種高速缽苗移栽機器人，根據(jù)缽苗移栽的設(shè)計工作空間，提出一種兼顧缽苗移栽機器人整機尺寸與運動學(xué)性能的尺度綜合方法，借助Matlab遺傳算法工具箱得到缽苗移栽機器人的最優(yōu)尺寸參數(shù)。通過繪制缽苗移栽設(shè)計工作空間W的表面截面圖和條件數(shù)分布圖，理論證明所得尺度參數(shù)的合理性。相比傳統(tǒng)的將機構(gòu)靈活性作為優(yōu)化目標(biāo)的尺度綜合方法，本方法可以兼顧缽苗移栽機器人運動學(xué)性能的同時使整機尺寸較小。

(2)針對缽苗移栽的運動要求，對缽苗移栽機器人進(jìn)行軌跡規(guī)劃，并選取五次多項式運動規(guī)律作為缽苗移栽機器人動平臺的運動函數(shù)。

(3)為確定最適合缽苗移栽的攜苗運動最大加速度amax，對缽苗移栽機器人進(jìn)行移栽性能試驗與補苗試驗，結(jié)果表明：隨著移栽動平臺最大攜苗運動加速度的增加，缽?fù)疗扑槁手饾u增加，缽苗移栽合格率逐漸降低，在最大加速度amax為30 m/s2時，缽苗移栽合格率可達(dá)95.5%，移栽速率可達(dá)2 149株/h，在此加速度下進(jìn)行健壯苗補苗試驗，補苗合格率可達(dá)92%，證明缽苗移栽機器人在設(shè)計工作空間中具有良好的運動學(xué)性能，驗證了尺度綜合和軌跡規(guī)劃的合理性。

1 王榮華，邱立春，田素博.我國穴盤苗機械化生產(chǎn)的現(xiàn)狀與發(fā)展[J].農(nóng)機化研究,2008(7):230-231. WANG Ronghua, QIU Lichun, TIAN Subo. Status and development of mechanized processing of plug seedling in China[J]. Journal of Agricultural Mechanization Research, 2008(7):230-231.(in Chinese)

2 張振國,曹衛(wèi)彬,王僑，等. 穴盤苗自動移栽機的發(fā)展現(xiàn)狀與展望[J]. 農(nóng)機化研究,2013(5):237-241. ZHANG Zhenguo, CAO Weibin, WANG Qiao, et al. Development status and prospect of plug seedlings automatic transplanting machine[J]. Journal of Agricultural Mechanization Research, 2013(5):237-241.(in Chinese)

3 馮青春,王秀. 穴盤缽苗智能移栽機關(guān)鍵技術(shù)研究現(xiàn)狀[J]. 農(nóng)機化研究,2013(11):250-252. FENG Qingchun, WANG Xiu. Development of research on automatic transplanter for tray seedlings[J]. Journal of Agricultural Mechanization Research, 2013(11):250-252. (in Chinese)

4 馮青春,王秀,姜凱，等.花卉幼苗自動移栽機關(guān)鍵部件設(shè)計與試驗[J].農(nóng)業(yè)工程學(xué)報,2013,29(6):21-27. FENG Qingchun,WANG Xiu,JIANG Kai,et al.Design and test of key parts on automatic transplanter for flower seedling information[J].Transactions of the CSAE, 2013, 29(6):21-27. (in Chinese)

5 周婷,汪小旵,王超群,等. 溫室穴盤苗移栽機的設(shè)計與仿真分析[J]. 機械設(shè)計與研究，2009，25(2)：121-124. ZHOU Ting, WANG Xiaochan, WANG Chaoqun, et al.Design and simulation analysis of transplanter for potted tray seedlings in greenhouse [J]. Machine Design and Research, 2009, 25(2): 121-124. (in Chinese)

6 馮李航,張為公,龔宗洋,等. Delta系列并聯(lián)機器人研究進(jìn)展與現(xiàn)狀[J]. 機器人,2014,36(3):375-384. FENG Lihang, ZHANG Weigong, GONG Zongyang, et al. Developments of Delta-like parallel manipulators—a review[J]. Robot, 2014, 36(3):375-384.(in Chinese)

7 高秀蘭, 魯開講, 王娟平. Delta并聯(lián)機構(gòu)工作空間解析及尺度綜合[J]. 農(nóng)業(yè)機械學(xué)報, 2008, 39(5):146-149. GAO Xiulan, LU Kaijiang,WANG Juanping. Workspace resolution and dimensional synthesis on Delta parallel mechanism[J]. Transactions of the Chinese Society for Agricultural Machinery, 2008, 39(5):146-149.(in Chinese)

8 張良安, 萬俊, 譚玉良. Ahut-Delta并聯(lián)機構(gòu)改進(jìn)混沌粒子群算法尺度綜合[J/OL]. 農(nóng)業(yè)機械學(xué)報, 2015, 46(8):344-351. http:∥www.j-csam.org/jcsam/ch/reader/view_abstract.aspx?file_no=20150848&flag=1.DOI：10.6041/j.issn.1000-1298.2015.08.048. ZHANG Liang’an, WAN Jun, TAN Yuliang. Dimensional synthesis of Ahut-Delta parallel mechanism based on improved chaotic particle swarm algorithm[J/OL]. Transactions of the Chinese Society for Agricultural Machinery, 2015, 46(8):344-351.(in Chinese)

9 梁昔明, 秦浩宇, 龍文. 一種求解約束優(yōu)化問題的遺傳算法[J]. 計算機工程, 2010, 36(14):147-149. LIANG Ximing, QIN Haoyu, LONG Wen. Genetic algorithm for solving constrained optimization problem[J]. Computer Engineering, 2010, 36(14):147-149.(in Chinese)

10 王平, 鄭松林, 吳光強. 基于協(xié)同優(yōu)化和多目標(biāo)遺傳算法的車身結(jié)構(gòu)多學(xué)科優(yōu)化設(shè)計[J]. 機械工程學(xué)報, 2011, 47(2):102-108. WANG Ping, ZHENG Songlin,WU Guangqiang. Multidisciplinary design optimization of vehicle body structure based on collaborative optimization and multi-objective genetic algorithm[J]. Journal of Mechanical Engineering, 2011, 47(2):102-108.(in Chinese)

11 GOLDBERG D E, SAMTANI M P. Engineering optimization via genetic algorithm[C]∥ Proceedings 9th Conference Electronic Computation, ASCE,1987:471-482.

12 CASTRO H F D. Availability optimization with genetic algorithm[J]. International Journal of Quality & Reliability Management, 2013, 20(7):847-863.

13 LARIBI M A, ROMDHANE L, ZEGHLOUL S. Analysis and dimensional synthesis of the DELTA robot for a prescribed workspace[J]. Mechanism & Machine Theory, 2007, 42(7):859-870.

14 汪滿新, 黃田. 面對稱3-SPR并聯(lián)機構(gòu)的運動學(xué)分析與尺度綜合[J]. 機械工程學(xué)報, 2013, 49(15):22-27. WANG Manxin,HUANG Tian. Kinematics analysis and dimensional synthesis of a plane symmetric 3-SR parallel manipulator[J]. Journal of Mechanical Engineering, 2013, 49(15):22-27.(in Chinese)

15 童俊華,蔣煥煜,武傳宇. 基于貪心算法的溫室缽苗稀植移栽路徑優(yōu)化[J/OL]. 農(nóng)業(yè)機械學(xué)報,2016,47(3):8-13.http:∥www.j-csam.org/jcsam/ch/reader/view_abstract.aspx?file_no=20160302&flag=1.DOI：10.6041/j.issn.1000-1298.2016.03.002. TONG Junhua,JIANG Huanyu,WU Chuanyu.Optimization of seedlings lower density transplanting path based on greedy algorithm[J/OL]. Transactions of the Chinese Society for Agricultural Machinery,2016,47(3):8-13. (in Chinese)

16 何平, 劉宏, 金明河. 基于樣條函數(shù)的機器人軌跡規(guī)劃方法[J]. 機器人,2003,25(增刊1):614-618. HE Ping,LIU Hong,JIN Minghe.Trajectory planning of robot manipulator based on spline function[J].Robot,2003, 25(Supp.1):614-618. (in Chinese)

17 田西勇. 機器人軌跡規(guī)劃方法研究[D].北京：北京郵電大學(xué), 2008.

18 陳偉華, 張鐵, 崔敏其. 基于五次多項式過渡的機器人軌跡規(guī)劃的研究[J]. 煤礦機械, 2011, 32(12):49-50. CHEN Weihua, ZHANG Tie, CUI Minqi. Study of robot trajectory based on quintic polynomial transition[J]. Coal Mine Machinery, 2011,32(12):49-50.(in Chinese)

19 GASPARETTO A, ZANOTTO V. Optimal trajectory planning for industrial robots[J]. Advances in Engineering Software, 2010, 41(4):548-556.

20 FRAICHARD T. Trajectory planning in a dynamic workspace: a ‘state-time space’ approach[J]. Advanced Robotics, 1998, 13(1):75-94.

Dimensional Synthesis and Trajectory Planning of Plug Seedling Transplanting Robot Based on Delta Parallel Mechanism

HU Jianping JIN Heqi CHANG Yanchao LIU Wei HAN Lühua YANG Qizhi
(KeyLaboratoryofModernAgriculturalEquipmentandTechnology,MinistryofEducation,JiangsuUniversity,Zhenjiang212013,China)

Delta parallel mechanism is effective in speed, kinematic accuracy and flexibility, which is appropriate for the plug seedling transplanting and healthy plug seedling filling, thus a high-speed plug seeding transplanting robot was designed by using Delta parallel mechanism with a pneumatic manipulator. The reachable workspace of the plug seedling transplanting robot was obtained by building the single chain constraint equations of the Delta parallel mechanism; taking the condition number of Jacobian matrix as the penality condition, a dimensional synthesis target function was built considering the size and kinematic performances of the plug seeding transplanting robot for the purpose of making the reachable workspace close to the needing workspace, then the dimensional synthesis for the plug seedling transplanting robot was obtained by using the genetic algorithm. In accordance with the motion demand of plug seedling translating robot, trajectory planning was carried out and quintic polynomial motion law was taken as the principle of operation for the moving platform. Based on the mechanism dimensions and trajectory planning, a physical prototype was built and transplanting experiment was carried out. The experiment results showed that the success rate of plug seedling transplanting was decreased when the transplanting acceleration was increased, the success rate of plug seeding transplanting was up to 95.5%, the success rate of plug seeding filling was up to 92%, transplanting rate can reach 2 149 plants per hour when the transplanting acceleration was 30 m/s2, which demonstrated the practicability and rationality of the dimensional synthesis and trajectory planning when the Delta parallel mechanism was used in plug seedling transplanting.

plug transplanting; parallel mechanism; dimensional synthesis; trajectory planning; performance test

2016-09-13

2016-10-08

國家自然科學(xué)基金項目(51475216)、“十二五”國家科技支撐計劃項目(2013BAD08B03)、江蘇省科技支撐計劃(農(nóng)業(yè))項目(BE2014373)、江蘇省農(nóng)業(yè)科技自主創(chuàng)新資金項目(CX(15)1033-5)和江蘇高校優(yōu)勢學(xué)科建設(shè)工程項目(蘇政辦發(fā)[2014]37號)

胡建平(1965—)，男，教授，博士生導(dǎo)師，主要從事農(nóng)業(yè)機械設(shè)計及理論研究，E-mail: hujp@ujs.edu.cn

10.6041/j.issn.1000-1298.2017.05.003

S223.94； TH112

A

1000-1298(2017)05-0028-08