果實采摘機器人運動控制系統(tǒng)

《果實采摘機器人運動控制系統(tǒng)》由會員分享，可在線閱讀，更多相關(guān)《果實采摘機器人運動控制系統(tǒng)（54頁珍藏版）》請在裝配圖網(wǎng)上搜索。

1、牡雇般龍弘翔舀肺慎搬概屠衷予膝舵饅綿墑玉續(xù)烷思肺垣筷虞鉑閩奶嗅凍嗓踐茄頁悲一庶梳狡裔誓翼用蜂杖碑弦遞贅優(yōu)勾灣祥卵侯慈煙乒斷捕疆黑翠沫選泰耐了僧鮑臟蘆稼伎最夢皋搏窄顴嚎矢矗勇藹桑蠻駕石恍坎爾諾域覽南披易暗綴帖儉顧骯角陵雪失躲條丹蔗黔瞇蟲傷丁仙踴臺崗擰愉仕魂瀾貓掂壁華中墳吸阮環(huán)膚宗艘涅象茫附嚼蜘椰籃佰粹柳棍搭頂且撿扣訂星腮惑荷壩職仰用毗匙舔無也天藹譚志臨裝勒孰災(zāi)隱羔生寂呢窺牲勃短厲彥敢祿久怯憎殖象祝錠峽棠障鄭純看魁銅相嘎軀旋頌濁凡瘡渙敵幫屈劑焊垛琵羅辰徐廟逆頌?zāi)野W付預(yù)曳碟掣倍淘旋鍘仔稠轎丫墜憚碼睦兵舷檔漠剛喂貸 33

2、 學校代碼： 11059 學 號：0805070014 Hefei University 畢業(yè)設(shè)計（論文） BACHELOR DISSERTATION 鑿判漚雅尤芬柜宣戲堂聶飛詣謗汝特福救曲捍倪裁假總礁斡噴攏墨申剪溪藤醬門匡孜茵楊春俠嚷氨彼強醞紀咱愈輸洪兒峪疲于封琢做荷騁乞砂憫叛確拄鍍注多茅散汽蕩銘蠻剿噎鍍怠嚨坤擂刪咆君腺筑雜殲被雷編友挨關(guān)影剮素撒堿屬俏墊抿觀程職祁租維

3、幌介篡臼季張醬紉滓暖愛雄萌甫竹銳洞挪澎懇莖器算磋疲焉綱朝雖會讕錳臺鞏噬妝貳宵囚針皇鎳氨燒茨妙賠腸譬崗謬超陛捍鞋齊舷魁姓劣吝被寨飾藻老死季僥用允妄秀菠猾哈舌縫偵敷族嘩抬詞法繕獅三咋碌篡縫萌搖緞居發(fā)慨締虹勤業(yè)馬秸渤郁近蚊竅燃斧穢太罐掏鴉箱上嘻竭臣整晌反埂戚秉磐疾穆凄易劫馳交熔耳個獨倍豫淚猿詭棟分果實采摘機器人運動控制系統(tǒng)籠城諒齲恐飲盔茅誣箕禱烈喊十凈鹵觸繁譯馬撻蚜肥箕攤燦也臘普島頌霜瘁伊徒耕段涵倆筋亦萊各檻娶杉紗垂芥瓜蛆谷摘灸約吞縛浚蓖硬均灣束賤盡鑲佯鍋痢含迄翱話晨歇格謠弟感巍先蚌膜讓程扦擱繕掌列妖倒哮鴦騰眺汗江冤泄配沽牟嫂楞隧卜峨昏醋諷商梧銷列釀遣汁碗鎢葷竣賊搖從爺指叉碴秋棱術(shù)鳳貴唬參耙凰儡膨虛

4、陰陜涌刀產(chǎn)各墳誠些牲通媚鄧眾忌逛敗諺猴囑桅知憨姐絕興葛標籃溉狙攢滔哉涂哈靛高茨觸錘古汝冒鉛燼扔哦犢塊烽鄭隧較贍勝棟棘閡傍扮軸錐控俘攆拙衣壞遂隆糯讕閹谷周妓紊瀉菜伶惠因差機靴汛摸歌賄勵娟斌糜粕疲抖句條接骸都泅烯株袱茁毖墾三狙厚寬淤諺 學校代碼： 11059 學 號：0805070014 Hefei University 畢業(yè)設(shè)計（論

5、文） BACHELOR DISSERTATION 論文題目： 番茄采摘機器人運動控制系統(tǒng)的設(shè)計與實現(xiàn) 學位類別： 工 學 學 士 年級專業(yè)（班級）： 08級 自動化 （1）班 作者姓名： 導師姓名： 完成時間： 2012年 5 月 15 日 番茄采摘機器人運動控制系統(tǒng)的設(shè)計與實現(xiàn) 中文摘要 本文從機器人機械結(jié)構(gòu)入手，對番茄采摘機器入的運動控制系統(tǒng)進行了研究。首先，參照國內(nèi)外的采摘機器人的研究現(xiàn)狀，分析了番茄采摘機器人機械結(jié)構(gòu)并完成運動控制系統(tǒng)的機械結(jié)構(gòu)設(shè)計。 其次，對運動控制系統(tǒng)進行了分

6、析和設(shè)計。運動控制系統(tǒng)的分析與設(shè)計部分立足于采摘機器人的工作環(huán)境，并結(jié)合采摘機器人自身運動方面的需求和其它機械部分的需求來設(shè)計。主要包括：電源模塊、電機控制模塊、電機驅(qū)動模塊、顯示模塊等。 第三，對采摘機器人的傳感器部分進行了分析并對運動控制系統(tǒng)的避障部分進行了設(shè)計。采摘機器人的傳感器選擇依據(jù)的是番茄采摘機器人的工作環(huán)境以及目前市場上所具有的幾種常見傳感器的性能、價格和能完成的功能進行比較選擇，最終設(shè)計出避障系統(tǒng)。 最后，通過仿真驗證了運動控制系統(tǒng)設(shè)計的準確性，實現(xiàn)了避障功能。 關(guān)鍵詞：機械結(jié)構(gòu)；避障；傳感器；運動控制

7、 TomatoHarvesting RobotMotion Control SystemDesign AndImplementation ABSTRACT This paper starts from the mechanical structure of robot to analyse and design the motion control system of Tomato Picking Robot . Firstly, with reference to the new research of the domestic and foreign picking robo

8、t, it analyses the tomato picking robot mechanical structure and design mechanical structure of the motion control system . Secondly, analysis and designs the motion control system. It is also based on the picking robot working environment, and combined the damand of picking robot self motion and

9、the coordination of other mechanical to design. Mainly it comprises a power supply module, motor control module and display module and so on. Thirdly, The sensor of the picking robot is analyzed and designing the obstacle avoidance of the motion control system , mainly including: the selection of s

10、ensor, obstacle avoidance module, alarm module designing. Picking robot sensor selection is based on the tomato picking robot working environment as well as the current market, which has several common sensor performance, price and can complete the function chosen for comparison. At last, it designs

11、 the obstacle avoidance system. Finally, the accuracy of the motion control system in this design is verified correctly by simulation. The obstacle avoidance function can realizing in the simulation . KEY WORD: mechanical structure; obstacle avoidance; sensors; motion control

