購(gòu)買設(shè)計(jì)請(qǐng)充值后下載，，資源目錄下的文件所見(jiàn)即所得，都可以點(diǎn)開(kāi)預(yù)覽，，資料完整，充值下載可得到資源目錄里的所有文件。。。【注】：dwg后綴為CAD圖紙，doc,docx為WORD文檔，原稿無(wú)水印，可編輯。。。具體請(qǐng)見(jiàn)文件預(yù)覽，有不明白之處，可咨詢QQ:12401814
編號(hào)
濰 坊 學(xué) 院
畢 業(yè) 設(shè) 計(jì) 技 術(shù) 報(bào) 告
課題名稱： 沖床自動(dòng)送料裝置機(jī)械結(jié)構(gòu)設(shè)計(jì)
學(xué)生姓名： 李霖泰
學(xué) 號(hào)： 08011140136
專 業(yè)： 機(jī)械設(shè)計(jì)制造及其自動(dòng)化
班 級(jí)： 2008級(jí)本科1班
指導(dǎo)教師： 宋健
2012 年 06 月
濰坊學(xué)院本科畢業(yè)設(shè)計(jì)
摘要
沖壓成形的沖壓件具有重量輕、厚度薄、剛性好和質(zhì)量穩(wěn)定等一系列優(yōu)點(diǎn)，沖壓設(shè)備被廣泛使用。但由于傳統(tǒng)的沖床控制采用接觸器、繼電器控制，手工送料的方式，所以往往存在著效率低、速度慢、精度不能保證、安全存在隱患等方面的一系列問(wèn)題，雖然購(gòu)置新的數(shù)控設(shè)備可以解決這一問(wèn)題，但往往資金投入較大，小型企業(yè)難以承受，若能在保留原有機(jī)床的基本功能基礎(chǔ)上，對(duì)其進(jìn)行適當(dāng)?shù)母脑炫c改進(jìn)，不失為一種好的方法。一方面可以節(jié)約資金，另一方面也不會(huì)使原來(lái)的機(jī)床閑置浪費(fèi)，基于此種思想，我們對(duì)長(zhǎng)治科達(dá)工貿(mào)公司生產(chǎn)餐盒的沖床進(jìn)行了全面改造，本文對(duì)設(shè)計(jì)的詳細(xì)過(guò)程進(jìn)行了全方面的論述。
本論文在內(nèi)容安排上首先介紹了題目的來(lái)源與意義及其相關(guān)的背景;系統(tǒng)方案的確定、總體的組成、設(shè)計(jì)思想與理論依據(jù)等;隨后對(duì)系統(tǒng)進(jìn)行了詳細(xì)設(shè)計(jì)，包括:張力控制設(shè)計(jì)、電氣控制主電路與輔助電路設(shè)計(jì)、PLC控制器的資源分配、電氣連接、軟件程序代碼的編寫、觸摸屏部分的連接方式、控制界面的設(shè)計(jì)等;最后對(duì)通訊接口與上位機(jī)程序進(jìn)行了詳細(xì)設(shè)計(jì)，包括PLC-觸摸屏-PC機(jī)的連接方式、通訊協(xié)議、以及詳細(xì)的通訊代碼等。
系統(tǒng)經(jīng)調(diào)試自運(yùn)行三個(gè)月以來(lái)，無(wú)論是在穩(wěn)定性、可靠性方面，還是在系統(tǒng)的精度與效率方面都有了很大的提高，同時(shí)節(jié)約了成本，降低了操作人員的勞動(dòng)強(qiáng)度與人身危險(xiǎn)系數(shù)，使系統(tǒng)的自動(dòng)化、現(xiàn)代化程度大大提高，本論文提出“PLC-觸摸屏-代機(jī)”的控制方式在工業(yè)自動(dòng)化控制中有一定的理論研究?jī)r(jià)值意義，控制過(guò)程的具體實(shí)施有較高的參考與使用價(jià)值，在同行業(yè)中有一定的推廣與應(yīng)用的實(shí)際意義。
關(guān)鍵詞：PLc 控制觸摸屏 自動(dòng)送料機(jī) 沖床改造
Abstract
The stamping workpiece has a series of advages with light weight,thin thickness, good rigidity and stable quality and so on . The stamping equipment has been widely used. But traditional punch control often adopts the contactor and relay control and the method of sending material by hand , so problem exit in low efficiency ,slow speed ,precision not being guaranteed and potential safety . Although purchasing the new equipment of numerical control may solve these problems. But the fund to be invested is greater, small company is hard to bear. It will be a good method if we can carry out proper transformation and improvement for the original machine tool without changing its basic functions, which will not only economize fund but also make good use of original machine tool. Based on this thought, overall transformation of the punch producing the meal box in CHANG ZHI Ke Da trade company has been carried out. This paper will elaborate the process of design in detail.
This paper first introduces the background related to it and the meaning and source of this title, the definition of systematic scheme, overall composition and design thought and theoretical basis; then it carries out detailed design which includes tension control design, electrical control main circuit and supplementary circuit design , the resource allocation of PLC controller , electrical connection , software program code, the connected way of touch-screen, the design of control interface and etc; finally as for communication interface and last position machine it carries out detailed design that includes the connected way of “PLC-touch-screen-personal computer”, communication agreement as well as detailed communication code.
Running for three months, the debugged system has got great raising not only in stability and reliability but also in system’s precision and efficiency, at the same time it has economized cost, reduced the personal risk factor and efficiency, at the same time it has economized cost, reduced the personal risk factor and labour intensity and largely raised automatization and modernization of the system,.The control way “PLC- touch-screen-personal computer” put forward in this paper has the certain theoretical research value in industry and the control process has higher reference and use significance and has certain popularization and actual meaning of application in the field of industry.
Keywords: PLC；controls touch-screen；send material machine；punch transformation
II
濰坊學(xué)院本科畢業(yè)設(shè)計(jì)
生物系統(tǒng)工程（2003）86（2）135-144
DOI：10.1016/S1537-5110（03）00133-8
AE—自動(dòng)化與新興技術(shù)
黃瓜采摘機(jī)器人的無(wú)碰撞規(guī)劃
E.J.凡Henten J.海明; B.A.J.凡Tuijl; J.G.短號(hào);研究Bontsema
溫室工程，農(nóng)業(yè)和環(huán)境工程研究所（IMAG BV公司），箱43，NL-6700機(jī)管局瓦赫寧根，荷蘭;電子郵件通訊作者：eldert.vanhenten wur.nl
（2002年4月26日收到，2003年7月8號(hào)以修訂后的形式接受; 2003年8月29日在網(wǎng)上發(fā)表）
在農(nóng)業(yè)和環(huán)境工程學(xué)院，對(duì)于黃瓜自動(dòng)收獲機(jī)，其中最大的一個(gè)挑戰(zhàn)方面就是在采摘的過(guò)程中實(shí)現(xiàn)一種快速精確的手眼協(xié)調(diào)的操作。這個(gè)程序包含兩個(gè)主要的組成部分。首先，采集信息機(jī)器人的工作環(huán)境，其次，一個(gè)程序可以讓機(jī)器人末端執(zhí)行器對(duì)黃瓜產(chǎn)生無(wú)碰撞機(jī)械運(yùn)動(dòng)。這篇文章主要闡述了后者，無(wú)碰撞機(jī)械運(yùn)動(dòng)所產(chǎn)生的所謂的路徑搜索算法。在這項(xiàng)研究中這個(gè)A-search算法被應(yīng)用著，用一些數(shù)值的例子對(duì)黃瓜收割應(yīng)用的搜索過(guò)程分析說(shuō)明。得出的結(jié)論是，無(wú)碰撞運(yùn)動(dòng)可以用于采摘黃瓜的機(jī)械手的自由度的計(jì)算。這個(gè)A-search算法非常易于實(shí)施和魯棒。當(dāng)找不到解決方案時(shí)這個(gè)算法要不產(chǎn)生一個(gè)解決方案要不就停止工作。這個(gè)有利的財(cái)產(chǎn)然而卻使算法過(guò)分的緩慢，結(jié)果表明這個(gè)算法不包括多智能的搜索過(guò)程。我們可以知道，為了滿足每10S為一個(gè)單一收獲循環(huán)的要求，還需要做進(jìn)一步的研究，去尋找發(fā)現(xiàn)快速的算法，使用盡可能多的關(guān)于這個(gè)問(wèn)題特定結(jié)構(gòu)的信息來(lái)產(chǎn)生解決方案，如果這個(gè)算法找不到解決方案并能給出明確的信息。
1. 介紹
1996年，農(nóng)業(yè)和環(huán)境工程學(xué)院開(kāi)始研究自主的黃瓜采摘機(jī)器人的發(fā)展，這個(gè)項(xiàng)目是由荷蘭農(nóng)業(yè)部，食品和漁業(yè)部門支持的。為農(nóng)業(yè)應(yīng)用設(shè)計(jì)機(jī)器人的任務(wù)所提出的議題不涉及其他行業(yè)(Gielinget al., 1996 ; Van Kollenburg-）。機(jī)器人必須處在一個(gè)高度非結(jié)構(gòu)化環(huán)境中，在這里沒(méi)有兩個(gè)場(chǎng)景是一模一樣的。農(nóng)作物和水果都易于被機(jī)械損傷應(yīng)給小心處理。機(jī)器必須能夠在不利的條件下運(yùn)轉(zhuǎn)，如相對(duì)較高的溫度和濕度以及光線變化的條件。最后，為了符合成本效益，就機(jī)器人采摘運(yùn)動(dòng)的速度和成功率而言，機(jī)器人需要滿足高的性能特點(diǎn)。在這個(gè)項(xiàng)目中這些具有挑戰(zhàn)性的問(wèn)題已經(jīng)被一個(gè)機(jī)械工程，傳感技術(shù)（計(jì)算機(jī)視覺(jué)等），系統(tǒng)和控制工程，電子、軟件工程，物流，最后但不是最少園藝工程分享的互動(dòng)的方式解決(Van Kollenburg-Crisan et al., 1997 ; Bontsema et al., 1999 ; Meuleman et al., 2000 )。
自動(dòng)收割機(jī)的開(kāi)發(fā)研制中最具有挑戰(zhàn)性的問(wèn)題之一就是達(dá)到快速精確的手眼協(xié)調(diào)的，即達(dá)到機(jī)器人在采摘運(yùn)動(dòng)中感官信息的采集和機(jī)器人運(yùn)動(dòng)控制之間的有效相互作用，就像人們做的那樣。在園藝實(shí)踐中，一個(gè)訓(xùn)練有素的工人只需要3-6S采摘和存儲(chǔ)一個(gè)水果，那種表現(xiàn)是很難被打敗的。幸運(yùn)的是，就機(jī)器人的采摘速度而言沒(méi)有必要達(dá)到那么高的性能特點(diǎn)。一項(xiàng)任務(wù)分析顯示，考慮經(jīng)濟(jì)可行性，一個(gè)單一采摘運(yùn)動(dòng)可能只需要10S (Bontsemaet al., 1999 )。仍然，機(jī)器人運(yùn)動(dòng)應(yīng)盡可能快的同時(shí)防止機(jī)器手的碰撞，手和收獲水果作物，溫室結(jié)構(gòu)還有機(jī)器人自身的碰撞（如汽車視覺(jué)系統(tǒng)）。在荷蘭，黃瓜生產(chǎn)設(shè)施，機(jī)器人運(yùn)行在一個(gè)非常緊張的工作環(huán)境中。最后，為了保證收獲果實(shí)的質(zhì)量，在運(yùn)動(dòng)路徑的各個(gè)部分對(duì)機(jī)械手的速度和加速度加以約束。
為了達(dá)到理想的手眼協(xié)調(diào)，一個(gè)人需要環(huán)境的感官信息的采集和算法去為機(jī)械手計(jì)算這種無(wú)碰撞運(yùn)動(dòng)。正像Meuleman et al. (2000) 報(bào)道的那樣。在這個(gè)項(xiàng)目中感覺(jué)系統(tǒng)是基于計(jì)算機(jī)視覺(jué)的。本文著重論述了收獲機(jī)的機(jī)械手的無(wú)碰撞運(yùn)動(dòng)軌跡的快速生成。盡管有相當(dāng)大的研究工作花在自動(dòng)收集蔬菜水果方面，但是這個(gè)問(wèn)題在農(nóng)業(yè)工程研究中沒(méi)有引起人們極大的關(guān)注。(see e.g. Kondoet al., 1996 ; Hayashi& Sakaue, 1996 ; Arima & Kondo, 1999 )。
本文概述如下，在第二節(jié)對(duì)采摘機(jī)器人進(jìn)行了闡述，在第三節(jié)，講述的是一個(gè)單一收獲操作的任務(wù)序列，然后，第四節(jié)，表述的是無(wú)碰撞規(guī)劃的自動(dòng)算法的組成。為了能夠深入洞察算法的運(yùn)行，在第五節(jié)對(duì)該算法在第二級(jí)自由度的機(jī)械手上進(jìn)行了解釋說(shuō)明，第六節(jié)包含一個(gè)應(yīng)用于收獲機(jī)器人身上的six-DOF RV-E2三菱機(jī)械手的運(yùn)動(dòng)規(guī)劃實(shí)驗(yàn)結(jié)果。第七節(jié)包含結(jié)束語(yǔ)和對(duì)未來(lái)研究的建議。
2．采摘機(jī)器人
圖1.黃瓜收獲機(jī)器人的功能模型;（a）車輛;（b）廣角相機(jī);（c）七度的自由度機(jī)械手;（d）最終效應(yīng);（e）激光測(cè)距儀和攝像機(jī)的位置當(dāng)?shù)爻上?（f）計(jì)算機(jī)和電子產(chǎn)品;（g）與220伏電源線卷軸;（h）氣動(dòng)泵;（i）供熱管
圖一中，一個(gè)采摘機(jī)器人的功能模型被展示出來(lái)。它包含一個(gè)用于溫室走道里的收獲機(jī)進(jìn)行粗定位的自主車輛。這車采用加熱管作為一個(gè)鐵路進(jìn)行指導(dǎo)和支持。它作為一個(gè)移動(dòng)平臺(tái)裝載電源、主動(dòng)泵、各種數(shù)據(jù)收集和控制的電子硬件、一個(gè)用于監(jiān)測(cè)和定位植物上黃瓜位置的廣角攝像系統(tǒng)和一個(gè)用于機(jī)械末端運(yùn)行器定位的七個(gè)自由度的機(jī)械手。這個(gè)機(jī)械手由安裝著六個(gè)自由度的Mitsubishi RV-E2機(jī)械手的滑動(dòng)線路構(gòu)成。這個(gè)RV-E2機(jī)械手包括一個(gè)人形的機(jī)械手臂和球形的手腕。這個(gè)機(jī)械手有個(gè)能夠抓去0.2毫米的穩(wěn)態(tài)精度并能夠在惡劣的溫室氣候（高濕度和高溫度）條件下滿足一般的衛(wèi)生的操作方面的要求。這個(gè)機(jī)械手裝有一個(gè)末端執(zhí)行器。它包括兩部分：一個(gè)爪抓住水果，另一個(gè)爪切割水果從植物上分離出來(lái)。這個(gè)末端執(zhí)行器帶有一個(gè)末端激光測(cè)距系統(tǒng)或一個(gè)小相機(jī)。他們是用來(lái)在黃瓜附近能夠更好地進(jìn)行運(yùn)動(dòng)控制而獲取感官信息的，如果需要的話。
3.單一收割運(yùn)動(dòng)的任務(wù)序列
圖2. 一個(gè)單一的收獲作業(yè)任務(wù)序列：3D，三維，TCP，工具中心點(diǎn)
圖二展示的是一個(gè)單一的收獲運(yùn)動(dòng)的一個(gè)任務(wù)序列。在采摘操作中接近黃瓜被公認(rèn)為是一個(gè)兩階段的過(guò)程。首先，用安裝在車輛上的攝像系統(tǒng)，黃瓜果實(shí)被檢測(cè)到他的成熟認(rèn)定和位置是不確定的。如果我們決定采摘黃瓜則低分辨率圖像的車載攝像機(jī)就用于定位機(jī)器人末端執(zhí)行器鄰近黃瓜附近這一帶。一旦末端執(zhí)行器抵達(dá)鄰近的黃瓜，然后利用末端執(zhí)行器上面的激光測(cè)距系統(tǒng)或攝像系統(tǒng)為最終的準(zhǔn)確的接近黃瓜獲得黃瓜定位環(huán)境的高分辨率的信息。末端執(zhí)行器緊握并消減果子的莖。夾持固定分離的水果最后收獲果實(shí)移動(dòng)到存儲(chǔ)箱。
避障運(yùn)動(dòng)規(guī)劃將用于黃瓜的初步做法以及收獲黃瓜回程箱子，來(lái)保證，如機(jī)器人車輛本身的工作空間中的其他對(duì)象，但也源于，如果目前，葉片和溫室建設(shè)的部分都沒(méi)有命中。顯然，收獲的黃瓜，增加最終的效應(yīng)，應(yīng)考慮在機(jī)械臂返回到存儲(chǔ)議案的大小。黃瓜的平均長(zhǎng)度為300mm。
4.一個(gè)無(wú)碰撞運(yùn)動(dòng)規(guī)劃算法
圖3.無(wú)碰撞的自動(dòng)生成程序議案
圖3顯示了一個(gè)程序，自動(dòng)生成赫爾曼（1986年）的工作基礎(chǔ)上的黃瓜采摘機(jī)器人無(wú)碰撞運(yùn)動(dòng)的組成部分。無(wú)碰撞運(yùn)動(dòng)規(guī)劃依賴于三維（3D）機(jī)器人的物理結(jié)構(gòu)以及在機(jī)器人操作的工作區(qū)的信息。因此，在無(wú)碰撞機(jī)器人運(yùn)動(dòng)規(guī)劃的第一步是三維世界描述的收購(gòu)。這個(gè)描述是基于感官信息，如機(jī)器視覺(jué)以及先驗(yàn)知識(shí)，例如，采摘機(jī)器人運(yùn)動(dòng)學(xué)的三維結(jié)構(gòu)，如三維模型，在數(shù)據(jù)庫(kù)中。有了這個(gè)信息，在任務(wù)定義階段，機(jī)器人的整體任務(wù)的計(jì)劃。決定最后的位置和方向的效應(yīng)最終結(jié)果中的黃瓜最好的方法。也定義在此階段的具體位置和方向約束等。在階段目標(biāo)的位置和方向的最終任務(wù)定義中定義的效應(yīng)，逆運(yùn)動(dòng)學(xué)，將目標(biāo)配置的manipulator.The目標(biāo)配置跨lated表示作為一個(gè)線性滑軌的翻譯和6的組合七自由度機(jī)械手關(guān)節(jié)的旋轉(zhuǎn)。使用此信息的路徑規(guī)劃，路徑規(guī)劃，采用了搜索技術(shù)找到自由碰撞路徑，從開(kāi)始操縱其目標(biāo)配置配置。一旦已成功完成的無(wú)碰撞路徑規(guī)劃，軌跡規(guī)劃軌跡，可以轉(zhuǎn)換成的無(wú)碰撞路徑由機(jī)器人執(zhí)行。通常情況下，路徑規(guī)劃過(guò)程中，只有在太空中的無(wú)碰撞配置有關(guān)，但沒(méi)有速度，加速度和運(yùn)動(dòng)平滑。軌跡規(guī)劃涉及這些因素。 thetrajectory策劃生產(chǎn)的機(jī)器人伺服系統(tǒng)的運(yùn)動(dòng)命令。在執(zhí)行階段執(zhí)行這些命令。運(yùn)動(dòng)規(guī)劃系統(tǒng)的一些部件將在更詳細(xì)地描述以下。
4.1世界的描述（采集）
Meulemanet在一份文件中描述的基于機(jī)器視覺(jué)的世界描述收購(gòu)的黃瓜采摘機(jī)器人（2000年）。視覺(jué)系統(tǒng)能夠偵測(cè)在綠色canopy.Moreover綠色黃瓜，視覺(jué)系統(tǒng)決定的黃瓜成熟。最后，利用立體視覺(jué)技術(shù)QUES，相機(jī)視覺(jué)系統(tǒng)產(chǎn)生的工作空間內(nèi)的攝像頭的視角3D地圖。在這樣的機(jī)器人能夠處理工作面臨的環(huán)境與它的變異。
圖6. 自由度的三菱RV-E2的操縱一個(gè)三維模型
如上所述，先驗(yàn)知識(shí)，例如，機(jī)器人的物理結(jié)構(gòu)所需的無(wú)碰撞運(yùn)動(dòng)規(guī)劃。作為一個(gè)例子，圖4顯示了一個(gè)六自由度三菱RV-E2在MATLAB中實(shí)現(xiàn)機(jī)械臂的三維模型。機(jī)器人的三維結(jié)構(gòu)是由矩形和三角形構(gòu)造的多邊形表示。議案的戰(zhàn)略評(píng)估模型用于模擬期間，作為操縱機(jī)器人運(yùn)動(dòng)規(guī)劃期間的工作空間中的結(jié)構(gòu)部件的碰撞檢測(cè)的基礎(chǔ)上。
4.2逆運(yùn)動(dòng)學(xué)
逆機(jī)械臂運(yùn)動(dòng)學(xué)關(guān)節(jié)角度的計(jì)算和翻譯，處理結(jié)果在所需的位置和方向,工具中心點(diǎn)（TCP）機(jī)器人（克雷格，1989年）。 TCP是一個(gè)預(yù)定義的endeffector點(diǎn)。對(duì)于六自由度三菱RV-E2的操縱范戴克（1999年）獲得了逆機(jī)械臂運(yùn)動(dòng)學(xué)的解析解。七自由度機(jī)械手，即三菱RV-E2的機(jī)械臂安裝在一個(gè)線性滑軌，一個(gè)簡(jiǎn)單的逆運(yùn)動(dòng)學(xué)解析解不存在由于在運(yùn)動(dòng)鏈的固有冗余。最近獲得這種冗余機(jī)械臂的逆運(yùn)動(dòng)學(xué)分析數(shù)值混合溶液（申克，2000年）。由于成熟的黃瓜的立場(chǎng)，該算法產(chǎn)生的七自由度機(jī)械臂的無(wú)碰撞收獲配置。此外，它可以保證關(guān)節(jié)黃瓜附近的精細(xì)運(yùn)動(dòng)控制有足夠的自由。
4.3路徑規(guī)劃
無(wú)碰撞路徑規(guī)劃算法已被大量的研究對(duì)象。例如見(jiàn)latombe（1991）和黃和阿胡加（1992）概述。
一個(gè)無(wú)碰撞路徑規(guī)劃主要包括兩個(gè)重要組成部分：搜索算法和碰撞檢測(cè)算法。搜索算法的搜索空間探索一個(gè)可行的，即collisionfree，從起點(diǎn)到目標(biāo)點(diǎn)的議案。在搜查過(guò)程中，被選中的碰撞檢測(cè)算法在搜索空間的每一步的可行性。該算法檢查機(jī)器人的碰撞與機(jī)器人的工作空間中的其他結(jié)構(gòu)部件。重要的是要注意，對(duì)于大多數(shù)路徑規(guī)劃者的搜索空間是所謂的配置空間機(jī)器人，其中關(guān)鍵的是從不同的3D工作區(qū)機(jī)器人。在黃瓜收獲機(jī)的7自由度機(jī)械手的情況下，配置空間是由一個(gè)聯(lián)合翻譯和6個(gè)聯(lián)合旋轉(zhuǎn)組合橫跨七維空間。然后，從一開(kāi)始的位置和方向的工具中心點(diǎn)為無(wú)碰撞運(yùn)動(dòng)目標(biāo)的位置和方向在三維工作空間癤的單點(diǎn)無(wú)碰撞通過(guò)的議案的搜索搜索七維配置從一開(kāi)始就配置目標(biāo)配置掩膜的空間。在這樣的運(yùn)動(dòng)鏈中的冗余問(wèn)題很容易規(guī)避。有一到一個(gè)映射的配置空間中的點(diǎn)的位置和方向，在工作區(qū)中的工具中心點(diǎn)。然而，對(duì)于大多數(shù)的機(jī)器人，相反不成立。一個(gè)單一的位置和方向，在工作區(qū)中的工具中心點(diǎn)，然后可以復(fù)制機(jī)器人的多種配置。由于其獨(dú)特的代表性配置空間搜索是首選。然而，碰撞檢測(cè)，需要說(shuō)明的身體姿勢(shì)操縱在與其他物體在三維工作空間的關(guān)系。因?yàn)槊總€(gè)配置代表一個(gè)單一的姿勢(shì)在三維工作空間的機(jī)械臂，可以很容易地驗(yàn)證碰撞。然后，特別是機(jī)器人的運(yùn)動(dòng)結(jié)構(gòu)，工作空間的障礙可以被映射到配置空間的障礙將會(huì)顯示。
4.3.1.搜索算法
路徑搜索算法應(yīng)該是有效率的，如果存在的話，找到一個(gè)解決方案。后者的財(cái)產(chǎn)被稱為完整性（珍珠，1984年）。通常情況下，算法的完整性，保證不計(jì)算效率。然而，計(jì)算效率是至關(guān)重要的，當(dāng)上線的應(yīng)用程序需要。運(yùn)動(dòng)規(guī)劃的各個(gè)方面取得的洞察力，在這項(xiàng)研究中，上述計(jì)算效率的青睞，該算法的完整性。這樣的選擇的主要原因是一個(gè)完整的算法將找到解決辦法，或停止使用一個(gè)明確定義的停止準(zhǔn)則，如果不能找到一個(gè)解決方案。這是不是真實(shí)的，不保證完整性的算法。他們要么提供一個(gè)解決方案或卡住，恕不另行通知。在本研究中所謂的A *搜索算法（明珠，1984年;近藤，1991年，羅素和Norvig還，1995年）。它很容易實(shí)現(xiàn)和保證完整性。此外，它最大限度地降低成本標(biāo)準(zhǔn)，其中包括一個(gè)在搜索空間旅行距離的措施。該算法是在MATLABB實(shí)施
圖5.在離散化的二維配置空間的正交節(jié)點(diǎn)擴(kuò)展：S，起始節(jié)點(diǎn); G，目標(biāo)節(jié)點(diǎn)
使用配置空間機(jī)器人運(yùn)動(dòng)規(guī)劃的A *算法，離散化使用一個(gè)固定的電網(wǎng)結(jié)構(gòu)如圖5。用戶可以定義網(wǎng)格的大小和分辨率。然后A *算法搜索從一開(kāi)始就格點(diǎn)的目標(biāo)格點(diǎn)的路徑，同時(shí)最大限度地降低成本函數(shù)f：此成本函數(shù)f包括路徑的成本遠(yuǎn)遠(yuǎn)?;和樂(lè)觀的估計(jì)成本從目前的位置目標(biāo)?：在這項(xiàng)研究中，歐拉規(guī)范被用來(lái)作為樂(lè)觀的估計(jì)到目標(biāo)節(jié)點(diǎn)的成本。A *算法是既完整和優(yōu)化。最優(yōu)保證的路徑獲得最大限度地減少使用成本函數(shù)。.
A *算法使用兩個(gè)網(wǎng)格節(jié)點(diǎn)，開(kāi)放列表和封閉列表清單。開(kāi)放列表中包含了電網(wǎng)的成本函數(shù)，其中尚未被評(píng)估，而評(píng)估已閉合的名單上的網(wǎng)格節(jié)點(diǎn)的函數(shù)值的節(jié)點(diǎn)。這是假設(shè)的起點(diǎn)和目標(biāo)，可以選擇配置，配合網(wǎng)格節(jié)點(diǎn)或網(wǎng)格節(jié)點(diǎn)，在這些配置的密切鄰里。然后根據(jù)珍珠（1984），A *算法在網(wǎng)格如下操作節(jié)點(diǎn)。
(1)放在開(kāi)放的起始節(jié)點(diǎn)S。
(2)如果打開(kāi)是空的，則失敗退出，否則從關(guān)節(jié)點(diǎn)n FO其中f是最低的開(kāi)放和地點(diǎn)。
(3)如果n等于目標(biāo)節(jié)點(diǎn)G;成功退出追溯從n指針為S得到的解決方案：
(4)否則擴(kuò)大N;生成所有其繼承人，并重視它們的指針回到N：對(duì)于每一個(gè)n的繼任者n’：
(a) 如果是尚未打開(kāi)或關(guān)閉，估計(jì)H（n’）（樂(lè)觀的估計(jì)成本的最佳途徑，從n’到目標(biāo)節(jié)點(diǎn)G），并計(jì)算F（n’）= G（n’）+ H（n’）其中g(shù)（n’）= G×（N）+ C（N，n’）C（N，n’）從節(jié)點(diǎn)n的過(guò)渡成本，節(jié)點(diǎn)n’和G（S）= 0
（b）如果已經(jīng)打開(kāi)或關(guān)閉，直接收益率最低的G（1）道路沿線的指針;
(c)如發(fā)現(xiàn)閉，1所需的指針調(diào)整和重新打開(kāi)它
(5)轉(zhuǎn)到第2步。
電網(wǎng)擴(kuò)張?jiān)诘?步，可以采取多種形式。在本研究中所謂的正交擴(kuò)充。這種方法是在圖5所示。
圖5還說(shuō)明起始節(jié)點(diǎn)和目標(biāo)節(jié)點(diǎn)沒(méi)有以配合實(shí)際的起點(diǎn)和目標(biāo)機(jī)器人的配置。在這種情況下，最近的鄰居節(jié)點(diǎn)被選中。
在這個(gè)算法，停止準(zhǔn)則是非常明確的規(guī)定。如果在第3步，從開(kāi)放列表中刪除的節(jié)點(diǎn)等于目標(biāo)節(jié)點(diǎn)，算法停止。另外，該算法將停止在第2步如果所有的網(wǎng)格節(jié)點(diǎn)進(jìn)行評(píng)估，并開(kāi)放列表已成為空。在這種情況下，沒(méi)有找到一個(gè)解決方案。
路徑搜索過(guò)程中碰撞檢測(cè)的處理有兩種方式。首先，碰撞的配置可以通過(guò)掃描整個(gè)離散化配置空間的路徑搜索前確定。這將是在一個(gè)高維離散化的空間配置，具有很高的情況下計(jì)算昂貴決議電網(wǎng)。這將是更有效地評(píng)估在搜索過(guò)程中的網(wǎng)格節(jié)點(diǎn)的可行性。也就是說(shuō)，在節(jié)點(diǎn)擴(kuò)展一步，第4步，碰撞檢測(cè)算法檢查是否與該節(jié)點(diǎn)相關(guān)的機(jī)器人配置與環(huán)境或不產(chǎn)生碰撞。由于A *算法通常計(jì)算只有一小部分配置空間，這將產(chǎn)生相當(dāng)大的改善效率。碰撞可以在步驟4a中提到的成本函數(shù)加入一個(gè)大型的罰款處罰。另外，在碰撞中產(chǎn)生的一個(gè)網(wǎng)格點(diǎn)可以直接從省略開(kāi)放期間電網(wǎng)的擴(kuò)張階段的名單。在這項(xiàng)研究中，后者的做法被使用。
圖6.一個(gè)面向包圍盒模型的六個(gè)自由度的RV-E2的操縱
4.3.2.碰撞檢測(cè)算法
碰撞檢測(cè)算法在MATLAB中實(shí)現(xiàn)根據(jù)報(bào)道由Boyse（1979年）的想法。該算法計(jì)算的交點(diǎn)在工作區(qū)中的其他結(jié)構(gòu)部件表面的機(jī)器人模型的表面。計(jì)算兩個(gè)曲面相交的本質(zhì)歸結(jié)為決定從幾何中使用的標(biāo)準(zhǔn)工具，可以實(shí)現(xiàn)與其他表面的一個(gè)表面的邊緣相交。所有的一切，碰撞檢測(cè)是一項(xiàng)計(jì)算密集型的任務(wù)。因此，在實(shí)時(shí)應(yīng)用，如黃瓜機(jī)器人碰撞檢測(cè)，需要碰撞檢測(cè)的精度和可用計(jì)算時(shí)間之間的權(quán)衡。精確的CAD模型圖。 4包含600個(gè)三角形和矩形表面。一因素15減少計(jì)算時(shí)間，實(shí)現(xiàn)了從所謂的面向邊界建立了一個(gè)不太準(zhǔn)確的模型代替精確的操縱模型盒（更新行動(dòng)）。這種三維機(jī)械手的只有36個(gè)移動(dòng)的表面組成OBB的模型如圖6所示。顯然，一些與OBB的模型精度已提供計(jì)算速度的緣故。對(duì)于目前的調(diào)查，它被認(rèn)為是合理的。
5．例1：碰撞兩個(gè)度的自由操縱運(yùn)動(dòng)規(guī)劃
要說(shuō)明的方法，結(jié)果與兩兩自由度轉(zhuǎn)動(dòng)關(guān)節(jié)的機(jī)械臂的無(wú)碰撞運(yùn)動(dòng)規(guī)劃。圖7（a）顯示了一個(gè)人為的溫室環(huán)境，其中方塊代表黃瓜莖的目標(biāo)是移動(dòng)的路徑（直打下了）操縱的工具中心點(diǎn)背后掛在黃瓜黃瓜冠捷干，沒(méi)有擊中任何黃瓜莖。這被認(rèn)為是黃瓜采摘過(guò)程中最困難的議案之一。
5.1.結(jié)果
為了說(shuō)明操作的運(yùn)動(dòng)規(guī)劃算法，圖。 7（b）顯示相關(guān)的兩維的配置空間。一個(gè)離散化步驟五度使用。堅(jiān)實(shí)的黑色方塊，稱為配置的障礙，代表機(jī)器人和黃瓜干之間的碰撞產(chǎn)生的配置。由字母S表示開(kāi)始配置目標(biāo)配置是由字母G表示：他們代表的開(kāi)始姿勢(shì)和圖采摘姿態(tài)。 7（一）。路徑搜索的目標(biāo)是要找到一個(gè)起始節(jié)點(diǎn)S和目的節(jié)點(diǎn)G之間的連接：觀察，首先，配置空間的地圖，揭示了真正復(fù)雜運(yùn)動(dòng)規(guī)劃的問(wèn)題，可能看起來(lái)瑣碎的工作空間中。其次，觀察，一條直路從起始節(jié)點(diǎn)到目標(biāo)節(jié)點(diǎn)碰撞的結(jié)果，并因此是不可行的。圖7（c）所示的網(wǎng)格節(jié)點(diǎn)，記為*，A *算法的評(píng)估過(guò)程中向前搜索從起始節(jié)點(diǎn)到目標(biāo)節(jié)點(diǎn)。圖所示的配置空間中的最優(yōu)路徑。如圖7（d）及相關(guān)的無(wú)碰撞機(jī)械臂在工作區(qū)的議案快照。 7（E）。觀察，在工作區(qū)中的無(wú)碰撞運(yùn)動(dòng)的空間配置結(jié)果無(wú)碰撞的議案;機(jī)器人不會(huì)干擾與工作空間的障礙：黃瓜莖。最后，圖7（f）顯示網(wǎng)格節(jié)點(diǎn)A *算法當(dāng)一個(gè)落后的搜索目標(biāo)節(jié)點(diǎn)的起始節(jié)點(diǎn)進(jìn)行評(píng)估。
5.2.討論
結(jié)果表明，在配置空間沸騰的路徑搜索，找到一個(gè)點(diǎn)的運(yùn)動(dòng)軌跡，從一開(kāi)始就配置目標(biāo)配置。
圖7（c）和（F）清楚地表明，碰撞檢查接續(xù)OFA先驗(yàn)碰撞檢測(cè)路徑搜索過(guò)程中，由于A *算法，只有部分評(píng)估在配置空間網(wǎng)格點(diǎn)的優(yōu)勢(shì)。此外，研究結(jié)果表明，如果一個(gè)障礙之間開(kāi)始配置和位于目標(biāo)配置，大量的網(wǎng)格節(jié)點(diǎn)找到了解決辦法之前，必須進(jìn)行評(píng)估。在這種情況下，A *算法不是很有效，在發(fā)現(xiàn)周圍的配置空間障礙的一種方式。障礙的情況下密切繞過(guò)一個(gè)目標(biāo)節(jié)點(diǎn)，一個(gè)落后的搜索可能會(huì)產(chǎn)生較少的解決方案由圖所示的計(jì)算時(shí)間。 7（F）。在這個(gè)例子中向后搜索向前搜索時(shí)取得117而不是146次迭代后的解決方案;減少20％。如果目標(biāo)節(jié)點(diǎn)位于兩者之間的障礙脊巷子盡頭，即使在較高的迭代次數(shù)減少使用向后搜索（結(jié)果未顯示）獲得。最好的搜索方向明確，取決于手頭的特定結(jié)構(gòu)的問(wèn)題。這兩個(gè)圖。 7條（d）及（e）表明，以實(shí)現(xiàn)最優(yōu)路徑成本函數(shù)的意義，算法往往偷工減料，致使小機(jī)器人和障礙物之間的距離。要牢記這一特點(diǎn)，在實(shí)際運(yùn)動(dòng)規(guī)劃實(shí)驗(yàn)時(shí)，傳感器為基礎(chǔ)的世界描述數(shù)據(jù)不準(zhǔn)確容易。然后可能會(huì)發(fā)生碰撞，不占在運(yùn)動(dòng)規(guī)劃。最后，圖7（d）顯示，由于電網(wǎng)結(jié)構(gòu)和正交擴(kuò)展的路徑搜索過(guò)程中的網(wǎng)格節(jié)點(diǎn)，運(yùn)動(dòng)路徑包含了一些尖角。這將導(dǎo)致強(qiáng)不必要的加速和減速的鏈接時(shí)，在實(shí)踐中實(shí)施。在第4節(jié)的建議，為平滑軌跡規(guī)劃的議案等不良行為的來(lái)電。
6．例2：碰撞為6度的自由操縱運(yùn)動(dòng)規(guī)劃
這一段演示六自由度三菱RV-E2的機(jī)械臂運(yùn)動(dòng)規(guī)劃方案。圖8（a）顯示了三維視圖六自由度機(jī)械手，在一個(gè)人為的溫室環(huán)境。再次，目標(biāo)是從路徑中的位置移動(dòng)機(jī)器人的工具中心點(diǎn)到黃瓜掛背后的黃瓜干，沒(méi)有擊中黃瓜TEMS代表由黑職位。
圖7.黃瓜采摘在一個(gè)人為的溫室環(huán)境經(jīng)營(yíng)度自由操縱的無(wú)碰撞運(yùn)動(dòng)規(guī)劃：（a）開(kāi)始姿勢(shì)（直）和目標(biāo)姿態(tài)與機(jī)械臂的工作空間冠捷挑選黃瓜掛灰色正方形代表;（b）與代表的黑色區(qū)域配置中的碰撞和S的起點(diǎn)和目標(biāo)配置，分別代表?配置空間;（c）配置空間由A采樣黃瓜干背后*算法在從一開(kāi)始向前搜索到目標(biāo)節(jié)點(diǎn);（d）通過(guò)配置空間的無(wú)碰撞軌跡;（e）6，到操盤黃瓜的無(wú)碰撞運(yùn)動(dòng)的快照;（f）配置A *算法在空間采樣，從向后搜索目標(biāo)的起始節(jié)點(diǎn)1和2是第一和第二關(guān)節(jié)的旋轉(zhuǎn)。
6.1．結(jié)果
由于這個(gè)例子涉及一個(gè)六自由度機(jī)械手，執(zhí)行搜索，在六維的配置空間。這是不可能的可視化配置空間的無(wú)碰撞點(diǎn)的運(yùn)動(dòng)，是與前面的例子一樣。因此，只有通過(guò)工作區(qū)的無(wú)碰撞運(yùn)動(dòng)的快照?qǐng)D。 8（一） - （F）。該議案涉及所有6個(gè)旋轉(zhuǎn)關(guān)節(jié)。從本質(zhì)上講，黃瓜的議案，由兩部分組成。首先所有機(jī)器人向后傾斜，同時(shí)圍繞主垂直軸旋轉(zhuǎn)，然后傾斜前鋒再次攜帶刀具中心點(diǎn)之間的黃瓜莖。其次，同時(shí)，過(guò)去三年關(guān)節(jié)旋轉(zhuǎn)，以便能夠定位在背后的黃瓜干黃瓜工具中心點(diǎn)。這樣做，黃瓜干規(guī)避。
6.2．討論
結(jié)果表明，碰撞自由運(yùn)動(dòng)的六自由度機(jī)械手可以發(fā)現(xiàn)。據(jù)預(yù)計(jì)，這一結(jié)果可以擴(kuò)展到七個(gè)自由度的機(jī)械手，在黃瓜采摘設(shè)備使用。然而，這個(gè)例子揭示了A *算法的弱點(diǎn)。對(duì)于正在審議的六自由度機(jī)械手，在六維的配置空間進(jìn)行搜索。然后，由于網(wǎng)格點(diǎn)的大量的，必須進(jìn)行評(píng)估，搜索變得過(guò)于緩慢。這部分是由于在MATLAB實(shí)現(xiàn)。該軟件包不是很有效時(shí)，必須執(zhí)行大量的迭代。再次，結(jié)果表明：在運(yùn)動(dòng)軌跡的尖角。當(dāng)需要高速運(yùn)動(dòng)，這些運(yùn)動(dòng)軌跡要平滑，以防止上機(jī)械臂鏈接的重載。
黃瓜采摘機(jī)器人
圖8.（a）-（f）：六快照的無(wú)碰撞運(yùn)動(dòng)6自由度RV-E2的操縱掛在黃瓜背后黃瓜莖代表黑色垂直職位
7.結(jié)論
本文提出了一種方法，以達(dá)到適當(dāng)?shù)氖盅蹍f(xié)調(diào)的黃瓜收獲機(jī)器人在農(nóng)業(yè)和環(huán)境工程研究所（IMAG BV）的開(kāi)發(fā)。本文提出了一個(gè)方案，是能夠生成機(jī)器人無(wú)碰撞運(yùn)動(dòng)。一些數(shù)值例子說(shuō)明了該方法和分析。
本研究的主要結(jié)論是，無(wú)碰撞運(yùn)動(dòng)可以計(jì)算六度自由度（DOF），RV-E2的機(jī)械臂在收獲機(jī)使用。據(jù)預(yù)計(jì)，這些結(jié)果可以擴(kuò)展到七自由度機(jī)械手，即RV-E2的操縱器線性滑軌安裝。被發(fā)現(xiàn)的A*搜索算法很容易實(shí)現(xiàn)和強(qiáng)大的。通過(guò)這種方式，它提供了很多有識(shí)之士為機(jī)器人運(yùn)動(dòng)規(guī)劃的具體問(wèn)題。此外，該算法的一個(gè)大優(yōu)勢(shì)是，它可以產(chǎn)生一個(gè)解決方案或停止時(shí)，無(wú)法找到一個(gè)解決方案。該財(cái)產(chǎn)的完整性，但是，使得算法望而卻步緩慢。結(jié)果發(fā)現(xiàn)，與本文中所描述的算法涉及的多自由度機(jī)械手運(yùn)動(dòng)軌跡的計(jì)算是計(jì)算非常。至符合所需的周期時(shí)間的10秒為一個(gè)單一的收獲行動(dòng)，需要進(jìn)一步研究，以減少議案所需的計(jì)算時(shí)間規(guī)劃。研究，可沿兩條線。首先，可以減少計(jì)算時(shí)間，通過(guò)使用特殊的計(jì)算機(jī)硬件，例如并行處理器。另外，同時(shí)，減少計(jì)算可以通過(guò)使用更快和有效地實(shí)現(xiàn)的算法。此外，結(jié)果表明，該算法不包括許多情報(bào)。雖然它試圖產(chǎn)生定向運(yùn)動(dòng)的目標(biāo)，如果它只是配置遇到障礙樣品中的搜索空間網(wǎng)格解決方案，直到發(fā)現(xiàn)不使用有關(guān)的問(wèn)題，特別是結(jié)構(gòu)的信息點(diǎn)。因此，進(jìn)一步研究需要獲得快速算法，有效地利用有關(guān)的問(wèn)題，特別是結(jié)構(gòu)的信息，不卡，恕不另行通知。
致謝
這項(xiàng)工作是由荷蘭農(nóng)業(yè)，食品和漁業(yè)部的支持。匿名介紹人的建設(shè)性意見(jiàn)表示感謝。
參考文獻(xiàn)
[1]Arima S; Kondo N (1999). Cucumber harvesting robot and plant training system. Journal of Robotics and Mechatro-nics, 11(3), 208–212
[2]Bontsema J; Van Kollenburg-Crisan L M; Van Henten E (1999). Automatic harvesting of vegetable fruits, Proceedings of the BRAIN International Symposium 2000 }Progressive Technologies in Agriculture and Environmen towards 21 Century, November 24, 1999, IAM-BRAIN Omiya, Japan, pp 44–51
[3]Boyse J W (1979). Interference detection among solids and surfaces. Communications of the ACM, 22(1), 3–9
[4]Craig J J(1989). Introduction to Robotics. Addison-Wesley,Reading, MA, USA
[5]Gieling Th H; Van Henten E J; Van Os E A; Sakaue O;Hendrix A T M (1996). Conditions, demands and technol-ogy for automatic harvesting of fruit vegetables. ActaHorticulturae,440, 360–365
[6] Hayashi S; Sakaue O (1996). Tomato harvesting by robotic system. ASAE Annual International Meeting, Phoenix, Arizona, USA, ASAE Paper No. 96-3067
[7]Herman M (1986). Fast, three-dimensional, collision-free motion planning. Proceedings of the IEEE International Conference on Robotics and Automation, San Francisco,CA, USA, pp 1056–1063
[8] Hwang Y K; Ahuja N (1992). Gross motion planning}a survey. ACM Computing Surveys, 24(3), 219–291
[9] Kondo K (1991). Motion planning with six degrees of freedom by multistrategic bidirectional heuristic free-space enumera-tion. IEEE Transactions on Robotics and Automation, 7(3),267–277
[10] Kondo N; Monta M; Fujiura T(1996). Fruit harvesting robots in Japan. Advances in Space Research, 18(1/2), 181–184
[11] Latombe J C (1991). Robot Motion Planning. Kluwer Academic Publishers, Boston, USA
[12] Meuleman J; Van Heulen S F; Kornet J G; Peters D G(2000). Image analysis for robot harvesting of cucumbers. AgEng 2000, Agricultural Engineering International Conference, Warwick, UK, EurAgEng Paper No. 00-AE-003
[13] Pearl J (1984).Heuristics.Intelligent Search Strategies for Com-puter Problem Solving. Addision-Wesley, Reading, MA, USA
[14] Russell S; Norvig P (1995). Artificial Intelligence }A mode Approach. Prentice-Hall, Englewood Cliffs, NJ, USA
[15] Schenk E J(2000). Modelvorming, voorwaartse kinematica, inverse kinematica met botsingsdetectie en padplanning van een 7 DOF manipulator systeem voor het automatisch oogsten van komkommers. [Modelling, forward kinematics, inverse kinematics with collision detection and motion planning of a 7 DOF manipulator system used for cucumber harvesting]. IMAG, Wageningen, The Netherlands, IMAG
Report V2000-77
[16] Van Dijk G(1999). Modelvorming en padplanning van een 6 DOF manipulator voor het oogsten van komkommers. [Modelling and motionplanning of a 6 DOF manipulator used for cucumber harvesting.] IMAG, Wageningen, The Netherlands, IMAG Report V99-04
[17] Van Kollenburg-Crisan L M; Wennekes P; Werkhoven C (1997). Development of a mechatronic system for automatic harvesting of cucumbers. In: Proceedings of BIO-RO-BOTICS 97, The International Workshop on Robotics and Automated Machinery for Bio-productions, Valencia, Spain, pp 143–148