【正文】 .................................................................................................. 27 結(jié)束語 ............................................................................................................................................. 30 參考文獻 ......................................................................................................................................... 31 致謝 ................................................................................................................................................ 33 附件 ................................................................................................................................................ 34 1 第一章 前言 研究背景與意義 隨著電子技術(shù)和計算機技術(shù)的發(fā)展 ,智能機器人已在許多領(lǐng)域得到日益廣泛的應(yīng)用。 國際上，日本、美國等發(fā)達國家，已經(jīng)從 20 世紀 80 年代開始研究采摘機器人，并取得很多成果。和國內(nèi)相比國外一直處于技術(shù) 前沿。采用具有冗余度的 7 自由度機械手是為了能夠靈活避開障礙物。 其 內(nèi)置有能夠感應(yīng)色彩的攝像頭，可以 準確 分辨出草莓和綠葉，利用事先設(shè)定的色彩值，再配合獨特的機械結(jié)構(gòu)，它就可以判斷出草莓的成熟度，并將符合要求的草莓采摘下來 ，速度達到 10s/個 [6]。該機器人末端執(zhí)行器下方安裝有果實收集袋，縮短了從采摘到放置的時問，提高了采摘速度 [7]。經(jīng)教育部認定，是國內(nèi)第一臺黃瓜采摘機器人，獲得多項國家專利。未來的采摘機器人將真正做到一機多用，不僅可以采摘多種果實還可以實現(xiàn)多種用途 [13]。 （ 2）具有靈活的機械臂和較為輕便柔軟的機械末端，且能夠在工作時避開枝蔓的阻撓。所以要求系統(tǒng)的實時性要好。比如，最初的日本研制的番茄采摘機器人采用傳統(tǒng)視覺處理技術(shù) 由彩色攝像頭和圖像處理卡組成的視覺系統(tǒng)來尋找和識別成熟果實 [16]，而現(xiàn)在番茄采摘機器人，南京農(nóng)業(yè)大學(xué)的張瑞合、姬長英等人在番茄采摘中運用雙目立體視覺技術(shù)對紅色番茄進行定位，將圖像進行灰 度變換，而后對圖像的二維直方圖進行腐蝕、膨脹以去除小團塊，提取背景區(qū)邊緣，然后用擬合曲線實現(xiàn)彩色圖像的分割，將番茄從背景中分離出來 [17]。機器人已由一開始的無法準確判斷和避開枝蔓 [18]，發(fā)展到快速而準確的避開枝蔓采摘果實。 果實采摘機 器人整體機械結(jié)構(gòu)的分析 機器人整體的機械結(jié)構(gòu)應(yīng)具備以下能力： （ 1） 要具備可靠性，穩(wěn)定性，結(jié)構(gòu)緊湊并且要有適當?shù)墓ぷ鞣秶?。其自由度?7，由下到上，第一個自由度為水平移動，第二個自由度是升降自由度，第三個為旋轉(zhuǎn)自由度，后面三個為機械臂的軌跡規(guī)劃自由度，最 后一個是機械末端的自動調(diào)整自由度。 6 圖 四輪式果實采摘機器人整體結(jié)構(gòu)示意圖 運動控制系統(tǒng)機械結(jié)構(gòu)的設(shè)計 運動控制系統(tǒng)的機械結(jié)構(gòu)分析 我們首先假想，番茄采摘機器人的環(huán)境是地面整 體平坦，具有摩擦系數(shù)適中，地面結(jié)實。前輪是控制車體轉(zhuǎn)向，后輪是控制車體前后運動。圖 是其從后面角度看的機械結(jié)構(gòu)示意圖， 7 圖 車體布局示意圖 圖 從車體后方角度觀察 運動控制系統(tǒng)車體載荷分析與執(zhí)行器的選擇 執(zhí)行器選擇依據(jù) 作為番茄采摘機器人中承擔(dān)機器人的移動任務(wù)，車體載荷決定驅(qū)動電機的選擇。靜態(tài)摩擦系數(shù) 一 般取 。通過查找電機的參數(shù)指標 , ，可以選擇 FAULHBER3863型號，當工作電壓為 24Ｖ時，其輸出功率為 130W。 ?? —— 工作機的效率。 根據(jù)最選擇功率合適的電機，要求電機的輸出功率滿足 Pmax≥P0,一般選擇 2 P0≥Pmax≥ P0。我們采用 35BY48HJ120減速步進電動機。同時為了提高運動系統(tǒng)的穩(wěn)定性能，避免設(shè)備的不必要的效率消耗以及降低投入成本和達到靈活的避險要求。在本系統(tǒng)中控制量較多，單片機的優(yōu)勢得到很好的體現(xiàn)。 為了提供穩(wěn)定的 5V 直流電源，需要將 24V 電源穩(wěn)定 5V。電動機在 24V 電壓情況下 能夠正常工作。 電機控制模塊 脈寬調(diào)制（ PWM）原理： 小功率直流電機由定子和轉(zhuǎn)子組成，對小功率直流電機調(diào)速系統(tǒng)，使用單片機是極為方便的。這種調(diào)速方法稱為脈寬調(diào)速。 電機驅(qū)動模塊 （ 1）前輪電機的驅(qū)動 模塊 由于步進電機是一種將電脈沖信號轉(zhuǎn)換成直線或角位移的執(zhí)行元件，它不能直接接到交直流電源上。它是由 7 對 NPN 達林頓管組成的，它的高電壓輸出特性和陰極箝位二極管可以轉(zhuǎn)換感應(yīng)負載。 表 ULN2020A 的極限參數(shù) 14 項目 符號 數(shù)值 單位 最大輸入電壓 Vi(max) 30 V 集電極 發(fā)射極電壓 Vo(max) 50 V 最大基極輸入電流 IB(MAX) 25 mA 輸出電流 Io 500 mA 貯存溫度 Ts 65～ 150 ℃ 結(jié)溫 Tj 175 ℃ 引線耐焊接溫度 TD 300 ℃ （ 2）后輪電機的驅(qū)動模塊 所示為一個典型的直流電機控制電路。要使電機運轉(zhuǎn)，必須導(dǎo)通對角線上的一對三極管。按圖中電流箭頭所示，該流向的電流將驅(qū)動電機順時針轉(zhuǎn)動。 圖 H橋驅(qū)動電路 圖 驅(qū)動 電機順時針轉(zhuǎn)動 圖 驅(qū)動電機逆時針轉(zhuǎn)動 顯示模塊 本設(shè)計的顯示 模塊目標是能夠顯示出電機的正反轉(zhuǎn)停等信息。由該模塊構(gòu)成的液晶顯示方案與 同類型的圖形點陣液晶顯示模塊相比，不論硬件電路結(jié)構(gòu)或顯示程序都要簡潔得多，且該模塊的價格也略低于相同點陣的圖形液晶模塊。果實識別與采摘采用視覺傳感器、位置傳感器、力傳感器，系統(tǒng)導(dǎo)航采用電磁傳感器，運動系統(tǒng)避障采用超聲波 傳感器。 （ 1）常見傳感器的比較 傳感器種類多，應(yīng)用廣泛，以下是幾種常用傳感器的比較。 測量范圍小 ， 對 空氣溫度 變化敏感。其利用紅外原理制成的，這也就決定其在對物體探測過程中對溫度依賴過大，對溫度相同的物體不能做出準確的判斷。 方案三： 探測障礙的最簡單的方法是使用超聲波傳感器，它是利用向目標發(fā)射超聲波脈沖，計算其往返時間來判定距離的。 圖 為超聲波避障模塊框圖。 超聲波測距的原理一般采用渡越時間法 TOF（ time of flight）。 功能包括對會聚主 IC 內(nèi)部寄存器、數(shù)據(jù) RAM 及外部接口等功能部件的初始化，會聚調(diào)整控制，會聚測試圖控制，紅外遙控信號 IR 的接收解碼及與主板 CPU 通信等。 最小系統(tǒng)電路如圖 所示，其由時鐘電路和復(fù)位電路組成。 復(fù)位電路。控制兩個電機：前輪控制車體轉(zhuǎn)向的步進電機；后輪控制電機前進后退的直流電機。LED 燈與電阻組成光報警；蜂鳴器與驅(qū)動電路組成的聲報警。 圖 LED燈光報警 圖 聲報警 顯示模塊電路設(shè)計 顯示模塊如圖 所示，是將番茄采摘機器人的運動狀態(tài)用直觀的方法顯示出來。為此設(shè)計中采用了 CD4069 六非門反相器來增強超聲波的發(fā)射功率，由于非門實質(zhì)上是放大倍數(shù)很大的反相放大器，如果給非門加上合適的負反饋電阻，就能夠使它從飽和區(qū)進入線性放大區(qū)。輸出端采 用兩個反向器并聯(lián)用以提高驅(qū)動能力。 圖 超聲波發(fā)射驅(qū)動電路 22 （ 2）超聲波接收電路 集成芯片 CX20206A 是一款紅外線檢波接收的專用芯片，常用電視機遙控器。 圖 CX20206A內(nèi)部結(jié)構(gòu)及電路連接圖 使用 CX20206A 集成電路對接收探頭受到的信號進行放大、濾波。增大電阻 R1 或減小 C1,將使負反饋量增大，放大倍數(shù)下降，反之則放大倍數(shù)增大。取 F 例如， R=200kΩ 時， 0≈ 42kHz， 若取 R=220k 23 Ω ，則中心頻率 F0 ≈ 38kHz。 第四章 運動控制系統(tǒng)軟件設(shè)計 番茄采摘機器人運動控制系統(tǒng)的軟件主要由等五大部分組成，每一部分都針對相應(yīng)的硬件路。 開始 初始化 24 圖 運動控制系統(tǒng)總程序流程圖 超聲波測距模塊 開始 比較避障并處理 計算距離 發(fā)射超聲波脈沖 接受超聲波脈沖 25 圖 超聲波測距模塊流程圖 主程序?qū)ο?統(tǒng)進行初始化之后，超聲波測距程序設(shè)置定時器 T0 為 16 位定時器，開中斷允許位 EA，清零顯示端口 P0 和 P2。測出距離后結(jié)果將以十進制 BCD 碼方式送入累加器 A 與安全距離進行比較，若判定前方有障礙物則執(zhí)行避障操作，等待上述過程結(jié)束，然后再發(fā)射超聲波脈沖重復(fù)測量過程。本運動系統(tǒng)對速度的精度無特殊要求，控制直流電機方法相對簡單。八拍工作方式的步距角是單四拍與雙四拍的一半，因此，八拍工作方式既可以保持較高的轉(zhuǎn)動力矩又可以提高控制精度 。 N 27 顯示模塊 顯示模塊的關(guān)鍵之處是了解顯示的指令。簡要步驟如下： 在使用時先在 Keil uVision 環(huán)境下編輯程序，然后保存程序、建立新項目、設(shè)置項目，接著編譯程序并生成 HEX 文件，最后在 Proteus 上調(diào)試和執(zhí)行。 所示，顯示的是后輪電機處于停止狀態(tài)，顯示屏顯示為“停止”。 28 圖 仿真效果圖（后輪電機停止狀態(tài)） 29 圖 仿真效果圖（后輪電機正轉(zhuǎn)狀態(tài)） 30 結(jié)束語 本文介紹了番茄采摘機器人運動控制系統(tǒng)的設(shè)計與實現(xiàn)，闡述了番茄采摘機器人運動控制系統(tǒng)的整體機械結(jié)構(gòu)與運動控制系統(tǒng)的 組成，并對基于 AT89C52的控制策略進行了研究，設(shè)計了避障系統(tǒng)，并最終借助于 Proteus 完成了實驗的驗證。在整個完成過程中，不僅提高了 我查閱文獻資料、設(shè)計手冊 、 CAD 制圖 、 Proteus 仿真 等 知識，并且 使我的 抗壓能力 、思維分析能力都有了很大提高，這必將成為我今后生活中不可多得的經(jīng)驗 。 首先得感謝我的論文指導(dǎo)老師王俊老師，本文的工作是在王老師的悉心指導(dǎo)下完成的。 2020年 05月于合肥學(xué)院 34 附件： 程序 (部分程序清單 ) include include include define uc unsigned char define ui unsigned int define LCDPAGE 0xB8 //設(shè)置頁指令。 sbit RS=P3^6。 sbit LED=P0^5。 uc scan_key1,scan_key2。 static step_index。 uc code FZ[]= { 0x09,0x08,0x0c,0x04,0x06,0x02,0x03,0x01 }。合 0x40,0x40,0x20,0x50,0x48,0x44,0x42,0x41, 0x42,0x44,0x68,0x50,0x30,0x60,0x20,0x00, 35 0x00,0x00,0x00,0x7E,0x22,0x22,0x22,0x22, 0x22,0x22,0x22,0x7E,0x00,0x00,0x00,0x00, }。學(xué) 0x40,0x30,0x10,0x12,0x5C,0x54,0x50,0x51, 0x5E,0xD4,0x50,0x18,0x57,0x32,0x10,0x00, 0x00,0x02,0x02,0x02,0x02,0x02,0x42,0x82, 0x7F,0x02,0x02,0x02,0x02,0x02,0x02,0x00, }。自 0x00,0x00,0x00,0xF8,0x48,0x48,0x4C,0x4B, 0x4A,0x48,0x48,0x48,0xF8,0x00,0x00,0x00, 0x00,0x00,0x00,0xFF,0x44,0x44,0x44,0x44, 0x44,0x44,0x44,0x44,0xFF,0x00,0x00,0x00, }。 uc code X[]= {