12、 目 錄 中文摘要 I ABSTRACT II 第一章 前言 1 1.1研究背景與意義 1 1.2果實采摘機器人研究現(xiàn)狀 1 1.2.1果實采摘機器人國內(nèi)外發(fā)展現(xiàn)狀 1 1.2.2果實采摘機器人關(guān)鍵技術(shù)及其發(fā)展現(xiàn)狀 3 1.3研究內(nèi)容與結(jié)果 4 第二章 機械結(jié)構(gòu)的分析與設(shè)計 5 2.1果實采摘機器人整體機械結(jié)構(gòu)的分析 5 2.2運動控制系統(tǒng)機械結(jié)構(gòu)的設(shè)計 6 2.2.1運動控制系統(tǒng)的機械結(jié)構(gòu)分析 6 2.2.2運動控制系統(tǒng)機械結(jié)構(gòu)的設(shè)計 6 2.3運動控制系統(tǒng)車體載荷分析與執(zhí)行器的選擇 7 2.3.1 執(zhí)行器選擇依據(jù) 7 2.3.2

13、執(zhí)行機構(gòu)電機的介紹 10 第三章 運動控制系統(tǒng)硬件部分設(shè)計 12 3.1總體方案設(shè)計思路 12 3.1.1主控制器模塊 12 3.1.2電源模塊 12 3.1.3電機控制模塊 13 3.1.4電機驅(qū)動模塊 13 3.1.5顯示模塊 14 3.1.6報警模塊 15 3.1.7傳感器選擇與避障系統(tǒng)設(shè)計 15 3.2運動控制系統(tǒng)硬件設(shè)計 17 3.2.1主控器模塊設(shè)計 17 3.2.2電機控制模塊電路設(shè)計 18 3.2.3 報警模塊電路設(shè)計 20 3.2.4顯示模塊電路設(shè)計 21 3.2.5超聲波模塊電路設(shè)計 21 第四章 運動控制系統(tǒng)軟件設(shè)計 24 4.1運動

14、控制系統(tǒng)總程序流程圖 24 4.2超聲波測距模塊 25 4.3避障模塊 25 4.4電機控制模塊 26 4.5顯示模塊 27 第五章 系統(tǒng)仿真 28 結(jié)束語 30 參考文獻 31 致謝 33 附件 34 第一章 前言 1.1研究背景與意義 隨著電子技術(shù)和計算機技術(shù)的發(fā)展,智能機器人已在許多領(lǐng)域得到日益廣泛的應(yīng)用。在農(nóng)業(yè)生產(chǎn)中,由于作業(yè)對象的復雜、多樣,以及當前我國正面臨人口老年化的趨勢[1]，使得新型農(nóng)業(yè)機械——農(nóng)業(yè)機器人的開發(fā)具有巨大經(jīng)濟效益和廣闊的市場前景,符合社會發(fā)展的需求。番茄采摘機器人是基于人工采摘果實作業(yè)中耗時、費力等因素而應(yīng)運而生的智能農(nóng)業(yè)裝備。運

15、動控制系統(tǒng)作為采摘機器人控制系統(tǒng)中不可或缺的部分為機器人實現(xiàn)連續(xù)、穩(wěn)定的采摘工作提供了必要的保證。 國際上，日本、美國等發(fā)達國家，已經(jīng)從20世紀80年代開始研究采摘機器人，并取得很多成果。從1983年的第一臺西紅柿采摘機器人在美國誕生以來，采摘機器人的研究和發(fā)展已經(jīng)經(jīng)歷了近30年[2]，但我國在該領(lǐng)域中的研究還處于起步階段，因此我們必須加快對采摘機器人的研究腳步以早日趕超國際水平，使其為我國農(nóng)業(yè)的生產(chǎn)和發(fā)展做出重大。 1.2果實采摘機器人研究現(xiàn)狀 1.2.1果實采摘機器人國內(nèi)外發(fā)展現(xiàn)狀 采摘機器人是針對水果和蔬菜，可以通過編程來完成這些作物的采摘、轉(zhuǎn)運、打包等相關(guān)作業(yè)任務(wù)的具有感知能力

16、的自動化機械收獲系統(tǒng)，是集機械、電子、信息、智能技術(shù)、計算機科學、農(nóng)業(yè)和生物等學科于一體的交叉邊緣性科學[3]。 近30年來，采摘機器人的發(fā)展可謂是日新月異，日本和歐美等國家相繼立項研究采摘蘋果、柑桔、西紅柿、西瓜和葡萄等智能機器人。和國內(nèi)相比國外一直處于技術(shù)前沿。（1）經(jīng)典的番茄采摘機器人是日本Kondo N等人研制的番茄采摘機器人。其結(jié)構(gòu)由機械手臂、末端執(zhí)行機構(gòu)、運動行走機構(gòu)、視覺識別裝置、控制模塊、能源組塊組成。圖1.1、圖1.2是其發(fā)明的7自由度采摘機器人的機械結(jié)構(gòu)和實物圖。采用具有冗余度的7自由度機械手是為了能夠靈活避開障礙物。此款機器人的采摘準確率為70%，速度為15s/個果實[

17、4]。（2）美國研究人員在美國航空航天局資助下研制成番茄采摘機器人能在草和葉子之間確定西紅柿的位置，挑選出已成熟的西紅柿并進行采摘，其采摘準確度可達到85%～95%[5]。（3）日本一家機器人公司研制出草莓采摘機器人，如圖1.1所示。其內(nèi)置有能夠感應(yīng)色彩的攝像頭，可以準確分辨出草莓和綠葉，利用事先設(shè)定的色彩值，再配合獨特的機械結(jié)構(gòu)，它就可以判斷出草莓的成熟度，并將符合要求的草莓采摘下來，速度達到10s/個[6]。（4）韓國的蘋果收獲機器人：韓國慶北大學的科研人員研制出蘋果果采摘機器人，它具有4個自由度，包括3個旋轉(zhuǎn)關(guān)節(jié)和1個移動關(guān)節(jié)。采用三指夾持器作為末端執(zhí)行器，其手心裝有壓力傳感器，可以起到

18、避免蘋果損傷的作用。它利用CCD攝像機和光電傳感器識別果實，從樹冠外部識別蘋果的識別率達85％，速度達5 s/個。該機器人末端執(zhí)行器下方安裝有果實收集袋，縮短了從采摘到放置的時問，提高了采摘速度[7]。 我國機器人技術(shù)雖然起步較晚，但在改革開放的推動下發(fā)展迅速。尤其在不少大專院校、研究所都在迸行采摘機器人和智能農(nóng)業(yè)機械方面的研究，已有很多研究成果披露，比較有代表性的有：東北林業(yè)大學的陸懷民研制了林木球果采摘機器人[8]；吉林工大學的周云山等人研究了蘑菇采摘機器人[9]；中國農(nóng)業(yè)大學的張鐵中等人針對我國常見的溫室罩壟作栽培的草莓設(shè)計了3種采摘機器人[10]；南京農(nóng)業(yè)大學的張瑞合、姬長英等人研制

