【正文】 //寫指令行 for(i=0。 // 寫指令 頁 wcode(LCDLINE)。i16。 //寫數(shù)據(jù)代碼 E=1。 //輸出 設(shè)置 P2=cd。 //使能LCD RS=0。R=1。void disrow(uc page,uc col,uc *temp)。/**/uc code YOU[]={0x00,0x08,0x08,0x88,0x48,0xF8,0x4C,0x4B,0x28,0x24,0xE4,0x04,0x04,0x04,0x00,0x00,0x04,0x02,0x01,0x00,0x00,0x7F,0x05,0x05,0x25,0x40,0x3F,0x00,0x00,0x00,0x00,0x00,}。uc code TUI[] = {//退 0x40,0x41,0xC6,0x00,0x00,0xFE,0x4A,0x4A,0xCA,0x4A,0x4A,0x7E,0x80,0x00,0x00,0x00,0x40,0x20,0x1F,0x20,0x40,0x5F,0x48,0x44,0x40,0x41,0x42,0x4D,0x58,0x40,0x40,0x00,}。uc code TAI[]={//態(tài)0x00,0x04,0x04,0x04,0x84,0x44,0x34,0x4F,0x94,0x24,0x44,0x84,0x84,0x04,0x00,0x00,0x00,0x60,0x39,0x01,0x00,0x3C,0x40,0x42,0x4C,0x40,0x40,0x70,0x04,0x09,0x31,0x00,}。動 0x20,0x24,0x24,0xE4,0x24,0x24,0x24,0x20,0x10,0x10,0xFF,0x10,0x10,0xF0,0x00,0x00,0x08,0x1C,0x0B,0x08,0x0C,0x05,0x4E,0x24,0x10,0x0C,0x03,0x20,0x40,0x3F,0x00,0x00,}。肥 0x00,0x00,0xFE,0x12,0x12,0xFE,0x00,0xFE,0x42,0x42,0x7E,0x42,0x42,0xFE,0x00,0x00,0x40,0x30,0x0F,0x21,0x41,0x3F,0x00,0x3F,0x40,0x40,0x40,0x40,0x40,0x40,0x70,0x00,}。 //定時 uc butter。// //忙 判斷位 sbit MA=P1^6。 sbit E=P3^5。參考文獻[1] IllWoo Park, JungYup Kim, Jungho Lee, JunHo Oh. Mechanical design of humanoid robot platform KHR3[C]．IEEERAS International Conference on Humanoid Robot, 2005：321–326．[2] Edan Y，Rogozin D，F(xiàn)lash T，et melon harvesting[J]．Robotics and Automation，2000，16 (6)：831835．[3] 徐瑋，沈建良．單片機快速入門[M]．北京：北京航空航天大學出版社，2008 .[4] 紀超，馮青春，袁挺，譚豫之，李偉．溫室黃瓜采摘機器人系統(tǒng)研制及性能分析[D]．中國農(nóng)業(yè)大學工學院，2010． [5] 秦浩，馬旭，卓晴．基于電磁場檢測的尋線智能車設(shè)計[M]．北京：清華大學出版社，2009． [6] 宋健，張賓，于曙風．電磁感應(yīng)傳感器在噴霧機器人導航中的應(yīng)用[J]．農(nóng)業(yè)工程學報，2005，27 (6)：8793．[7] 陳中偉，肖華，吳功平．高壓巡線機器人電磁傳感器導航方法[J]．武漢大學學報，2006，14 (5)：3237．[8] 嚴誠,馬宏亮．果實采摘機器人運動學研究[M]．西安：西安交通大學出版社, 2008． [9 ] 曲文乾，胡曉樂．三維信息采集系統(tǒng)中的檢校分析[J]．首都師范大學學報，2008，12 (8)：1119．[10] 李小煒，姬長英．多用途采摘機器人末端執(zhí)行器的研究[M]．南京： 南京農(nóng)業(yè)大學出版社，2010．[11] 張鐵中，林寶龍，[J]．農(nóng)業(yè)機械學報，2004，41(12)：244248．[12] 廖勤武，王朝立，[J]．上海理工大學學報，2009，31(4)：402405． [13] [J]．伺服控制，2008， 31(8)：3133． [14] 鮑官軍，荀一，戚利勇，楊慶華，高峰．機器視覺在黃瓜采摘機器人中的應(yīng)用研究[J]．浙江工業(yè)大學學報，2010，38(1)：114118．[15] 趙廣濤，[J]．微計算機信息，2006， 1(7)：129131．[16] 張國勛，（第二版）[M]．北京：中國電力出版社，2007．[17] Pubudu N．et al. A Method for StereoVision based tracking for robotic applications[C]．Proceedings of the 47th IEEE CDC, 2008．[18] 樓然苗，李光飛．單片機課程設(shè)計指導[M]．北京：北京航空航天大學出版社，2007．致謝時間總會在不經(jīng)意間溜走，隨著本論文的完成，我的大學生活也將結(jié)束。此時無采摘任務(wù)，且前方無障礙物番茄采摘，機器人處于前進狀態(tài)。第五章 系統(tǒng)仿真本設(shè)計是最后借助于仿真，完成的。單四拍與雙四拍的步距角相等，但單四拍的轉(zhuǎn)動力矩小。在室溫下測試聲速為 344m/s，超聲波每發(fā)射，接收一次所走距離為被測距離 L 的 2 倍，L便是被測物體和超聲波傳感器之間的距離，L式中t為計數(shù)器 T0 中的計數(shù)值。7腳：遙控命令輸出端，它是集電極開路輸出方式，因此該引腳必須接上一個上拉電阻到電源端，沒有接受信號是該端輸出為高電平，有信號時則產(chǎn)生下降。以下是CX20106A的引腳注釋∶1腳：超聲信號輸入端，該腳的輸入阻抗約為40kΩ 。上拉電阻 R23,R24 一方面可以提高反相器的高電平驅(qū)動能力，另一方面可以增強超聲波換能器的阻尼效果，縮短其自由震蕩的時間。 顯示模塊本設(shè)計采用T/R4012小型超聲波傳感器作為探測前方障礙物體的檢測元件，其中心頻率為40Hz，由80C52發(fā)出的40KHz脈沖信號驅(qū)動超聲波傳感器發(fā)送器發(fā)出40KHz的脈沖超聲波，如機器人運動時前方遇到有障礙物時，此超聲波信號被障礙物反射回來，由接收器接收，經(jīng)LM318兩級放大，再經(jīng)帶有鎖相環(huán)的音頻解碼芯片LM567解碼，當LM567的輸入信號大于25mV時，輸出端由高電平變?yōu)榈碗娖?，?0C52單片機處理?？刂苾蓚€電機：前輪控制車體轉(zhuǎn)向的步進電機；后輪控制電機前進后退的直流電機。，其由時鐘電路和復位電路組成。首先測出超聲波從發(fā)射到遇到障礙物返回所經(jīng)歷的時間，再乘以超聲波的速度就得到二倍的聲源與障礙物之間的距離。該方法被廣泛應(yīng)用于移動機器人的研究上。測量范圍有限，對天氣環(huán)境變化敏感。識別障礙的首要問題是傳感器的選擇?？梢燥@示84行1616點陣的漢字. 。 H橋電路驅(qū)動電機順時針轉(zhuǎn)動，電流將從右至左流過電機。H橋式電機驅(qū)動電路包括4個三極管和一個電機。由于機步進電動機不能直接接到工頻交流或直流電源上工作，而必須使用專用的步進電動機驅(qū)動器。這種方法稱為脈沖寬度調(diào)制，簡稱PWM。比較而言，開關(guān)型直流穩(wěn)壓電路更能降低電源轉(zhuǎn)換芯片的功耗，提高電源的利用效率。根據(jù)設(shè)計要求，控制器主要用于各種信號的處理、控制算法實現(xiàn)、底盤電動機的控制和聲光報警等，控制器選擇ATMEL公司生產(chǎn)的AT89C52單片機作為系統(tǒng)控制器。總結(jié)：由上述兩種方法進行選擇，可以看出FAULHABER公司生產(chǎn)的直流電機FAULHBER3863型號符合條件。根據(jù)輸出功率方面進行選擇 （5）式中，——工作機阻力，N。在運動控制系統(tǒng)設(shè)計中必須考慮車體載荷。 四輪式果實采摘機器人整體結(jié)構(gòu)示意圖我們首先假想，番茄采摘機器人的環(huán)境是地面整體平坦，具有摩擦系數(shù)適中，地面結(jié)實。機器人整體的機械結(jié)構(gòu)應(yīng)具備以下能力：（1）要具備可靠性，穩(wěn)定性，結(jié)構(gòu)緊湊并且要有適當?shù)墓ぷ鞣秶?。比如，最初的日本研制的番茄采摘機器人采用傳統(tǒng)視覺處理技術(shù)由彩色攝像頭和圖像處理卡組成的視覺系統(tǒng)來尋找和識別成熟果實[16]，而現(xiàn)在番茄采摘機器人，南京農(nóng)業(yè)大學的張瑞合、姬長英等人在番茄采摘中運用雙目立體視覺技術(shù)對紅色番茄進行定位，將圖像進行灰度變換，而后對圖像的二維直方圖進行腐蝕、膨脹以去除小團塊，提取背景區(qū)邊緣，然后用擬合曲線實現(xiàn)彩色圖像的分割，將番茄從背景中分離出來[17]。（2）具有靈活的機械臂和較為輕便柔軟的機械末端，且能夠在工作時避開枝蔓的阻撓。經(jīng)教育部認定，是國內(nèi)第一臺黃瓜采摘機器人，獲得多項國家專利。其內(nèi)置有能夠感應(yīng)色彩的攝像頭，可以準確分辨出草莓和綠葉，利用事先設(shè)定的色彩值，再配合獨特的機械結(jié)構(gòu)，它就可以判斷出草莓的成熟度，并將符合要求的草莓采摘下來，速度達到10s/個[6]。和國內(nèi)相比國外一直處于技術(shù)前沿。 motion control目 錄中文摘要 IABSTRACT II第一章 前言 1 1 1 1 3 4第二章 機械結(jié)構(gòu)的分析與設(shè)計 5 5 6 6 6 7 執(zhí)行器選擇依據(jù) 7 執(zhí)行機構(gòu)電機的介紹 10第三章 運動控制系統(tǒng)硬件部分設(shè)計 12 12 12 12 13 13 14 15 15 17 17 18 報警模塊電路設(shè)計 20 21 21第四章 運動控制系統(tǒng)軟件設(shè)計 24 24 25 25 26 27第五章 系統(tǒng)仿真 28結(jié)束語 30參考文獻 31致謝 33附件 34第一章 前言隨著電子技術(shù)和計算機技術(shù)的發(fā)展,智能機器人已在許多領(lǐng)域得到日益廣泛的應(yīng)用。最后，通過仿真驗證了運動控制系統(tǒng)設(shè)計的準確性，實現(xiàn)了避障功能。 學校代碼： 11059 學 號：0805070014Hefei University 畢業(yè)設(shè)計（論文）BACHELOR DISSERTATION論文題目： 番茄采摘機器人運動控制系統(tǒng)的設(shè)計與實現(xiàn) 學位類別： 工 學 學 士年級專業(yè)（班級）：08級 自動化 （1）班作者姓名： 導師姓名： 完成時間： 2012年 5 月 15 日49番茄采摘機器人運動控制系統(tǒng)的設(shè)計與實現(xiàn)中文摘要本文從機器人機械結(jié)構(gòu)入手，對番茄采摘機器入的運動控制系統(tǒng)進行了研究。關(guān)鍵詞：機械結(jié)構(gòu)；避障；傳感器；運動控制Tomato在農(nóng)業(yè)生產(chǎn)中,由于作業(yè)對象的復雜、多樣,以及當前我國正面臨人口老年化的趨勢[1]，使得新型農(nóng)業(yè)機械——農(nóng)業(yè)機器人的開發(fā)具有巨大經(jīng)濟效益和廣闊的市場前景,符合社會發(fā)展的需求。（1）經(jīng)典的番茄采摘機器人是日本Kondo N等人研制的番茄采摘機器人。（4）韓國的蘋果收獲機器人：韓國慶北大學的科研人員研制出蘋果果采摘機器人，它具有4個自由度，包括3個旋轉(zhuǎn)關(guān)節(jié)和1個移動關(guān)節(jié)。其利用機器人的多傳感器融合功能，對采摘對象進行信息獲取、成熟度判別，并確定采摘對象的空間位置，實現(xiàn)機器人末端執(zhí)行器的控制與操作的智能化系統(tǒng)，能夠?qū)崿F(xiàn)在非結(jié)構(gòu)環(huán)境下的自主導航運動、區(qū)域視野快速搜索、局部視野內(nèi)果實成熟度特征識別及果實空間定位、末端執(zhí)行器控制與操作，最終實現(xiàn)黃瓜果實的采摘收獲[12]。即自由度個數(shù)適中，同時能夠保證采摘的效率。對目標進行標定后，用面積匹配實現(xiàn)共軛圖像中目標的配準。（2）要具備柔性和靈活性都比較好的機械手及末端執(zhí)行器，即機械手具有一定的冗余度。事實證明，一般的智能番茄生產(chǎn)大棚都是一個場地規(guī)劃相對整齊干凈的環(huán)境。（1）后輪的電機選擇我們先假設(shè)車體重量是10千克，可以采摘的果實最大總重量是5千克?！ぷ鳈C的線速度，m／s。（2）前輪的電機選擇前輪的電機采用步進電機，可以使小車轉(zhuǎn)向更加靈活，本設(shè)計中前后輪的電機功率及力矩應(yīng)該相當。單片機算術(shù)運算功能強，軟件編程靈活、自由度大，可用軟件編程實現(xiàn)各種算法和邏輯控制，并且其功耗低、體積小、技術(shù)成熟和成本低等優(yōu)點，使其在各個領(lǐng)域應(yīng)用廣泛。在本電路設(shè)計中，我選擇開關(guān)型穩(wěn)壓電源LM25765作為電壓轉(zhuǎn)換模塊：根據(jù)分析可以知道機器人底盤控制系統(tǒng)正常工作時，需要電源提供不同大小的穩(wěn)壓電壓。小功率直流電動機的轉(zhuǎn)速控制方