資源描述：
《基于MATLAB／Simulink的取苗機(jī)械臂運動軌跡仿真》由會員上傳分享，免費在線閱讀，更多相關(guān)內(nèi)容在學(xué)術(shù)論文-天天文庫。
1、·智能控制技術(shù)·李建剛尹文慶胡飛等基于MATLAB／Simulink的取苗機(jī)械臂??27基于MATLAB／Simulink的取苗機(jī)械臂運動軌跡仿真李建剛，尹文慶，胡飛，左德龍(南京農(nóng)業(yè)大學(xué)工學(xué)院，江蘇南京210031)摘要：根據(jù)取苗機(jī)械臂的結(jié)構(gòu)和特定的工作要求，用MATLAB／Simulink模塊建立機(jī)械臂仿真模型，驗證機(jī)械臂的路徑和位姿規(guī)劃。仿真結(jié)果表明路徑規(guī)劃以及機(jī)械臂在特定點的位姿符合取苗要求。關(guān)鍵詞：取苗機(jī)械臂；MATLAB／Simulink；仿真中圖分類號：TP242．31文獻(xiàn)標(biāo)識碼：B文章編號：1672—
2、1616(2009)15—0027一O3農(nóng)作物移栽種植雖然比直播種植費工費時，但是移栽種植可以延長作物的生長期，苗期便于管理、有利于抵抗病蟲害和氣候災(zāi)害。發(fā)達(dá)國家普遍采用缽苗移栽植的方式，與缽苗移栽植相配套的裝備主要是半自動栽植機(jī)，全自動栽植機(jī)正在快速發(fā)展。隨著工業(yè)機(jī)器人技術(shù)的日益成熟和廣泛應(yīng)用，該技術(shù)在農(nóng)業(yè)中的應(yīng)用越來越廣泛，它的應(yīng)用將極大提高農(nóng)業(yè)生產(chǎn)率和自動化程度。為了實現(xiàn)取苗自動化，提出用取苗機(jī)械臂代替人工取苗放苗，達(dá)到提圖1取苗機(jī)械臂連桿坐標(biāo)系統(tǒng)高移栽工作效率的目的，實現(xiàn)缽苗移栽自動化。為了描述取苗未端執(zhí)行器
3、的位姿，定義固定坐標(biāo)系及各連桿的附體坐標(biāo)系如圖1所示。取苗未1取苗機(jī)械臂的運動學(xué)方程端執(zhí)行器的位姿矩陣為：取苗機(jī)械臂完成將缽苗從穴盤中取出，然后放m—0Zm0忌人到栽植器中，根據(jù)取苗點與放苗點的位置空問，r3A1。A2‘A3：構(gòu)建的取苗機(jī)械臂如圖1所示，取苗機(jī)械臂3個關(guān)0010節(jié)的z軸平行且坐標(biāo)原點在同一平面內(nèi)，所以連0001式中：A1，A2，A3分別為相應(yīng)連桿的齊次變換矩桿參數(shù)中的連桿扭角和連桿間距分別為0。陣；m=COS(01+02+03)；=sin(01+02+03)；根據(jù)圖1建立的取苗機(jī)械臂連桿坐標(biāo)系統(tǒng)_1J
4、，Z=170cos(0l十2+03)+220cos(01+02)+可以用連桿的4個D—H參數(shù)來描述取苗機(jī)械220cos01；是=170sin(01+02+03)+220sin(01+臂，見表1。表1取苗機(jī)械臂連桿參數(shù)02)十220sin0l。通過取苗末端的位姿矩陣，在給定取苗機(jī)械臂末端執(zhí)行器的特定點以及在特定點的姿態(tài)進(jìn)行反向求解，可以計算出取苗機(jī)械臂在該特定點下的3個關(guān)節(jié)變量的值。收稿日期：2009—05—18基金項目：江蘇省農(nóng)機(jī)三項工程資助項目(NJ2008—32)作者介紹：李建剛(1981一)，男，山東菏澤人，南
5、京農(nóng)業(yè)大學(xué)工學(xué)院碩士研究生，主要研究方向為機(jī)電智能控制。282009年8月中國制造業(yè)信息化第38卷第15期2取苗機(jī)械臂運動軌跡規(guī)劃項式軌跡規(guī)劃方法，關(guān)節(jié)變量的三次多項式為：根據(jù)取苗機(jī)械臂工作過程可知，在穴盤中取苗()=o+Cl十C2t+C3t時末端執(zhí)行器要求與穴盤垂直，避免末端執(zhí)行器傷各個關(guān)節(jié)點的起始點和終止點的角度為已知，苗(該點為A點)、同時在開始取出到整個苗完全同時各關(guān)節(jié)起始點和終止點運動角速度也為已知。取出時(該點為B點)仍要保持同苗盤垂直，即把根據(jù)這4個已知條件，可以求出三次多項式軌跡函苗取出苗盤的整個過程
6、(AB段為直線)都保持和數(shù)的4個系數(shù)，且是惟一解，然后就可以得到各關(guān)苗盤垂直。在栽植器里放苗時要達(dá)到預(yù)定位姿(該節(jié)任意時間的角度、角速度和角加速度。在BC，點為C點)即末端執(zhí)行器與栽植器保持垂直以確CA段分別插入2個路徑點，為了保證AB段為直保苗能夠順利放入栽植器苗根朝下，BC，CA段是線則在該段插入4個路徑點。否為直線不在功能要求之內(nèi)，只要軌跡平穩(wěn)就能達(dá)這里的起始點和終止點條件為：到要求。由取苗機(jī)械臂的抓放幼苗的功能要求，得t)=0出其最短運動軌跡如圖2所示。tf)=t)=tf)=Os式中：0，0為起始點的角度，角
7、速度；，Os為終止點的角度，角速度。3取苗機(jī)械臂仿真模型為了在計算機(jī)上進(jìn)行仿真，首先把移栽機(jī)械臂本體和移栽機(jī)械臂所在的作業(yè)環(huán)境抽象為物理模型_2』，然后進(jìn)行系統(tǒng)模型的設(shè)置，最后編制相關(guān)的圖2取苗機(jī)械臂末端執(zhí)行器最短理想軌跡對于取苗機(jī)械臂的抓放作業(yè)，需要描述取苗機(jī)仿真運算程序。取苗機(jī)械臂仿真運算程序包括各械臂運動的起始點和目標(biāo)點，也就是取苗的特定連桿的設(shè)置、關(guān)節(jié)的制作及各關(guān)節(jié)相對坐標(biāo)系的建點。故采用點到點運動形式(point—to—pointmo—立；驅(qū)動器的設(shè)計，把運動軌跡規(guī)劃的參數(shù)加入到tion)，這里點表示取苗機(jī)
8、械臂末端執(zhí)行器的位姿。驅(qū)動器；傳感器的設(shè)計，建立各關(guān)節(jié)位置傳感器。確定運動形式之后，要對運動軌跡進(jìn)行規(guī)劃，而軌根據(jù)前述的連桿D—H參數(shù)在MATLAB／跡規(guī)劃方法有很多，如不同階次的多項式函數(shù)及拋Simulink環(huán)境下的SimMechanics工具箱中，4J，建物線性函數(shù)等方法。本文采用關(guān)節(jié)空間的三次多立取苗機(jī)械臂仿真圖如圖3所示。圖3取苗機(jī)械臂