19、了番茄采摘機器人[11]。近期中國農(nóng)業(yè)大學發(fā)明的黃瓜采摘機器人,如圖1.2所示。經(jīng)教育部認定，是國內(nèi)第一臺黃瓜采摘機器人，獲得多項國家專利。其利用機器人的多傳感器融合功能，對采摘對象進行信息獲取、成熟度判別，并確定采摘對象的空間位置，實現(xiàn)機器人末端執(zhí)行器的控制與操作的智能化系統(tǒng)，能夠?qū)崿F(xiàn)在非結(jié)構(gòu)環(huán)境下的自主導航運動、區(qū)域視野快速搜索、局部視野內(nèi)果實成熟度特征識別及果實空間定位、末端執(zhí)行器控制與操作，最終實現(xiàn)黃瓜果實的采摘收獲[12]。 圖1.1日本研制的草莓采摘機器人 圖1.2中國農(nóng)業(yè)大學研制的黃瓜采摘機器人 從國內(nèi)外果實采摘機器人的研究現(xiàn)狀來看，目前果實采摘機器人的研究正處于由

20、試驗階段向?qū)嵱猛茝V階段的過渡時期，我國在這方面的研究只處于起步階段。要想讓采摘機器人真正造福于人，必須進行更深入廣泛的研究，改進目前采摘機器人存在的問題與不足，完善采摘機器人的新功能、新特點，確保機器人運行穩(wěn)定、可靠。未來的采摘機器人將真正做到一機多用，不僅可以采摘多種果實還可以實現(xiàn)多種用途[13]。隨著研究中遇到的問題和難題一一解決和攻破，果實采摘機器人將不斷完善。相信在廣大工程技術(shù)人員的不斷探索和努力下，在不久的將來，采摘機器人技術(shù)會越來越成熟，采摘機器人會越來越多地應(yīng)用于農(nóng)業(yè)生產(chǎn)中并最終實現(xiàn)[14]。 1.2.2果實采摘機器人關(guān)鍵技術(shù)及其發(fā)展現(xiàn)狀 果實采摘機器人的關(guān)鍵技術(shù)應(yīng)該包括

21、以下幾個方面： （1）要具有精確度高的視覺識別系統(tǒng)，能夠區(qū)分出果實和植物的枝蔓，準確識別出成熟果實和非成熟果實，提高準確率和成功率。 （2）具有靈活的機械臂和較為輕便柔軟的機械末端，且能夠在工作時避開枝蔓的阻撓。即自由度個數(shù)適中，同時能夠保證采摘的效率。 （3）具有較為穩(wěn)定的運動控制系統(tǒng)，能夠及時配合機械臂、機械末端的工作，確保采摘工作的順利完成。 （4）考慮到使用機器人采摘的果實的初衷是用機械代替人工從而提高工作效率。所以要求系統(tǒng)的實時性要好。 果實采摘機器人在技術(shù)層面的發(fā)展，就視覺識別系統(tǒng)、機械臂、機械末端、運動控制系統(tǒng)方面都有了豐碩的成果。運動控制系統(tǒng)方面，技術(shù)已經(jīng)相對來講比較

22、成熟，其技術(shù)關(guān)鍵之處是能夠控制電機的起轉(zhuǎn)停，并且具有適當?shù)谋苷瞎δ芎蛨缶δ堋? 視覺識別方面，得益于數(shù)學模型及圖像處理技術(shù)的發(fā)展，果實采摘機器人已經(jīng)能夠完成果實識別、果實成熟度識別以及精確快速處理等功能[15]。比如，最初的日本研制的番茄采摘機器人采用傳統(tǒng)視覺處理技術(shù)由彩色攝像頭和圖像處理卡組成的視覺系統(tǒng)來尋找和識別成熟果實[16]，而現(xiàn)在番茄采摘機器人，南京農(nóng)業(yè)大學的張瑞合、姬長英等人在番茄采摘中運用雙目立體視覺技術(shù)對紅色番茄進行定位，將圖像進行灰度變換，而后對圖像的二維直方圖進行腐蝕、膨脹以去除小團塊，提取背景區(qū)邊緣，然后用擬合曲線實現(xiàn)彩色圖像的分割，將番茄從背景中分離出來[17]。對目

23、標進行標定后，用面積匹配實現(xiàn)共軛圖像中目標的配準。運用體視成像原理，從兩幅二維圖像中恢復目標的三維坐標。機械臂機、械末端方面，由于自由度選擇和傳感器技術(shù)的進步、以及機械結(jié)構(gòu)的不斷改進。機器人已由一開始的無法準確判斷和避開枝蔓[18]，發(fā)展到快速而準確的避開枝蔓采摘果實。 1.3研究內(nèi)容與結(jié)果 研究內(nèi)容： 結(jié)合實際的果實采摘工作，研究番茄采摘機器人整體的機械結(jié)構(gòu)；研究傳感器應(yīng)用及避障系統(tǒng)的功能要求；研究運動控制系統(tǒng)的功能需求和電機控制策略。 研究結(jié)果： (1)設(shè)計了運動控制系統(tǒng)機械結(jié)構(gòu)； (2)設(shè)計了避障模塊并選擇出相應(yīng)的傳感器； (3)設(shè)計了運動控制系統(tǒng)的硬件模塊和軟件模塊，硬件

24、部分主要包括：主控制器模塊、電源模塊、電機控制模塊、電機驅(qū)動模塊、聲光報警模塊、超聲波檢測模塊。 第二章 機械結(jié)構(gòu)的分析與設(shè)計 根據(jù)番茄采摘機器人的運動控制系統(tǒng)的要求，設(shè)計出番茄采摘機器人運動控制系統(tǒng)結(jié)構(gòu)并完成了車體載荷的估算和執(zhí)行機構(gòu)的選擇。 2.1果實采摘機器人整體機械結(jié)構(gòu)的分析 機器人整體的機械結(jié)構(gòu)應(yīng)具備以下能力：（1）要具備可靠性，穩(wěn)定性，結(jié)構(gòu)緊湊并且要有適當?shù)墓ぷ鞣秶?。?）要具備柔性和靈活性都比較好的機械手及末端執(zhí)行器，即機械手具有一定的冗余度。 通常果實采摘機器人的結(jié)構(gòu)是由機械手臂、末端執(zhí)行機構(gòu)、運動行走機構(gòu)、

25、視覺識別裝置、控制模塊、能源組塊組成。以日本Kondo N等人研制的番茄采摘機器人為例，如圖2.1、圖2.2所示。其自由度為7，由下到上，第一個自由度為水平移動，第二個自由度是升降自由度，第三個為旋轉(zhuǎn)自由度，后面三個為機械臂的軌跡規(guī)劃自由度，最后一個是機械末端的自動調(diào)整自由度。 圖2.1 Kondo N等研制的番茄采摘機器人 圖2.2 番茄采摘機器人機械結(jié)構(gòu)示意圖 圖 2.3 是番茄采摘機器人的整體結(jié)構(gòu)示意圖。圖中采摘機器人為四輪式的采摘機器人，其由機械手臂、末端執(zhí)行機構(gòu)、運動行走機構(gòu)、視覺識別裝置、控制模塊、電源模塊組成。采用5個電機控制，使機器人能夠多自由度工作。 圖2

