畢業(yè)論文（設計）
外文翻譯
題 目：運動學和軌跡規(guī)劃的黃瓜采摘機器人機械手
系部名稱： 專業(yè)班級：
學生姓名： 學 號：
指導教師： 教師職稱：
20**年03月10日
張利兵、王雁、楊慶華、寶冠君、高鋒、薰易
(教育部重點實驗室的機械制造及自動化、浙江理工大學、中國杭州310012)
摘要：為了降低成本，提高黃瓜收獲經濟效益，黃瓜收獲機器人得以發(fā)展。黃瓜果蔬采摘機器人由一輛汽車,一個四自由度關節(jié)機械手,一個手端,一個上一個視覺系統(tǒng)與監(jiān)控、四直流伺服驅動系統(tǒng)組成。把黃瓜的運動學果蔬采摘機器人機械手使用D- H標系建立了框架模型。而且它提供了一個逆運動學軌跡規(guī)劃的基礎已經解決了逆變換技術。擺線針輪運動，它具有的性能的連續(xù)性和零速度和加速度的港口及有界區(qū)間，采用一種可行的
方法在關節(jié)空間軌跡規(guī)劃，研究了果蔬采摘機器人的機械臂的黃瓜。此外，硬件和摘要軟件基于上面的顯示器之間的交流及關節(jié)的控制器的設計。實驗結果表明，上面的顯示器與四關節(jié)控制器的溝通，有效地摘要錯誤的思想和綜合四關節(jié)角不超過四度。誤差產生的可能因素分析及相應的解決方案，為提高測量精度的措施提出了建議。
關鍵詞：黃瓜果蔬采摘機器人軌跡規(guī)劃、關節(jié)機械臂、運動、摘要、擺線針輪
分類號：10.3965/j.issn.1934-6344.2009.01.001-007。
引文：張利兵，楊慶華，寶冠君，高鋒，薰易。運動學和軌跡規(guī)劃黃瓜收獲機器人的機械手。農業(yè)與生物學工程，2009；2（1）：1-7。
一．介紹
水果和蔬菜的收獲是一個勞力密集的工作，由人類勞動和收獲的成本大約是33％?總數的50％，生產成本[1]。因此，機械化和自動化，迫切需要水果和蔬菜收獲。目前，許多國家正在研究。
收稿日期：08-11-20 接受日期：009-03-28
傳記：張利兵，教授，博士，主要從事農業(yè)機器人，機電一體化和控制。王雁，博士候選人浙江工業(yè)大學，主要從事，機器人，智能儀表。楊慶華，教授，博士，主要從事機器人技術，機電一體化和控制。寶冠君，講師，博士，主要從事機器人技術，控制人數及機器視覺。高峰，副教授，博士，主要從事機電工程等。薰易，博士，主要從事視覺系統(tǒng)和圖像處理。
通訊作者: 張利兵，教育部重點實驗室機械制造、自動化、浙江工業(yè)大學310012技術,中國,杭州，310012。電話及傳真：+86-571-88320007。電子郵箱：robot@zjut.edu.cn
研究了果蔬采摘機器人,尤其是荷蘭和日本。機器人的一些收獲,如黃瓜、西紅柿、葡萄收獲機器人已廣泛應用在溫室里和其他人在農場上[2、3]。在中國,雖然研究是遲于果蔬采摘機器人在發(fā)達國家,一些有利的方面取得通過努力在國內許多高等院校和研究機構,就是這樣的采摘機器人的設計由中國茄子農業(yè)大學和一個番茄收獲機器人浙江大學開發(fā)的。
國家高技術大力支持下,國家級高新技術研究和發(fā)展計劃(863)(2007AA04Z222),第一個系統(tǒng)化的黃瓜研究了果蔬采摘機器人在中國是聯(lián)合研制開發(fā)的中國農業(yè)大學和浙江工業(yè)大學技術。它由一個車，一個4自由度（簡稱自由度）關節(jié)機械手，一最終效應，一上位，視覺系統(tǒng)和四個直流伺服驅動系統(tǒng)。由浙江工業(yè)大學，利用一種工業(yè)機械手來代替四自由度關節(jié)機械手的關節(jié)，旨在減少成本和適應環(huán)境的收獲。
本文主要考察了四自由度鉸接式機器人運動學和軌跡規(guī)劃，這是概述如下。在第一節(jié)中，結構黃瓜收獲機器人機械臂描述。機械手的運動學建造的第2節(jié)逆運動學和第3節(jié)中得到解決。第4節(jié)的軌跡規(guī)劃算法擺線運動。硬件和軟件設計軌跡規(guī)劃基于CAN總線技術的引入第5節(jié)。實驗測量的實際位置4節(jié)進行搶修，對錯誤的可能原因在第6節(jié)進行了分析。最后，結論是畫在第7節(jié)。
二．黃瓜采摘機器人機械手結構
本文詳細介紹了運動學機械手和軌跡規(guī)劃的實現基于CAN控制總線。線圖和關節(jié)機械手的照片顯示在圖1。它是由四個旋轉接頭：腰圍關節(jié)（J1），肩關節(jié)（J2），肘關節(jié)（J3）和手腕聯(lián)合（J4）。一端固定在底座上，另一端連接到終端效應其中包含兩個部分：一爪抓水果和切割設備另外從植物的果
圖1線框圖和相片的黃瓜果蔬采摘機器人機械臂
該系統(tǒng)采用黃瓜采摘機器人多CPU，分布式控制，上位機和聯(lián)合伺服控制器的結構。
此外，四個關節(jié)驅動的完美和諧的工作通過CAN總線通訊，有效支持分布式實時控制系統(tǒng)。該通信系統(tǒng)黃瓜收獲機器人如圖2所示。在上位監(jiān)控用于監(jiān)控和管理整個機器人系統(tǒng)，找到黃瓜目標，并規(guī)劃軌跡。 CAN總線是傳輸的橋梁上位監(jiān)控和聯(lián)合控制器。伺服控制器，分布在各個關節(jié)驅動力矩馬達和他們能夠實現閉環(huán)控制從接受角度編碼器反饋信號。
圖2通信系統(tǒng)中的黃瓜收獲機器人
三．學模型坐標框架
運動學模型坐標框架Denavit-Hartenberg模型,構造了(D- H型),這已被廣泛使用在機器人由于它嗎明確的機制和物理解釋在相對容易實施的程序機器人操作臂控制的。D- H標系框架模型基于任務的笛卡爾坐標框架固定相對于機器人機械臂的每一環(huán)節(jié)。而且它描述了空間變換關系兩個連續(xù)的4×4連結變換矩陣我i-1Ai，以鏈接的氮轉化成相應的坐標框架坐標系可以被寫為[4,5]：
其中a是一個是接近的方向向量；0定向的矢量，n = 0 × a 是一個正常的向量；P為最終效應相對位置向量基礎坐標系。
在D- H的變換矩陣i-1Ai關一數的旋轉和平移兩連續(xù)幀坐標表示為[6，7]：
其中θ是聯(lián)合角；αi是扭轉角；di是一個聯(lián)合抵消；ai是一個鏈路長度。
圖3所示的D – H坐標系的幀機器人機械臂和表1總結它的D – H參數。
圖3 D– H坐標系黃瓜收割機器人操作臂控制
表1機器人的機械臂D – H參數
四．黃瓜收獲機器人的機械手逆運動學
逆運動學問題的機器人機械手是要找到一個載體，聯(lián)合變量產生一個理想的最終效應位置和方向。逆變換技術來解決問題[8,9]。為了挑選黃瓜方便，腕關節(jié)，必須平行于X軸的坐標系的基礎，所以可以得到：
θ2 + θ3 +θ4 = 0°
對于方程（1），它可以改寫為：
而
首先，讓等式（3,4）矩陣（4）及（5）是等價的，θ1可表示為：
那就讓等式（1，4）和（2,4）矩陣（4）及（5）是等價的，下面的公式可以得到：
通過簡化方程（7）：
從方程（7），可得出θ2 ，θ3 可表示為：
五．在關節(jié)空間軌跡規(guī)劃的基礎上擺線運動
該機器人的機械手軌跡規(guī)劃以這種方式定義：找到共同的時空運動規(guī)律位置，速度和加速度，根據給定操作的最終效應。運動規(guī)律由軌跡規(guī)劃師產生的必須使用一些特別是戰(zhàn)略來消除額外的運動，如抖振和共鳴。他們必須是足夠光滑，連續(xù)的第一及第二衍生物[10,11]。在規(guī)劃數算法，擺線運動，尤其適合適用于點對一點，因為它的軌跡規(guī)劃金額較小的計算，平滑度和連續(xù)性，零速度和加速度，并在最初的功能和有界區(qū)間[12]終點。它的運動曲線可以描述為[13]：
那么它的第一和第二導數可以表示為：
而
是常規(guī)時間，T為一個收獲的工作時間。
圖4顯示了彎的擺線針輪運動和它的第一和第二衍生物在規(guī)范區(qū)間(- 1,1)。從圖4,它可以清楚地看出擺線針輪運動是平的;同時,充分的速度和加速度運動和價值觀都是連續(xù)的。
圖 4 擺線運動和第一及第二衍生物
開始和結束點的區(qū)間0≤τ≤1足輕重。這證明了機器人末端執(zhí)行器的的運動機器人操作臂控制不會抖振，所以它可以確保運動穩(wěn)定性的機器人系統(tǒng)。
如屬聯(lián)名我，軌跡規(guī)劃和位置依賴定位最終效應。所以,第一步的獲取軌跡規(guī)劃是三維的描述目標的空間小黃瓜。這描述是基于感官信息等機器視覺以及先驗信息機器人的機械臂運動學結構。從目標位置的機器人末端執(zhí)行器與逆6日運動學(Eqs 10、12、13)。開始后關節(jié)角qi(f)我問被紅牌罰下,通過從關節(jié)控制器的摘要,這個位置,速度,加速度方程的基礎上擺線針輪運動可以表達為:開機后關節(jié)角度qi(0)智商已經從通過CAN總線控制器的聯(lián)合，位置，速度，加速度方程的基礎上擺線運動可以表示為：
六．硬件和軟件設計的軌跡規(guī)劃基于CAN總線
6 – 1. 接口電路的CAN總線
控制器區(qū)域網絡（CAN）是一種先進的串行通訊協(xié)議的分布式實時控制系統(tǒng)。不同的設備，如處理器，傳感器和執(zhí)行器可以連接到CAN總線通過雙絞線，可以互相溝通通過交換信息。最大傳輸速率可達1Mbps的在嘈雜的環(huán)境。和它利用載波感測多重存取及碰撞檢測（CSMA/ CD）為仲裁機制使其附著節(jié)點有訪問總線[14-16]。黃瓜收獲機器人系統(tǒng)采用點多點的CAN總線通信。該上位機和四個控制器是由聯(lián)合dsPIC30F4012為數字信號處理器包含標準CAN控制器和MCP2551收發(fā)器。和一個4線接口的設計基于CAN總線協(xié)議（CAN2.0A），它提供電源，接地和基礎兩個數據線（CAN高和CAN低）。該接口的CAN總線電路示于圖5。和上監(jiān)視電路板如圖6所示。該的CAN總線通信，采用1Mbps的傳輸率，和消息傳遞由2個字節(jié)的標識符，1個字節(jié)的數據長度和8字節(jié)的數據。消息以時間為10毫秒內透光根據收獲的要求。 CAN總線通信具有良好的實時性能，在實際申請專利。
圖5接口電路的CAN總線
圖6上監(jiān)視電路板
6 – 1. 軟件設計的軌跡規(guī)劃黃瓜采摘機器人
上部顯示器具有管理職能和監(jiān)理的機器人系統(tǒng)，黃瓜目標位置和軌跡規(guī)劃。該方案設計采用了模塊化的構想，是由幾個子程序。圖7說明過程為黃瓜收獲機器人軌跡規(guī)劃。它包括如CAN總線發(fā)送和子程序接收，黃瓜目標捕獲，逆運動學和軌跡規(guī)劃。
圖 7 流程圖的軌跡規(guī)劃
七．實驗和分析
為了驗證彈道精度規(guī)劃算法和CAN總線通信，實驗測量的實際位置的四個黃瓜收獲機器人的機械手的執(zhí)行關節(jié)與坐標測量機（CMM）的法魯技術白金FaroArm測量臂法團。作為世界上最暢銷的便攜式測量臂，鉑FaroArm測量臂是在尺寸規(guī)格從1.2米到3.7米，有精度高達0.013毫米。
實驗進行如下：
1）設置最終effecor位置：
Px = 700mm, Py = 200mm, Pz = 668mm 。通過利用逆運動學，四個關節(jié)角度可以計算出來方程（6）?（13）：θ1 =15.95°， θ2 =55.82 °，θ3 =-33.48°，θ4 =-22.34
°。
2）對每一節(jié)理面與擺線軌跡運動算法和發(fā)送郵件的計劃角通過CAN總線控制器的聯(lián)合。
3）使用鉑FaroArm測量臂的角度來衡量實際扭矩馬達的旋轉。
4）其他9月底效應，重復（1）?（3）步的位置。實驗結果列于表2。
實驗結果表明，四個關節(jié)角度的綜合誤差不超過四度。對實驗誤差的可能原因是：
（1）單關節(jié)控制精度為0°?1 °，（2）機械結構錯誤，包括安裝和變形誤差;（3）最終沒有意識到效應閉環(huán)位置控制。相應的解決方案是：（1）添加一些補償算法，以提高單關節(jié)控制精度，（2）代替鋁用于PVC合金制造的機械手，以減少機械誤差;（3）安裝在一個小型攝像機最終效應，實現了閉環(huán)控制機械手。
表2實驗結果對實際測量的位置機器人機械手的四個關節(jié)
理論值（度） 測量值（度）
八．結論
1)研究了果蔬采摘機器人運動學的黃瓜機械手使用D – H坐標系建立了框架模型。逆向運動學,它提供了一個軌跡規(guī)劃的基礎,已經解決了反變換技術。
2）擺線運動，它的性質連續(xù)性，計算量小，速度為零并在有界區(qū)間的港口加速，是建議，作為可行的方法進行規(guī)劃，關節(jié)軌跡空間機器人的機械手。
3）軟件和CAN總線的硬件上位機之間的溝通和聯(lián)合控制器的設計。
4）實驗結果表明,上面的顯示器有四個共同控制器有效地溝通摘要的,綜合誤差四關節(jié)角均小于四度。
承認：這項工作是支持國家自然科學中國基金（50575206）和國家高技術研究與發(fā)展（863）中國項目方案（2007AA04Z222）。
九．參考文獻
【1】唐秀英，張鐵忠。機器人吃水果和蔬菜收獲的綜述：機器人，2005,27 （1）：90-96。
【2】E. J. Van Henten, J. Hemming等。無碰撞采摘黃瓜的運動規(guī)劃機器人。生物系統(tǒng)工程，2003； 86(2): 135－144.
【3】阿銳瑪斯，科東恩。黃瓜采摘機器人和植物培訓體系。作者：機器人與機電一體化，1999；11(3)：208－212。
【4】熊有倫。機器人技術。武漢：華中大學科技出版社，1996；pp.18－22。
【5】M.Abderrahim, A.R.Whittaker。運動學模型工業(yè)機械手的鑒定。機器人與計算機集成制造，2000；16: 1－8。
【6】陳寧，焦恩章。一種新的解決逆運動學方程的方案彪馬機械手。南京林業(yè)大學。2003； 27(4): 23－26。
【7】傅晶遜。機器人。北京：中國科學技術出版社，1989；pp.26－36。
【8】王萍，楊艷萍，鄧曉。研究運動控制模具拋光機器人系統(tǒng)。中國機械工程，2007；18(20): 2422－2424。
【9】Anatoly P. Pashkevich, Alexandre B. Dolgui.機器人定位運動學方面的制度,以電弧焊接的應用程序?？刂乒こ虒嵺`，2003；11: 633－647。
【10】Neelam R Prakash, Kamal T S ,智能規(guī)劃的挑戰(zhàn)和地方行動軌跡。見：觸發(fā)。對系統(tǒng)，人與控制論國際會議。200；55－60。
【11】A. Gasparetto, V. Zanotto. 一個應用程序在弧焊機器人運動學定位系統(tǒng)方面?？刂乒こ虒嵺`，2007；(42): 455－471。
【12】莊鵬，姚政秋。彈道懸浮電纜并聯(lián)機器人運動規(guī)劃的基礎上擺線法議案。機械設計，2006；(9): 21－24。
【13】豪爾赫洛杉磯。該機器人的機械系統(tǒng)原理。北京：機械工業(yè)出版社，2004；141-148。
【14】Hofstee J W, Goense D.模擬一個基于CAN拖拉機實施現場總線，符合DIN 9684。農機工程研究所，1999；73（4）：383-394。
【15】楊向輝。工業(yè)通訊和控制網絡。北京：清華大學出版社，2003。第84-85。
【16】Navet N, Song Y Q. 可靠性的改進下不可靠傳輸的雙優(yōu)先級的協(xié)議。控制工程實踐，1999（7）：975-981。
Kinematics and trajectory planning of a cucumber harvesting robot manipulator
Zhang Libin, Wang Yan, Yang Qinghua, Bao Guanjun, Gao Feng, Xun Yi
(The MOE Key Laboratory of Mechanical Manufacture and Automation, Zhejiang University of Technology, Hangzhou 310012, China)
Abstract:In order to reduce cucumber harvesting cost and improve economic benefits, a cucumber harvesting robot was developed. The cucumber harvesting robot consists of a vehicle, a 4-DOF articulated manipulator, an end-effector, an upper monitor, a vision system and four DC servo drive systems. The Kinematics of the cucumber harvesting robot manipulator was constructed using D-H coordinate frame model. And the inverse kinematics which provides a foundation for trajectory planning has been solved with inverse transform technique. The cycloidal motion, which has properties of continuity and zero velocity and acceleration at the ports of the bounded interval, was adopted as a feasible approach to plan trajectory in joint space of the cucumber harvesting robot manipulator. Moreover, hardware and software based on CAN-bus communication between the upper monitor and the joint controllers have been designed. Experimental results show that the upper monitor communicates with the four joint controllers efficiently by CAN-bus,
and the integrated errors of four joint angles do not exceed four degrees. Probable factors resulting in the errors were analyse and the corresponding solutions for improving precision are proposed.
Keyword:cucumber harvesting robot, articulated manipulator, trajectory planning, cycloidal motion, CAN-bus
DOI:10.3965/j.issn.1934-6344.2009.01.001-007
Citation:Zhang Libin, Wang Yan, Yang Qinghua, Bao Guanjun, Gao Feng, Xun Yi. Kinematics and trajectory planning of a cucumber harvesting robot manipulator. Int J Agric & Biol Eng, 2009; 2(1): 1－7.
1 Introduction
Fruit and vegetable harvesting is a labor-intensive job,and the harvesting cost by human labor is about 33%～50% of the total production cost[1]. Therefore, it isurgent to mechanize and automate fruit and vegetable harvesting. Currently, many countries are studying.
Received date: 2008-11-20 Accepted date: 2009-03-28
Biographies:Zhang Libin, professor, Ph.D, mainly engaged in agricultural robot, mechatronics and control. Wang Yan, Ph.D candidate of Zhejiang University of Technology, mainly engaged in robotics, intelligent instruments. Yang Qinghua, professor, Ph.D, mainly engaged in robotics, mechatronics and control. Baoguanjun, lecturer, Ph.D, mainly engaged in robotics, control and machine vision. Gao Feng, associate professor, Ph.D, mainly engaged in electromechanical engineering. Xun Yi, Ph.D, mainly engaged in vision system and image processing.
Corresponding author:Zhang Libin, MOE Key Laboratory of Mechanical Manufacture and Automation, Zhejiang University of Technology, Hangzhou 310012, China. Tel & fax: +86-571-88320007. Email: robot@zjut.edu.cn
harvesting robot, especially Netherlands and Japan. Some of the harvesting robots, such as cucumber, tomato, grape harvesting robots have been applied in greenhouses
and others on farms[2,3]. In China, though research on harvesting robot is later than that in developed countries,some favorable achievements have been made through efforts in many universities and research institutes, such as the eggplant picking robot designed by China Agricultural University and the tomato harvesting robot developed by Zhejiang University.
Under the support of the National High-Tech Research and Development (863) Program of China(2007AA04Z222), the first systematical cucumber harvesting robot in China was jointly developed by China Agricultural University and Zhejiang University of Technology. It consists of a vehicle, a 4-degree of freedom (DOF for short) articulated manipulator, an end-effector, an upper monitor, a vision system and four DC servo drive systems. Instead of utilizing an industrial manipulator, the 4-DOF articulated manipulator was designed by Zhejiang University of Technology to reduce the cost and adapt to the harvesting environment.
This paper mainly investigates the 4-DOF articulated manipulator kinematics and trajectory planning, and it is outlined as follows. In Section 1, the structure of cucumber harvesting robot manipulator is described. The kinematics of manipulator is constructed in Section 2 and the inverse kinematics is solved in Section 3. Section 4 presents the trajectory planning algorithm of cycloidal motion. The hardware and software design of trajectory planning based on CAN-bus is introduced in Section 5. Experiments measuring actual position of four joints are carried out and possible causes for errors are analyzed in Section 6. Finally, conclusions are drawn in Section 7.
2 Cucumber harvesting robot manipulator structure
This paper describes in detail the kinematics of the robot manipulator and realization of trajectory planning control based on CAN-bus. The line diagram and photograph of the articulated manipulator is shown in Figure 1. It is composed of four rotation joints: waist joint (J1), shoulder joint (J2), elbow joint (J3) and wrist joint (J4). One end is fixed on the base, and the other end is connected to an end-effector which contains two parts: a gripper to grasp the fruit and a cutting device to separate the fruit from the plant.
Figure 1 Line diagram and photograph of the cucumber harvesting robot manipulator
The cucumber harvesting robot system employs multi-CPU, distributed control structure of upper monitor and joint servo controllers. Moreover, the four joints are driven to work in perfect harmony by CAN-bus communication which efficiently supports the distributed real-time control system. The communication system of
the cucumber harvesting robot is shown in Figure 2. The Upper monitor is used to monitor and manage the whole robot system, locate cucumber target, and plan
trajectory. The CAN-bus is the transmission bridge between upper monitor and joint controllers. The servo controllers are distributed in each joint to drive torque
motors and they can realize close-loop control by receiving feed back signals from angle encoders.
Figure 2 Communication system of the cucumber harvesting robot
3 Coordinate frames of kinematics models
Coordinate frames of kinematics models are constructed by Denavit-Hartenberg model (D-H for short), which has been widely adopted in robotics due to its explicit physical interpretation of mechanisms and relatively easy implementation in the programming of the robot manipulator. D-H coordinate frame model is based on assignment of Cartesian coordinate frames fixed relative to each link of robot manipulator. And it describes spatial transformation between two consecutive links by 4×4 transformation matrix i-1Ai, so the transformation of link n coordinate frame into the basecoordinate frame can be written as[4,5]:
where a is the vector of approaching direction; 0 is orientation vector, n = a×0 is the normal vector;P is the position vector of end-effector relative to thebase coordinate frame.
The D-H transformation matrix i-1Ai-relating to a number of rotations and translations between two consecutive coordinate frames is expressed as[6,7]:
Where θi is joint angle;αi is twist angle;di is joint offset;ai is the length of link.
Figure 3 illustrates the D-H coordinate frames of the robot manipulator and Table 1 summarizes its D-H parameters.
Figure 3 D-H coordinate frames of the cucumber harvesting robot manipulator
Table 1 D-H parameters of the robot manipulator
4 Inverse kinematics of the cucumber harvesting robot manipulator
The inverse kinematics problem for a robot manipulator is to find a vector of joint variables that produces a desired end-effector position and orientation.
The inverse transform technique is used to solve the problem[8,9]. In order to pick cucumbers conveniently, the wrist joint has to be parallel to X axis of the base coordinate frame, so it can be obtained:
θ2 + θ3 +θ4 = 0°
For equation (1), it can be rewritten as:
Where
First, let element (3,4) of matrix (4) and (5) be equal,θ1 can be given by:
Then let element (1, 4) and (2, 4) of matrix (4) and (5) be equal, the following equations can be obtained:
By simplifying equation (7):
From equation (7), θ2, θ3 can be expressed as:
5 Trajectory planning in joint space based oncycloidal motion
Trajectory planning of the robot manipulator is defined in this way: find temporal motion laws for joint position, velocity and acceleration according to a given operation of the end-effector. The motion laws generated by trajectory planner have to use some particular strategies to eliminate extra movements such as chattering and resonance. They have to be smooth enough, and continuous for their first and second derivatives[10,11]. Within a number of planning algorithms, cycloidal motion is especially suitable to apply in point-to-point trajectory planning because of its smaller amount of calculation, smoothness and continuity,
and features of zero velocity and acceleration at the initial and end points of the bounded interval[12]. Its motion curve can be described as[13]:
Then its first and second derivatives can be expressed as:
Where
is normalized time； T is a single harvest operation time.
Figure 4 shows the curves of the cycloidal motion andits first and second derivatives in canonical interval (-1,1). From Figure 4, it can be clearly seen that the cycloidal motion is adequately smooth; also, the velocity and acceleration motions are continuous and the values at
Figure 4 Cycloidal motion and its first and second derivatives the initial and end points of interval 0≤τ ≤1 are zeros.This demonstrates that the motion of the end-effector of robot manipulator won’t result chattering, so it can ensure motion stability of the robot system.
For joint i , trajectory planning relies on position and orientation of end-effector. So, the first step of trajectory planning is acquiring the three dimensional space description of the target cucumber. This description is based on sensory information such as machine vision as well as priori knowledge about
kinematics structure of robot manipulator. Then the goal angles qi(f) of the four joints can be obtained from the target position of the end-effector with inverse kinematics (Eqs 6, 10, 12, 13). After the start joint angles qi(0) i q being sent from joint controllers through CAN-bus, the position, velocity, acceleration equations based on cycloidal motion can be expressed as:
6 Hardware and software design of trajectory planning based on CAN-bus
6.1 Interface circuit of CAN-bus
Controller Area Network (CAN) is an advanced serial communication protocol for distributed real-time control system. Different devices such as processors, sensors and actuators can be connected to CAN-bus via twisted-pair wires and can communicate with each other by exchanging messages. The maximum transmission
rate can reach up to 1Mbps in a noisy environment. And it utilizes Carrier Sense Multiple Access with Collision Detection (CSMA/CD) as the arbitration mechanism to enable its attached nodes to have access to the bus[14-16].
The cucumber harvesting robot system employs the point to multi-points communication of CAN-bus. The upper monitor and four joint controllers are composed of dsPIC30f4012 digital signal processor which contains standard CAN controller and MCP2551 transceiver. And a 4-wire interface is designed based on CAN-bus protocol(CAN2.0A), which provides power, ground and two data lines(CAN High and CAN Low). The interface circuit of CAN-bus is shown in Figure 5. And the upper monitor circuit board is shown in Figure 6. The Baudrate of CAN-bus communication is adopted 1Mbps, and the messages transmitted consist of 2-byte identifier, 1-byte data length and 8-byte data. Messages are transmitted with a time internal of 10 ms according to the harvesting requirements. CAN-bus communication exhibits good real-time performance in practical application.
Figure 5 Interface circuit of CAN-bus
Figure 6 Upper monitor circuit board
6.2 Software design for trajectory planning of the cucumber harvesting robot
The upper monitor has functions of management and supervision for the robot system, location of cucumber target and trajectory planning. The program design
employs the modularization idea which is composed of several subprograms. Figure 7 illustrates the process of the trajectory planning for the cucumber harvesting robot. It consists of subprograms such as CAN-bus sending and receiving, acquisition of cucumber target, inverse kinematics and trajectory planning.
Figure 7 Flow chart for the trajectory planning
7 Experiments and analysis
In order to verify the accuracy of the trajectory planning algorithm and CAN-bus communication, experiments to measure the actual position of the four
joints of the cucumber harvesting robot manipulator were performed with the coordinate measurement machine(CMM) Platinum FaroArm of FARO Technologies Incorporation. As the world’ s best-selling portable measurement arm, Platinum FaroArm is available in sizes ranging from 1.2 m to 3.7 m and has precision of up to 0.013 mm.
Experiments were carried out as follows:
1) Set the position of the end-effecor:Px = 700mm, Py = 200mm, Pz = 668mm . By utilizing the inverse kinematics, the four joint angles can be computed from
equation (6) ～ (13):
θ1 =15.95°， θ2 =55.82 °，θ3 =-33.48°，θ4 =-22.34°.
2) Plan trajectories for each joint with cycloidal motion algorithm and send the planned angle messages to joint controllers by CAN-bus.
3) Use Platinum FaroArm to