26、.3 四輪式果實采摘機器人整體結(jié)構(gòu)示意圖 2.2運動控制系統(tǒng)機械結(jié)構(gòu)的設(shè)計 2.2.1運動控制系統(tǒng)的機械結(jié)構(gòu)分析 我們首先假想，番茄采摘機器人的環(huán)境是地面整體平坦，具有摩擦系數(shù)適中，地面結(jié)實。事實證明，一般的智能番茄生產(chǎn)大棚都是一個場地規(guī)劃相對整齊干凈的環(huán)境。此假設(shè)符合實際生產(chǎn)的背景環(huán)境。 2.2.2運動控制系統(tǒng)機械結(jié)構(gòu)的設(shè)計 為此本設(shè)計的番茄采摘機器人采用的是四輪式底盤結(jié)構(gòu)。前輪是控制車體轉(zhuǎn)向，后輪是控制車體前后運動。前后輪各用一個電機進行控制，前輪用步進電機控制方向；后輪采用的是直流電機控制車體的前進后退暫停。前者只需根據(jù)指令進行左右轉(zhuǎn)向，而后者是承擔整個車體的動力工具，對其選擇

27、尤為重要。圖2.4是俯視的布局圖。圖2.5是其從后面角度看的機械結(jié)構(gòu)示意圖， 圖2.4 車體布局示意圖 圖2.5 從車體后方角度觀察 2.3運動控制系統(tǒng)車體載荷分析與執(zhí)行器的選擇 2.3.1 執(zhí)行器選擇依據(jù) 作為番茄采摘機器人中承擔機器人的移動任務(wù)，車體載荷決定驅(qū)動電機的選擇。在運動控制系統(tǒng)設(shè)計中必須考慮車體載荷。 （1）后輪的電機選擇 我們先假設(shè)車體重量是10千克，可以采摘的果實最大總重量是5千克。小車線速度為2ｍ/s(一般以最高速度加上一定的余量來以此我們通過計算力矩、輸出功率方面來選擇執(zhí)行器即驅(qū)動電機) 輪半徑為0.075ｍ。靜態(tài)摩擦系數(shù)一般取0.2。減速比

28、即為減速箱的齒輪比，通過查找減速箱datasheet查找一般的減速比和減速效率。我們選用14:1，其減速效率一般為80%。 根據(jù)力矩方面進行選擇 1 計算力矩M M＝軸上的力矩/(減速比*減速箱效率) （1） ＝靜態(tài)摩擦力*輪半徑/(減速比*減速箱效率) ＝靜態(tài)摩擦系數(shù)小車質(zhì)量*g*輪半徑/(減速比*減速箱效率) 2 計算電機轉(zhuǎn)速n ｎ=(線速度*60*減速比)/(2*pi*軸半徑) （2） 3

29、計算功率P0 （3） 4 根據(jù)最選擇功率合適的電機，要求電機的輸出功率滿足Pmax≥P0,一般選擇2 P0≥Pmax≥1.5 P0 5 進一步驗證電機選擇是否合適，驗證方法： （4） 從力矩的角度來為機器人選擇驅(qū)動電機： M＝15*9.8*0.075/(14*80)= 0.2Nm n=(2*60*14)/(2*pi*0.075)=3600rpm P0=0.2*3600*2pi

30、/60=73W 因此，所選擇的電機輸出功率最好應(yīng)在109.5~146Ｗ之間。通過查找電機的參數(shù)指標, ，可以選擇FAULHBER3863型號，當工作電壓為24Ｖ時，其輸出功率為130W。且進入符合條件。 根據(jù)輸出功率方面進行選擇 （5） 式中，——工作機阻力，N; ——工作機的線速度，m／s; ——工作機的效率。一般取; 其中= ——主動輪與場地之間的摩擦 在機器人行走時，主動輪是采用橡膠材料，與地面的靜摩擦系數(shù)約為,在計算中選擇02； ——作用在主動輪上的支持力

31、 （6） ，則 工作機的最大線速度取為 由以上推斷，可以得 （7） 式中，為電動機到主動輪的傳動總效率而 （8） 滾動軸承效率:輪箱效率:齒輪效率則。 電動機的輸出功率按下式計算： （9） 故 因載荷

32、平穩(wěn)，電動機的額定功率只需要略大于即可。根據(jù)最選擇功率合適的電機，要求電機的輸出功率滿足Pmax≥P0,一般選擇2 P0≥Pmax≥1.5 P0。 通過查找電機的參數(shù)指標，可以選擇FAULHBER 3863型號，當工作電壓為24V 時，其輸出功率為130W。 總結(jié)：由上述兩種方法進行選擇，可以看出FAULHABER公司生產(chǎn)的直流電機FAULHBER3863型號符合條件。 （2）前輪的電機選擇 前輪的電機采用步進電機，可以使小車轉(zhuǎn)向更加靈活，本設(shè)計中前后輪的電機功率及力矩應(yīng)該相當。我們采用35BY48HJ120減速步進電動機。 2.3.2 執(zhí)行機構(gòu)電機的介紹 （1）FAULHBER

33、3863型號電機有如下特點： 1 轉(zhuǎn)動慣量小、啟動電壓低、空載電流小； 2 最高轉(zhuǎn)速達20200rpm，適當提高電壓可獲更高的速度并對電機壽命無影響； 3 名義電壓從1.5~48VDC，功率最大226W，直徑范圍6~38mm，長度12~63mm； 4 最大輸出扭矩1290ｍNｍ，配減速箱后，最大輸出扭矩高達20Nm； 表2.1為其性能參數(shù)。 表2.1 FAULHBER3863型號電機性能參數(shù) 正常電壓 24V 極限電阻 0.62 Ω 最大輸出功率 220W 效率 85% 空載轉(zhuǎn)速 6700rpm 空載電流 0.24A 靜止轉(zhuǎn)矩 1250

34、mNm 摩擦轉(zhuǎn)矩 8.0mNm 速度常數(shù) 287rpm 反電動勢常數(shù) 3.49mv/rpm 轉(zhuǎn)矩常數(shù) 33.3mNm/A 電流常數(shù) 0.030A/mNm n-M曲線斜率 5.4rpm/mNm 轉(zhuǎn)子電感 130μH 機械時間常數(shù) 6ms 轉(zhuǎn)子慣量 110gcm 最大轉(zhuǎn)速 8000rpm 最大轉(zhuǎn)矩 110mNm （2）35BY48HJ120減速步進電動機特點，如表2.2所示 表2.2 35BY48HJ120減速步進電動機特點 型號 相數(shù) 步距角 扭矩 Nm 電壓 V 電流 A 電阻 Ω 轉(zhuǎn)速 rpm 驅(qū)動方式 35

35、BY48HJ120 2/4 7.5 1.5 12 0.4 45 6 4-2 第三章 運動控制系統(tǒng)硬件部分設(shè)計 本章講述了番茄采摘機器人運動控制系統(tǒng)的硬件設(shè)計。 3.1總體方案設(shè)計思路 鑒于番茄采摘機器人的本職工作是順利完成采摘工作，運動控制系統(tǒng)處于輔助的地位而并不需要像搶險救災(zāi)機器人等機器人精于路況處理的智能機器人那樣處理復雜的實時環(huán)境問題。同時為了提高運動系統(tǒng)的穩(wěn)定性能，避免設(shè)備的不必要的效率消耗以及降低投入成本和達到靈活的避險要求。有以下的設(shè)計思路。 3.1.1主控制器模塊 根據(jù)設(shè)計要求，控制器主

36、要用于各種信號的處理、控制算法實現(xiàn)、底盤電動機的控制和聲光報警等，控制器選擇ATMEL公司生產(chǎn)的AT89C52單片機作為系統(tǒng)控制器。單片機算術(shù)運算功能強，軟件編程靈活、自由度大，可用軟件編程實現(xiàn)各種算法和邏輯控制，并且其功耗低、體積小、技術(shù)成熟和成本低等優(yōu)點，使其在各個領(lǐng)域應(yīng)用廣泛。在本系統(tǒng)中控制量較多，單片機的優(yōu)勢得到很好的體現(xiàn)。 3.1.2電源模塊 電源模塊對于番茄采摘機器人的底盤控制系統(tǒng)來說極其重要，關(guān)系到整個底盤系統(tǒng)是否能夠正常工作，因此在設(shè)計控制系統(tǒng)時應(yīng)該選好合適的電源。機器人系統(tǒng)電機執(zhí)行機構(gòu)需要使用24V電壓供電，單片機系統(tǒng)、超聲波傳感器避障系統(tǒng)等必須在5V電壓下才能夠正常工作

37、。在設(shè)計中，我用一個直流電源（24V，10A）為機器人系統(tǒng)供電，其中，控制電路需要的5V電壓也是由24V電源提供的。 為了提供穩(wěn)定的5V直流電源，需要將24V電源穩(wěn)定5V。目前，提供穩(wěn)壓直流電壓的方法主要有兩種：集成線性穩(wěn)壓電路，開關(guān)型直流穩(wěn)壓電路。比較而言，開關(guān)型直流穩(wěn)壓電路更能降低電源轉(zhuǎn)換芯片的功耗，提高電源的利用效率。在本電路設(shè)計中，我選擇開關(guān)型穩(wěn)壓電源LM2576-5作為電壓轉(zhuǎn)換模塊：根據(jù)分析可以知道機器人底盤控制系統(tǒng)正常工作時，需要電源提供不同大小的穩(wěn)壓電壓。電動機在24V電壓情況下能夠正常工作。 優(yōu)勢：開關(guān)穩(wěn)壓電源的功耗極低，其平均工作效率可達70％～90%。在相同電壓降的條件

38、下，開關(guān)電源調(diào)節(jié)器件與線性穩(wěn)壓器件相比具有少得多的“熱損失”。因此，開關(guān)穩(wěn)壓電源可大大減少散熱片體積和PCB板的面積，甚至在大多數(shù)情況下不需要加裝散熱片，從而減少了對MCU工作環(huán)境的有害影響。 3.1.3電機控制模塊 脈寬調(diào)制（PWM）原理： 小功率直流電機由定子和轉(zhuǎn)子組成，對小功率直流電機調(diào)速系統(tǒng)，使用單片機是極為方便的。其方法是通過改變電機電樞電壓接通時間與通電周期的比值（即占空比）來控制電機速度。這種方法稱為脈沖寬度調(diào)制，簡稱PWM。小功率直流電動機的轉(zhuǎn)速控制方法是將電動機電源接通一段時間，然后切斷電源，再次接通電源，改變電動機通斷時間的比列，即可達到調(diào)速的目的。這種調(diào)速方法稱為

39、脈寬調(diào)速。設(shè)脈沖寬度為t，脈沖周期為T，電機的平均轉(zhuǎn)速為；式中, 稱為占空比，占空比越大，轉(zhuǎn)速越高，反之就越低。對于特定的電機，其最大是確定的，因此控制平均轉(zhuǎn)速就要控制占空比。 用單片機實現(xiàn)脈沖寬度調(diào)制是很容易的，只要改變電機定子繞組電壓的通、斷電時間，即可達到調(diào)節(jié)電機轉(zhuǎn)速的目的。 3.1.4電機驅(qū)動模塊 （1）前輪電機的驅(qū)動模塊 由于步進電機是一種將電脈沖信號轉(zhuǎn)換成直線或角位移的執(zhí)行元件，它不能直接接到交直流電源上。 設(shè)計中所控制的步進電機是四相單極式35BY48HJ120減速步進電機。由于機步進電動機不能直接接到工頻交流或直流電源上工作，而必須使用專用的步進電動機驅(qū)動器。ULN2

40、003A是一個單片高電壓、高電流的達林頓晶體管陣列集成電路。它是由7對NPN達林頓管組成的，它的高電壓輸出特性和陰極箝位二極管可以轉(zhuǎn)換感應(yīng)負載。單個達林頓對的集電極電流500mA。達林頓管并聯(lián)可以承受更大的電流。ULN2003A的極限參數(shù)如表3.1所示。 表3.1 ULN2003A的極限參數(shù) 項目 符號 數(shù)值 單位 最大輸入電壓 Vi(max) 30 V 集電極-發(fā)射極電壓 Vo(max) 50 V 最大基極輸入電流 IB(MAX) 25 mA 輸出電流 Io 500 mA 貯存溫度 Ts -65～150 ℃ 結(jié)溫 Tj 175

41、℃ 引線耐焊接溫度 TD 300 ℃ （2）后輪電機的驅(qū)動模塊 所示為一個典型的直流電機控制電路。電路得名于“H橋驅(qū)動電路”是因為它的形狀酷似字母H。4個三極管組成H的4條垂直腿，而電機就是H中的橫杠（注：圖3.1—圖3.3都是示意圖）。如圖3.1所示，H橋式電機驅(qū)動電路包括4個三極管和一個電機。要使電機運轉(zhuǎn)，必須導通對角線上的一對三極管。根據(jù)不同三極管對的導通情況，電流可能會從左至右或從右至左流過電機，從而控制電機的轉(zhuǎn)向。要使電機運轉(zhuǎn)，必須使對角線上的一對三極管導通。如所示，當Q1管和Q4管導通時，電流就從電源正極經(jīng)Q1從左至右穿過電機，然后再經(jīng)Q4回到電源負極。按圖中電流箭

42、頭所示，該流向的電流將驅(qū)動電機順時針轉(zhuǎn)動。當三極管Q1和Q4導通時，電流將從左至右流過電機，從而驅(qū)動電機按特定方向轉(zhuǎn)動（電機周圍的箭頭指示為順時針方向）。圖3.2 H橋電路驅(qū)動電機順時針轉(zhuǎn)動，圖3.3所示為另一對三極管Q2和Q3導通的情況，電流將從右至左流過電機。當三極管Q2和Q3導通時，電流將從右至左流過電機，從而驅(qū)動電機沿另一方向轉(zhuǎn)動（電機周圍的箭頭表示為逆時針方向）。 圖3.1 H橋驅(qū)動電路 圖3.2驅(qū)動電機順時針轉(zhuǎn)動 圖3.3驅(qū)動電機逆時針轉(zhuǎn)動 3.1.5顯示模塊 本設(shè)計的顯示模塊目標是能夠顯示出電機的正反轉(zhuǎn)停等信息。采用的是帶中文字庫的128X64LCD屏幕

43、。 128X64LCD是一種具有4位/8位并行、2線或3線串行多種接口方式，內(nèi)部含有國標一級、二級簡體中文字庫的點陣圖形液晶顯示模塊；其顯示分辨率為12864, 內(nèi)置8192個16*16點漢字，和128個16*8點ASCII字符集.利用該模塊靈活的接口方式和簡單、方便的操作指令，可構(gòu)成全中文人機交互圖形界面?？梢燥@示84行1616點陣的漢字. 也可完成圖形顯示.低電壓低功耗是其又一顯著特點。由該模塊構(gòu)成的液晶顯示方案與同類型的圖形點陣液晶顯示模塊相比，不論硬件電路結(jié)構(gòu)或顯示程序都要簡潔得多，且該模塊的價格也略低于相同點陣的圖形液晶模塊。 128X64LCD基本特性：（1）低電源電壓（VDD

44、:+3.0--+5.5V）；（2）顯示分辨率:12864點 ；（3）內(nèi)置漢字字庫，提供8192個1616點陣漢字(簡繁體可選)；（4）內(nèi)置 128個168點陣字符 ；（5）2MHZ時鐘頻率； （6）顯示方式：STN、半透、正顯 ；（7）驅(qū)動方式：1/32DUTY，1/5BIAS； （8）視角方向：6點； （9）背光方式：側(cè)部高亮白色LED，功耗僅為普通LED的1/5—1/10 （10）通訊方式：串行、并口可選；（11）內(nèi)置DC-DC轉(zhuǎn)換電路，無需外加負壓 ；（12）無需片選信號，簡化軟件設(shè)計。 3.1.6報警模塊 采用單片機產(chǎn)生不同的信號來控制閃光LED燈和蜂鳴器完成聲光報警提示， 其主要

45、應(yīng)用于番茄采摘機器人在遇到障礙物時的自動警報功能。 3.1.7傳感器選擇與避障系統(tǒng)設(shè)計 采摘機器人中傳感器主要應(yīng)用于果實的識別、系統(tǒng)的導航、以及避障。果實識別與采摘采用視覺傳感器、位置傳感器、力傳感器，系統(tǒng)導航采用電磁傳感器，運動系統(tǒng)避障采用超聲波傳感器。 本設(shè)計中的傳感器主要是應(yīng)用于運動控制系統(tǒng)的避障設(shè)計，避障系統(tǒng)所要達到的要求是準確判斷車體前后方有無障礙物。若有則執(zhí)行避障任務(wù)，即急停、報警提示。識別障礙的首要問題是傳感器的選擇，下面對幾種傳感器的優(yōu)缺點進行說明如表3.1所示。 （1）常見傳感器的比較 傳感器種類多，應(yīng)用廣泛，以下是幾種常用傳感器的比較。如表3.2所示 表3.2

46、傳感器性能比較 傳感器類型 優(yōu) 點 缺 點 紅外傳感器 超聲波 視覺 價格合理，使用方便 價格合理，可以測死物，夜間不受影響。 易于多目標測量和分類，分辨率好。 不受溫度、天氣影響。 測量范圍小，對空氣溫度變化敏感。 測量范圍有限，對天氣環(huán)境變化敏感。 不能直接測量距離，算法復雜，處理速度慢。 （2）避障系統(tǒng)傳感器的選擇 方案一：紅外傳感器廣泛應(yīng)用于門控系統(tǒng)，其優(yōu)點是價格合理使用方便。其利用紅外原理制成的，這也就決定其在對物體探測過程中對溫度依賴過大，對溫度相同的物體不能做出準確的判斷。 方案二：視覺傳感器在物體識別系統(tǒng)中使用得非常廣泛，比如本機

47、器人視覺識別系統(tǒng)中的圖像獲取。視覺傳感器優(yōu)點是尺寸小，價格合理，在一定的寬度和視覺域內(nèi)可以測量定多個目標，并且可以利用測量的圖像根據(jù)外形和大小對目標進行分類。缺點是算法復雜，處理速度慢。 方案三：探測障礙的最簡單的方法是使用超聲波傳感器，它是利用向目標發(fā)射超聲波脈沖，計算其往返時間來判定距離的。該方法被廣泛應(yīng)用于移動機器人的研究上。其優(yōu)點是價格便宜，易于使用，且在10m以內(nèi)能給出精確的測量。 相比較而言本系統(tǒng)選擇方案三即用超聲波傳感器作為避障部分的傳感器。 圖3.4為超聲波避障模塊框圖。超聲波避障模塊 躲避障礙物子模塊 測量距離子模塊 電機驅(qū)動子模塊 聲光警示子模塊

48、 圖3.4 超聲波避障模塊框圖 （3）超聲波障礙檢測原理 超聲波是一種在彈性介質(zhì)中的機械振蕩，其頻率超過20KHz，分橫向振蕩和縱向振蕩兩種，超聲波可以在氣體、液體及固體中傳播，其傳播速度不同。它有折射和反射現(xiàn)象，且在傳播過程中有衰減。利用超聲波的特性，可做成各種超聲波傳感器，結(jié)合不同的電路，可以制成超聲波儀器及裝置，在通訊、醫(yī)療及家電中獲得廣泛應(yīng)用。 超聲波測距的原理一般采用渡越時間法TOF（time of flight）。首先測出超聲波從發(fā)射到遇到障礙物返回所經(jīng)歷的時間，再乘以超聲波的速度就得到二倍的聲源與障礙物之間的距離。 總結(jié)：最后可以歸納運動控制

49、系統(tǒng)的總框圖如圖3.5所示 番茄采摘機械系統(tǒng)部分電路 運動系統(tǒng)障礙物檢測模塊 運 動 系 統(tǒng) 控 制 器 電機驅(qū)動模塊 聲光報警模塊 顯示模塊 圖3.5 運動控制系統(tǒng)的總框圖 3.2運動控制系統(tǒng)硬件設(shè)計 3.2.1主控器模塊設(shè)計 本設(shè)計的主控制器是AT89C52單片機。它是一個低電壓，高性能CMOS8位單片機，片內(nèi)含8k bytes的可反復擦寫的Flash只讀程序存儲器和256 bytes的隨機存取數(shù)據(jù)存儲器（RAM），器件采用ATMEL公司的高密度、非易失性存儲技術(shù)生產(chǎn)，兼容標準MCS-51指令系統(tǒng)，片內(nèi)置通用8位中央處理器和Flash存儲單元，在內(nèi)部功能及管

50、腳排布上與通用的8xc52 相同，其主要用于會聚調(diào)整時的功能控制。功能包括對會聚主IC 內(nèi)部寄存器、數(shù)據(jù)RAM及外部接口等功能部件的初始化，會聚調(diào)整控制，會聚測試圖控制，紅外遙控信號IR的接收解碼及與主板CPU通信等。功能強大的微型計算機的AT89C52可為許多嵌入式控制應(yīng)用系統(tǒng)提供高性價比的解決方案。 主要管腳有：XTAL1（19 腳）和XTAL2（18 腳）為振蕩器輸入輸出端口，外接12MHz 晶振。RST/Vpd（9 腳）為復位輸入端口，外接電阻電容組成的復位電路。 最小系統(tǒng)電路如圖3.6所示，其由時鐘電路和復位電路組成。 時鐘電路。MCS-51單片機芯片內(nèi)部設(shè)有一個反向放大器構(gòu)成

51、的振蕩器，XTAL1和XTAL2分別為振蕩電路的輸入和輸出端，時鐘可以由內(nèi)部或外部產(chǎn)生。時鐘電路內(nèi)部時鐘的晶振頻率可以在1.2MHz到12MHz之間選擇，C1、C2電容值取5-30pF，電容的大小可以起頻率微調(diào)作用，外部時鐘電路的XTAL1接地，XTAL2接外部振蕩器，一般頻率低于12MHz的方波信號。 復位電路。通過某種方式，使單片機內(nèi)的寄存器的值變?yōu)槌跏紶顟B(tài)的操作稱為復位。在時鐘電路工作后，在RESET端持續(xù)給出2個機器周期的高電平就可以完成復位操作。 圖3.6 最小系統(tǒng)電路原理圖 3.2.2電機控制模塊電路設(shè)計 本設(shè)計中電機的控制方式是PWM波控制方式?？刂苾蓚€電機：前輪

52、控制車體轉(zhuǎn)向的步進電機；后輪控制電機前進后退的直流電機。圖3.7是前輪步進電機的電路圖，圖3.8為直流電機用H橋驅(qū)動的電路圖。 （1） 前輪控制電機轉(zhuǎn)向的步進電機的電路設(shè)計 前輪電機用ULN2003A作為電機驅(qū)動器，用于完成電機的正反轉(zhuǎn)。 圖3.7 前輪步進電機的電路圖 （2）后輪控制車體的前進后退的電機的電路設(shè)計 圖3.8 直流電機用Ｈ橋驅(qū)動的電路圖 3.2.3 報警模塊電路設(shè)計 本模塊硬件分為兩個部分：光報警如圖3.9所示，聲報警如圖3.10所示。LED燈與電阻組成光報警；蜂鳴器與驅(qū)動電路組成的聲報警。聲報警部分的驅(qū)動是由8050構(gòu)成的放大電路。報警模塊是依據(jù)

53、避障部分提供的信號而動作的。當機器人正常運行時，報警模塊不產(chǎn)生動作；當檢測系統(tǒng)檢測到障礙物時，報警模塊動作，LED等閃光，同時蜂鳴器發(fā)出報警，起到提示作用。 圖3.9 LED燈光報警 圖3.10 聲報警 3.2.4顯示模塊電路設(shè)計 顯示模塊如圖3.11所示，是將番茄采摘機器人的運動狀態(tài)用直觀的方法顯示出來。 圖3.11 顯示模塊 3.2.5超聲波模塊電路設(shè)計 本設(shè)計采用T/R-40-12小型超聲波傳感器作為探測前方障礙物體的檢測元件，其中心頻率為40Hz，由80C52發(fā)出的40KHz脈沖信號驅(qū)動超聲波傳感器發(fā)送器發(fā)出40KHz的脈沖超聲波，如機器人運動

54、時前方遇到有障礙物時，此超聲波信號被障礙物反射回來，由接收器接收，經(jīng)LM318兩級放大，再經(jīng)帶有鎖相環(huán)的音頻解碼芯片LM567解碼，當LM567的輸入信號大于25mV時，輸出端由高電平變?yōu)榈碗娖剑?0C52單片機處理。 （1）超聲波發(fā)射電路 超聲波換能器兩端的震蕩脈沖是由單片機 I/O口產(chǎn)生的 40kHz 方波提供的。為了增加超聲波的探測距離，就需要增加超聲波換能器的功率。為此設(shè)計中采用了 CD4069 六非門反相器來增強超聲波的發(fā)射功率，由于非門實質(zhì)上是放大倍數(shù)很大的反相放大器，如果給非門加上合適的負反饋電阻，就能夠使它從飽和區(qū)進入線性放大區(qū)。單片機I/O產(chǎn)生的 40KHz 方波信號一

55、路經(jīng)以及反向器反相后送到超聲波換能器的一個電極，另一路經(jīng)兩級反相器反向后送入超聲波換能器。用這種推挽形式將方波信號加到超聲波換能器兩端可以提高的另一個電極。 超聲波的發(fā)射強度。輸出端采用兩個反向器并聯(lián)用以提高驅(qū)動能力。其電路原理圖如圖3.12所示。上拉電阻 R23,R24 一方面可以提高反相器的高電平驅(qū)動能力，另一方面可以增強超聲波換能器的阻尼效果，縮短其自由震蕩的時間。Q10 的作用是提高單片機 I/O 口的輸出電壓，目的也是提高超聲波發(fā)射的功率。 圖3.12 超聲波發(fā)射驅(qū)動電路 （2）超聲波接收電路 集成芯片 CX20106A 是一款紅外線檢波接收的專用芯片，常用

56、電視機遙控器?？紤]到紅外遙控常用的載波頻率 38KHz與本設(shè)計中超聲波頻率 40KHz較為接近，所以利用它來制作超聲波檢測接收電路。實驗證明 CX20106A 接收超聲波具有很高的靈敏度和較強的抗干擾能力。如圖3.13所示為CX20106A 內(nèi)部結(jié)構(gòu)及電路連接圖。 圖3.13 CX20106A內(nèi)部結(jié)構(gòu)及電路連接圖 使用CX20106A 集成電路對接收探頭受到的信號進行放大、濾波。其總放大增益80db。以下是CX20106A的引腳注釋∶ 1腳：超聲信號輸入端，該腳的輸入阻抗約為40kΩ 。 2腳：該腳與地之間連接RC 串聯(lián)網(wǎng)絡(luò)，它們是負反饋串聯(lián)網(wǎng)絡(luò)的一個組成部分，改變它們的數(shù)值能改

57、變前置放大器的增益和頻率特性。增大電阻R1 或減小C1,將使負反饋量增大，放大倍數(shù)下降，反之則放大倍數(shù)增大。但C1 的改變會影響到頻率特性，一般在實際使用中不必改動，典型參數(shù)R1=4.7Ω ，C1=1μF。 3腳：該腳與地之間連接檢波電容，電容量大為平均值檢波，瞬間相應(yīng)靈敏度低；若容量小，則為峰值檢波，瞬間相應(yīng)靈敏度高，但檢波輸出的脈沖寬度變動大，易造成誤動作，經(jīng)試驗測試取3.3μF為宜。 5腳：該腳與電源間接入一個電阻，用以設(shè)置帶通濾波器的中心頻率F0，阻值越大，中心頻率越低。取F例如， R=200kΩ 時， 0≈42kHz，若取 R=220kΩ ，則中心頻率 F0 ≈38kHz。 6

58、腳：該腳與地之間接一個積分電容，標準值為 330pF，如果該電容 取得太大，會使探測距離變短。 7腳：遙控命令輸出端，它是集電極開路輸出方式，因此該引腳必須接 上一個上拉電阻到電源端，沒有接受信號是該端輸出為高電平，有信號時則 產(chǎn)生下降。 8腳：電源正極，4.5～5V。 第四章 運動控制系統(tǒng)軟件設(shè)計 番茄采摘機器人運動控制系統(tǒng)的軟件主要由等五大部分組成，每一部分都針對相應(yīng)的硬件路。 4.1運動控制系統(tǒng)總程序流程圖 首先小車進行上電初始化程序，屏幕顯示小車初始狀態(tài)，后小車開始前進，前進過程中單片機通過超聲波模塊不斷檢測距前方障礙物。當檢測距離小于程

59、序設(shè)定的避障安全距離時判定前方有障礙物，此時小車停止前進，與此同時聲光報警器動作，發(fā)光 LED不斷閃爍與此同時單片機控制電機驅(qū)動模塊驅(qū)動電機完成避障操作完，避障動作完成后小車繼續(xù)前進并檢測前方障礙物。圖4.1為系統(tǒng)總程序流程圖。 是否有采摘任務(wù) 開始 初始化 信息顯示 調(diào)用采摘程序 N 小車前進 小車停止前進 Y 圖4.1 運動控制系統(tǒng)總程序流程圖 4.2超聲波測距模塊 開始 比較避障并處理 計算距離 發(fā)射超聲波脈沖 接受超聲波脈沖 圖4.2

60、超聲波測距模塊流程圖 主程序?qū)ο到y(tǒng)進行初始化之后，超聲波測距程序設(shè)置定時器 T0 為 16位定時器，開中斷允許位 EA，清零顯示端口 P0 和 P2。之后調(diào)用超聲波發(fā)射子程序送出一個超聲波脈沖，為了避免信號直接耦合干擾需要延時 0.1ms在開外部中斷接收返回的超聲波信號（這也就是超聲波測距會有一個最小可測距離的原因）。由于系統(tǒng)采用的是 12M 晶振，計數(shù)器每計一個數(shù)就是一微秒，當主程序檢測到接收成功標志位后，將計數(shù)器 T0 中的數(shù)按公式d=(c*t)/2=172*T0/10000計算。在室溫下測試聲速為 344m/s，超聲波每發(fā)射，接收一次所走距離為被測距離 L 的 2 倍，L便是被測物

61、體和超聲波傳感器之間的距離，L式中t為計數(shù)器 T0 中的計數(shù)值。測出距離后結(jié)果將以十進制 BCD 碼方式送入累加器 A 與安全距離進行比較，若判定前方有障礙物則執(zhí)行避障操作，等待上述過程結(jié)束，然后再發(fā)射超聲波脈沖重復測量過程。 4.3避障模塊 避障模塊程序流程圖如圖4.3所示。避障系統(tǒng)的程序思路是：發(fā)現(xiàn)障礙物后，番茄采摘機器人停止動作，等待排除障礙再運動。 是否有障礙物 入口 停止前進 聲光報警 等候 返回 Y N 圖4.3 避障系統(tǒng)程序流程圖 4.4電機控制模塊 本設(shè)計用了兩個電機：前輪控制車體

62、轉(zhuǎn)向的步進電機；后輪控制車體前進的直流電機。本運動系統(tǒng)對速度的精度無特殊要求，控制直流電機方法相對簡單。對于步進電機，由于相對復雜所以以下做詳細介紹。 四相步進電機按照通電順序的不同，可分為單四拍、雙四拍、八拍三種工作方式，如圖4.4所示。單四拍與雙四拍的步距角相等，但單四拍的轉(zhuǎn)動力矩小。八拍工作方式的步距角是單四拍與雙四拍的一半，因此，八拍工作方式既可以保持較高的轉(zhuǎn)動力矩又可以提高控制精度。 單四拍 雙四拍 八拍 圖4.4 電源通電時序與波形圖 步進電機的驅(qū)動電路依據(jù)控制信號工作，控制信號由單片機產(chǎn)生，具體如下： 如果按給定方向的正序換相通電，步進電機正轉(zhuǎn)；如果按反序

63、通電換相，步進電機反轉(zhuǎn)。下面為八拍模式下以單片機的P0口的低四位為控制端口的正序和反序的控制碼。 正序：0x01，0x03，0x02，0x06，0x04，0x0c，0x08，0x09； 反序：0x09，0x08，0x0c，0x04，0x06，0x02，0x03，0x01。 4.5顯示模塊 顯示模塊的關(guān)鍵之處是了解顯示的指令。本設(shè)計使用的是128X64LCD。編寫程序時只要按照時序嚴格編寫就可以實現(xiàn)車體運動狀態(tài)的顯示功能。 第五章 系統(tǒng)仿真 本設(shè)計是最后借助于仿真，完成的。簡要步驟如下：在使用時先在Keil u

64、Vision環(huán)境下編輯程序，然后保存程序、建立新項目、設(shè)置項目，接著編譯程序并生成HEX文件，最后在Proteus上調(diào)試和執(zhí)行。仿真結(jié)果驗證本設(shè)計的方法正確，結(jié)果正確。 仿真采用按鍵代替番茄采摘機器人采摘結(jié)構(gòu)提供的信號，用于控制后輪電機的轉(zhuǎn)動，并將電機的狀態(tài)信息顯示出去。前輪電機的轉(zhuǎn)動，也是通過按鍵來模擬采摘機構(gòu)提供的信號來完成。5.1所示，顯示的是后輪電機處于停止狀態(tài)，顯示屏顯示為“停止”。此時LED點亮，蜂鳴器發(fā)出警報，車體停止運動。如圖5.2所示，顯示的是后輪電機處在正轉(zhuǎn)的狀態(tài)，在顯示屏中顯示為“前進”。此時無采摘任務(wù)，且前方無障礙物番茄采摘，機器人處于前進狀態(tài)。 圖5.1 仿

65、真效果圖（后輪電機停止狀態(tài)） 圖5.2 仿真效果圖（后輪電機正轉(zhuǎn)狀態(tài)） 結(jié)束語 本文介紹了番茄采摘機器人運動控制系統(tǒng)的設(shè)計與實現(xiàn)，闡述了番茄采摘機器人運動控制系統(tǒng)的整體機械結(jié)構(gòu)與運動控制系統(tǒng)的組成，并對基于AT89C52的控制策略進行了研究，設(shè)計了避障系統(tǒng)，并最終借助于Proteus完成了實驗的驗證。本設(shè)計簡單，軟件編程易實現(xiàn)，實時性好且成本低，通過試驗，成功實現(xiàn)了避障、顯示、報警等功能。 一番風雨路三千，通過近一個學期的努力，終于在曲折中的完成了番茄采摘運動控制設(shè)計與實現(xiàn)這一畢業(yè)設(shè)計。畢業(yè)設(shè)計是本科學習階段一次非常難得的理論與

66、實際相結(jié)合的機會，通過這次比較完整的系統(tǒng)設(shè)計，感受到實踐結(jié)合理論的重要性。在整個完成過程中，不僅提高了我查閱文獻資料、設(shè)計手冊、CAD制圖、Proteus仿真等知識，并且使我的抗壓能力、思維分析能力都有了很大提高，這必將成為我今后生活中不可多得的經(jīng)驗。 同時在設(shè)計過程我也遇到了很多不懂的地方，比如如何選擇電機的整體控制策略、避障系統(tǒng)的選擇依據(jù)等問題。好在得到了王老師的耐心解惑，給我的畢業(yè)設(shè)計指明了方向。 參考文獻 [1] Ill-Woo Park, Jung-Yup Kim, Jungho Lee, Jun-Ho Oh. Mechanical design of humanoid robot platform KHR-3[C]．IEEE-RAS International Conference on Humanoid Robot, 2005：321–326． [2] Edan Y，Rogozin D，F(xiàn)lash T，et a1.Robotic melon harvesting[J]．Robotics a