畢業(yè)論文光電導(dǎo)引自主式搬運(yùn)機(jī)器人設(shè)計(jì)_第1頁
畢業(yè)論文光電導(dǎo)引自主式搬運(yùn)機(jī)器人設(shè)計(jì)_第2頁
畢業(yè)論文光電導(dǎo)引自主式搬運(yùn)機(jī)器人設(shè)計(jì)_第3頁
畢業(yè)論文光電導(dǎo)引自主式搬運(yùn)機(jī)器人設(shè)計(jì)_第4頁
畢業(yè)論文光電導(dǎo)引自主式搬運(yùn)機(jī)器人設(shè)計(jì)_第5頁
已閱讀5頁,還剩39頁未讀, 繼續(xù)免費(fèi)閱讀

下載本文檔

版權(quán)說明:本文檔由用戶提供并上傳,收益歸屬內(nèi)容提供方,若內(nèi)容存在侵權(quán),請(qǐng)進(jìn)行舉報(bào)或認(rèn)領(lǐng)

文檔簡(jiǎn)介

1、 2015 屆畢業(yè)設(shè)計(jì)(論文)題 目:光電導(dǎo)引自主式搬運(yùn)機(jī)器人設(shè)計(jì)專 業(yè):測(cè)控技術(shù)與儀器班 級(jí): 測(cè)控1101姓 名: 指導(dǎo)老師:起訖日期:年 月摘 要機(jī)器人是一種復(fù)雜的智能機(jī)械,包含了電子、機(jī)械、傳感器、計(jì)算機(jī)、仿生學(xué)、控制技術(shù)、人工智能等學(xué)科。目前已成為世界各國(guó)的研究熱點(diǎn)之一,是衡量一國(guó)工業(yè)化水平的重要標(biāo)志。智能移動(dòng)機(jī)器人是一個(gè)集環(huán)境感知、動(dòng)態(tài)規(guī)劃與決策、運(yùn)動(dòng)行為控制與執(zhí)行等多種功能與一體的綜合系統(tǒng),可以說它是機(jī)器人的一個(gè)重要的分支。本文主要介紹了一種基于光電傳感的移動(dòng)搬運(yùn)機(jī)器人的設(shè)計(jì)與實(shí)現(xiàn)。該機(jī)器人系統(tǒng)選用stm32f103zet6單片機(jī)作為微控制器,采用七路灰度傳感器循跡,三路舵機(jī)控制

2、的機(jī)械爪,一個(gè)紅外光電開關(guān)測(cè)距,一個(gè)觸碰開關(guān),四個(gè)電機(jī)驅(qū)動(dòng)機(jī)器人直線行駛,轉(zhuǎn)彎。整個(gè)機(jī)器人系統(tǒng)涉及機(jī)器人結(jié)構(gòu)設(shè)計(jì),灰度傳感器信號(hào)采集處理,機(jī)械爪的結(jié)構(gòu)設(shè)計(jì),循跡算法和策略優(yōu)化等方面。經(jīng)過多次調(diào)試,比較各種方案的優(yōu)劣,不斷改進(jìn)和升級(jí),確定了現(xiàn)在的方案?,F(xiàn)在該機(jī)器人系統(tǒng)能夠完整完成自主導(dǎo)航及搬運(yùn)的任務(wù),達(dá)到了實(shí)驗(yàn)預(yù)期目的。關(guān)鍵詞:光電傳感器,搬運(yùn)機(jī)器人,自主導(dǎo)航,循跡ABSTRACTRobotics is a combination of mechanical, electronic, computer, sensors, control technology, artificial intell

3、igence, bionics and other disciplines of complex intelligent machinery, has become one of the hot spots around the world, as a measure of a country's level of industrialization important symbol.Intelligent mobile robot is an important branch of the robot, is a versatile integrated system human-c

4、omputer interaction, situational awareness, planning and decision-making, such as a set of motion control.This paper describes the design and implementation of mobile robot based handling of photoelectric sensors. The robot system selected stm32f103zet6 microcontroller as microcontrollers, sensors t

5、racking the use of seven road gray, three-way servo-controlled mechanical claw, an infrared photoelectric switches ranging, a touch switch, four motor-driven robot straight, turning . Entire robot system involving body structure design, gray sensor signal acquisition and processing, structural desig

6、n of mechanical claw, control algorithms and strategies to optimize other aspects. After several rounds of testing, comparing the pros and cons of various options, continuous improvement and upgrading, determine the current program.The robot system can now complete the task of autonomous navigation

7、and transportation, to achieve the intended purpose of the experiment.Keywords: photoelectric sensors, handling robots, autonomous navigation, tracking摘要IIABSTRACTIII第一章 緒論11.1 自主式搬運(yùn)機(jī)器人概述11.2 發(fā)展歷史與研究現(xiàn)狀11.2.1 國(guó)外發(fā)展11.2.2 國(guó)內(nèi)發(fā)展21.3 課題研究意義21.4 課題研究?jī)?nèi)容2第二章 機(jī)器人總體設(shè)計(jì)42.1 設(shè)計(jì)目標(biāo)42.2 導(dǎo)航方式52.3 機(jī)械手62.3.1 機(jī)械手功能62.3.

8、2 機(jī)械手驅(qū)動(dòng)方式62.4 小車驅(qū)動(dòng)方式82.5 電源選擇92.6 微控制器選擇102.7 測(cè)距抓取102.8 機(jī)器人整體框圖10第三章 硬件電路設(shè)計(jì)123.1 微控制器123.2 程序下載123.3 電源模塊133.3.1 穩(wěn)壓芯片133.3.2 穩(wěn)壓電路133.4 驅(qū)動(dòng)模塊143.4.1 電機(jī)驅(qū)動(dòng)模塊選擇143.4.2 電機(jī)驅(qū)動(dòng)電路設(shè)計(jì)153.5 灰度檢測(cè)模塊173.6 舵機(jī)控制電路183.7 碰撞開關(guān)193.8 紅外光電開關(guān)19第四章 軟件設(shè)計(jì)204.1 小車運(yùn)動(dòng)控制算法204.2 機(jī)械臂控制算法254.3 搬運(yùn)機(jī)器人關(guān)鍵函數(shù)264.4 軟件開發(fā)平臺(tái)27第五章 實(shí)地調(diào)試295.1 基于紅

9、外傳感器的循跡方案試驗(yàn)295.2 基于高亮LED的循跡方案試驗(yàn)295.3 車速及轉(zhuǎn)彎調(diào)試305.3.1 車速調(diào)試305.3.2 轉(zhuǎn)彎調(diào)試31第六章 總結(jié)與展望326.1 創(chuàng)新與可取點(diǎn)326.2 不足和改進(jìn)32參考文獻(xiàn)34致謝36第一章 緒論1.1 自主式搬運(yùn)機(jī)器人概述移動(dòng)機(jī)器人是能夠感知環(huán)境做出相應(yīng)行為控制并執(zhí)行的系統(tǒng),是機(jī)器人學(xué)的重要組成部分。由于移動(dòng)機(jī)器人的智能性和對(duì)環(huán)境的適應(yīng)性,越來越多的移動(dòng)機(jī)器人被運(yùn)用于醫(yī)療服務(wù)、宇宙探測(cè)、軍事及深海偵察等領(lǐng)域。二十世紀(jì)六十年代斯坦福大學(xué)研制的一款自主移動(dòng)機(jī)器人SHAKEY拉開了移動(dòng)機(jī)器人研究序幕。 70年代末,計(jì)算機(jī)和傳感器技術(shù)的發(fā)展將移動(dòng)機(jī)器人的研

10、究帶向新的高度。別是在80年代中期,全世界刮起了一股機(jī)器人的浪潮,許多公司開始研制用于大學(xué)實(shí)驗(yàn)室和研究機(jī)構(gòu)的機(jī)器人實(shí)驗(yàn)平臺(tái),機(jī)器人研究開始向多領(lǐng)域發(fā)展。90年代以來,以研制高水平的環(huán)境信息傳感器和信息處理技術(shù),高適應(yīng)性的移動(dòng)機(jī)器人控制技術(shù), 真實(shí)環(huán)境下的規(guī)劃技術(shù)為標(biāo)志,開展了移動(dòng)機(jī)器人更高層次的研究。1.2 發(fā)展歷史與研究現(xiàn)狀1.2.1 國(guó)外發(fā)展20世紀(jì)60年代美國(guó)斯坦福大學(xué)研制了第一款自主移動(dòng)機(jī)器人Shakey,這款機(jī)器人可以在不同環(huán)境下識(shí)別路徑,做出推理并控制移動(dòng)功能。 70年代,傳感器和計(jì)算機(jī)技術(shù)開始運(yùn)用到移動(dòng)機(jī)器人領(lǐng)域,帶動(dòng)了移動(dòng)機(jī)器人的發(fā)展。比如前蘇聯(lián)研制的用于月球探測(cè)的輪式機(jī)器人L

11、unokhod;美國(guó)斯坦福大學(xué)研制的Stanford Cart移動(dòng)機(jī)器人能通過自身視覺傳感器來識(shí)別軌線;法國(guó)圖盧茲LAAS實(shí)驗(yàn)室研制了配有激光測(cè)距儀、超聲波傳感器等傳感設(shè)備的Hilare輪式移動(dòng)機(jī)器。70年代末80年代中期,許多大學(xué)和研究機(jī)構(gòu)從事移動(dòng)機(jī)器人平臺(tái)的研究,促進(jìn)了移動(dòng)機(jī)器人的多方向發(fā)展。 進(jìn)入90年代后,隨著科技進(jìn)步,移動(dòng)機(jī)器人開始向智能化發(fā)展。如CMU的Navlab系列移動(dòng)機(jī)器人系統(tǒng);德國(guó)Vamors-P和Caravelle系統(tǒng);由日本本田公司研制的P系列和ASIMO人型機(jī)器人;日本索尼的SDR-3X人型機(jī)器人和AIBO娛樂型機(jī)器人等,展示了移動(dòng)機(jī)器人各方面的先進(jìn)成果10。 國(guó)內(nèi)發(fā)

12、展我國(guó)移動(dòng)機(jī)器人研究開始于八五期間。雖然起步較晚,但是發(fā)展迅速。在863計(jì)劃的支持下,機(jī)器人研究的各領(lǐng)域都取得了顯著成績(jī)。比較著名的有清華大學(xué)的移動(dòng)護(hù)理機(jī)器人,它具有七自由度;香港城市大學(xué)研制的自動(dòng)導(dǎo)航車和服務(wù)機(jī)器人;中科院自動(dòng)化所通過研究,開發(fā)了具有全方位視覺導(dǎo)航系統(tǒng)的移動(dòng)機(jī)器人;上海交通大學(xué)設(shè)計(jì)的移動(dòng)機(jī)器人 “小蜘蛛”,它具有輪式結(jié)構(gòu)可以用于登月研究。1.3 課題研究意義本選題主要研究移動(dòng)搬運(yùn)機(jī)器人的設(shè)計(jì)與實(shí)現(xiàn)。搬運(yùn)機(jī)器人具有智能性,它可以按照人類設(shè)計(jì)好的路線搬運(yùn)貨物。資料顯示:在工廠生產(chǎn)過程中,只有5%的時(shí)間是用來生產(chǎn)產(chǎn)品,產(chǎn)品的裝卸、運(yùn)輸卻要占用95%的時(shí)間。有研究顯示在美國(guó),直接生產(chǎn)

13、成本只占總成本的10%,40%成本要用于產(chǎn)品的存儲(chǔ)、運(yùn)輸。所以現(xiàn)代企業(yè)生產(chǎn)應(yīng)該把優(yōu)化物流結(jié)構(gòu)、降低物流費(fèi)用作為企業(yè)的核心競(jìng)爭(zhēng)力之一。移動(dòng)搬運(yùn)機(jī)器人運(yùn)用于企業(yè)生產(chǎn),不僅能提高效率,實(shí)現(xiàn)物流的集成化和自動(dòng)化,而且把人從危險(xiǎn)、惡劣、繁重的工作環(huán)境下解放出來,顯示出極大的優(yōu)越性。因此對(duì)自主搬運(yùn)機(jī)器人的研究對(duì)現(xiàn)代工業(yè)的產(chǎn)生深遠(yuǎn)影響,具有實(shí)用價(jià)值。同時(shí)本課題開發(fā)的機(jī)器人系統(tǒng)適應(yīng)于一般競(jìng)賽機(jī)器人要求,在其基礎(chǔ)上可以擴(kuò)展更多功能,滿足更多需求。1.4 課題研究?jī)?nèi)容本文在全國(guó)大學(xué)生機(jī)器人大賽的基礎(chǔ)上設(shè)計(jì)了一款以光電導(dǎo)引方式循跡的搬運(yùn)機(jī)器人。具體研究?jī)?nèi)容如下: 機(jī)器人整體機(jī)械結(jié)構(gòu)設(shè)計(jì)。包括小車的大小,機(jī)械爪的結(jié)構(gòu)

14、,電池的安裝等。 機(jī)器人硬件電路設(shè)計(jì)。包括單片機(jī)的選取,電源模塊、驅(qū)動(dòng)模塊、灰度檢測(cè)模塊等模塊的設(shè)計(jì)。 機(jī)器人軟件設(shè)計(jì)。包括整個(gè)系統(tǒng)的軟件開發(fā)平臺(tái),機(jī)器人運(yùn)動(dòng)控制、機(jī)械爪舵機(jī)控制算法的設(shè)計(jì),信號(hào)數(shù)據(jù)的采集與處理等。 機(jī)器人調(diào)試。包括場(chǎng)地的鋪設(shè),不斷讓機(jī)器人在現(xiàn)場(chǎng)調(diào)試,觀察數(shù)據(jù),修改參數(shù)最終獲得最佳狀態(tài)。第二章 機(jī)器人總體設(shè)計(jì)2.1 設(shè)計(jì)目標(biāo)本課題旨在完成一個(gè)小型的光電導(dǎo)引式自主搬運(yùn)機(jī)器人的設(shè)計(jì),并能夠自主完整的完成以下規(guī)定動(dòng)作:(1)機(jī)器人查病房;(2)機(jī)器人為病人端茶水。(1)機(jī)器人查病房。從起點(diǎn)出發(fā),機(jī)器人沿著白線循跡,到達(dá)指定甲、乙兩處,并且機(jī)器人輕觸甲、乙兩處的擋板即可。(2)機(jī)器人為

15、病人端茶水。機(jī)器人模擬人手抓住杯子,將S1處的杯子放到指定地點(diǎn)1,將S2處的杯子放到指定地點(diǎn)2,然后回到起點(diǎn)。場(chǎng)景示意圖如下:圖2.1場(chǎng)地示意圖2.2 導(dǎo)航方式移動(dòng)機(jī)器人能夠?qū)崿F(xiàn)自主行駛,最重要的技術(shù)就是導(dǎo)航和導(dǎo)引,沒有可靠的導(dǎo)航系統(tǒng)就無法實(shí)現(xiàn)移動(dòng)機(jī)器人的最初目的,所以對(duì)移動(dòng)機(jī)器人的研究很大程度上是對(duì)導(dǎo)航技術(shù)的研究。隨著科學(xué)技術(shù)發(fā)展,為了讓移動(dòng)機(jī)器人適應(yīng)不同工作環(huán)境開發(fā)了各種導(dǎo)航技術(shù),目前的導(dǎo)航/導(dǎo)引技術(shù)主要有以下幾種:慣性導(dǎo)航慣性導(dǎo)航是利用慣性元件來測(cè)量運(yùn)載體的加速度進(jìn)而計(jì)算出位置和速度,達(dá)到機(jī)器人導(dǎo)航目的。這種方法運(yùn)用到了牛頓慣性運(yùn)動(dòng)定律。慣性導(dǎo)航系統(tǒng)的缺點(diǎn)是誤差會(huì)隨著時(shí)間漂移而增長(zhǎng),因此

16、不適合于長(zhǎng)時(shí)間準(zhǔn)確定位。(18)電磁導(dǎo)航電磁導(dǎo)航是讓一定頻率電流流過電纜,產(chǎn)生磁場(chǎng)信號(hào),機(jī)器人上安裝的傳感器檢測(cè)磁場(chǎng)信號(hào),并判斷路徑。這種方法的優(yōu)點(diǎn)是原理簡(jiǎn)單,聲光對(duì)其無干擾,缺點(diǎn)路徑改變麻煩,鋪設(shè)電纜工作量大,維護(hù)困難。激光導(dǎo)航 該方法需要在移動(dòng)機(jī)器人身上安裝激光發(fā)射器,激光發(fā)射器發(fā)射激光,激光反射并被接收,通過計(jì)算發(fā)射光束與反射光束之間的信息可以對(duì)移動(dòng)機(jī)器人進(jìn)行位置導(dǎo)引。這種方法的優(yōu)點(diǎn)是定位精確,缺點(diǎn)是算法復(fù)雜。光學(xué)反射導(dǎo)引在深色地面鋪設(shè)淺色條帶或者在淺色地面鋪設(shè)深色條帶,移動(dòng)機(jī)器人攜帶的光學(xué)發(fā)射元件對(duì)路面進(jìn)行照射,光學(xué)信號(hào)被反射或吸收以此來判斷機(jī)器人和條帶的相對(duì)位置。這種方法操作簡(jiǎn)單,但

17、是容易受外界光線影響。(29)視覺導(dǎo)航 通常采用CCD敏感元件拍攝路面信息,運(yùn)用相關(guān)視覺技術(shù)識(shí)別路徑。移動(dòng)機(jī)器人利用視覺技術(shù)導(dǎo)航具有很大的發(fā)展前景,是未來移動(dòng)機(jī)器人導(dǎo)航的發(fā)展趨勢(shì)。超聲波導(dǎo)航 超聲波導(dǎo)航是利用超聲波傳感器發(fā)射超聲波遇到物體反射進(jìn)行定位。這種方法原理簡(jiǎn)單,硬件陳本低,缺點(diǎn)是當(dāng)超聲波束與檢測(cè)物體表面不垂直或者物體距離太遠(yuǎn)時(shí)檢測(cè)結(jié)果不夠準(zhǔn)確。通過對(duì)以上導(dǎo)航方式的優(yōu)劣進(jìn)行對(duì)比,并考慮到實(shí)際操作需要,我選擇了光學(xué)反射導(dǎo)引的方式循跡。2.3 機(jī)械手在工業(yè)生產(chǎn)中,機(jī)器人已經(jīng)逐漸被運(yùn)用各個(gè)領(lǐng)域成為重要的生產(chǎn)力。大多數(shù)工業(yè)機(jī)器人都需要有自己的機(jī)械手作為執(zhí)行機(jī)構(gòu),結(jié)構(gòu)合理的機(jī)械手可以大大提高機(jī)器人

18、的工作效率,所以對(duì)機(jī)械手功能和結(jié)夠的研究就很有現(xiàn)實(shí)意義。 機(jī)械手功能機(jī)器人手爪功能是當(dāng)機(jī)器人收到抓取物件信號(hào),按指定路徑抓放物件的能力。為了完成這一系列動(dòng)作,機(jī)械手應(yīng)具備一定運(yùn)動(dòng)范圍、物件定位、適當(dāng)夾緊力等功能。 機(jī)械手驅(qū)動(dòng)方式機(jī)器人手爪按照驅(qū)動(dòng)源的方式可以分為電機(jī)、液壓、氣動(dòng)、形狀記憶記憶合金等,機(jī)器人靈巧手傳動(dòng)系統(tǒng)把驅(qū)動(dòng)器產(chǎn)生的運(yùn)動(dòng)和力以一定的方式傳遞到手指關(guān)節(jié),從而使關(guān)節(jié)做相應(yīng)的運(yùn)動(dòng)。機(jī)械手的驅(qū)動(dòng)和傳動(dòng)方式可以分為以下幾種類型:腱傳動(dòng)方式第一類是由腱,一般是繩索、鋼絲繩之類配上滑輪。其特點(diǎn)是能實(shí)現(xiàn)多自由度遠(yuǎn)距離傳輸,但是由于摩擦和腱的布局產(chǎn)生的力矩耦合等,手爪的抓取控制變得復(fù)雜。連桿傳動(dòng)

19、方式利用各種連桿結(jié)構(gòu)傳動(dòng),其優(yōu)點(diǎn)是動(dòng)力大,結(jié)構(gòu)牢固,能抓取很重的物體,但是需要用到動(dòng)力學(xué)設(shè)計(jì)復(fù)雜。人工肌肉驅(qū)動(dòng)方式近年來產(chǎn)生一種驅(qū)動(dòng)方式是模擬人肌肉工作方式,比較典型的是氣動(dòng)的驅(qū)動(dòng)方式和液壓驅(qū)動(dòng),但是這種技術(shù)還不夠成熟,還遠(yuǎn)遠(yuǎn)無法達(dá)到和人類肌肉一樣工作的高度。形狀記憶合金驅(qū)動(dòng)方式還有一種方式是利用某些合金的記憶效應(yīng)進(jìn)行驅(qū)動(dòng),這種驅(qū)動(dòng)方式負(fù)載能力強(qiáng),但是不夠靈活,容易產(chǎn)生衰耗。欠驅(qū)動(dòng)方式空間機(jī)器人研究的一個(gè)課題是欠驅(qū)動(dòng)手爪。通過欠驅(qū)動(dòng)手指機(jī)構(gòu)、 機(jī)械限位和彈簧實(shí)現(xiàn)無動(dòng)力關(guān)節(jié)對(duì)被抓取形狀的被動(dòng)自適應(yīng),具有驅(qū)動(dòng)元件少,抓取范圍廣泛、控制簡(jiǎn)單、出力大、負(fù)載能力好等特點(diǎn)。由于其他幾種方式機(jī)械手結(jié)構(gòu)較復(fù)雜

20、,且價(jià)格較高,本設(shè)計(jì)采用舵機(jī)配合機(jī)械手臂實(shí)現(xiàn)抓取物體。一個(gè)舵機(jī)一般包括控制電路、傳感器、直流電機(jī)和減速齒輪組四部分,輸出不同信號(hào)則舵機(jī)旋轉(zhuǎn)不同角度。本設(shè)計(jì)選用舵機(jī)如下圖:圖2.2 MG996R舵機(jī) 舵機(jī)參數(shù)如下:工作電壓產(chǎn)品拉力12kg/cm(6V)反應(yīng)速度0.17sec/60度(4.8V無負(fù)載)0.14sec/60度(6V無負(fù)載)工作溫度0-55齒輪形式金屬齒輪接線定義黃信號(hào) 紅正極 褐負(fù)極本設(shè)計(jì)采用的是金屬對(duì)稱抓取機(jī)械手,實(shí)物圖如圖2.3所示。機(jī)械手長(zhǎng)161.8mm,寬72mm,由一只舵機(jī)驅(qū)動(dòng),通過舵機(jī)的轉(zhuǎn)動(dòng)可以實(shí)現(xiàn)機(jī)械手的張開與閉合,能穩(wěn)定的抓取大型圓球,圓柱體。圖2.3 機(jī)械手2.4

21、小車驅(qū)動(dòng)方式移動(dòng)機(jī)器人要想完成移動(dòng)、搬運(yùn)的功能必須要有運(yùn)動(dòng)控制系統(tǒng),一個(gè)完善、高效的運(yùn)動(dòng)控制系統(tǒng)能夠讓機(jī)器人完整、穩(wěn)定的行駛。本文研究的機(jī)器人主體類似于小型智能車,小車按照驅(qū)動(dòng)方式可以分為單輪驅(qū)動(dòng)、差速驅(qū)動(dòng)和全方位驅(qū)動(dòng)。三輪式小車是單輪驅(qū)動(dòng)小車最常見的形式,小車的驅(qū)動(dòng)輪和轉(zhuǎn)向輪都是前輪,兩個(gè)后輪起從動(dòng)作用。差速驅(qū)動(dòng)小車,采用兩個(gè)或四個(gè)航輪,分置在車體四周增加小車的穩(wěn)定性,當(dāng)每組航輪轉(zhuǎn)速不同時(shí)執(zhí)行車體轉(zhuǎn)向動(dòng)作,當(dāng)速度相同時(shí),車體執(zhí)行直線行動(dòng)或原地旋轉(zhuǎn)。全方位小車安裝有三個(gè)獨(dú)立的驅(qū)動(dòng)轉(zhuǎn)向組合輪,能夠朝任意方向行駛而不改變車體姿態(tài)。考慮到小車必須要能支撐起機(jī)械臂和整個(gè)硬件系統(tǒng),所以小車應(yīng)該是三輪或者

22、四輪形式,由于三輪小車只有后面兩輪是驅(qū)動(dòng)輪動(dòng)力不足,所以最終采用四輪的結(jié)構(gòu),并且是四輪差速驅(qū)動(dòng)方式,通過調(diào)節(jié)左右兩組航輪的速度可以做到直線行動(dòng)和轉(zhuǎn)彎。這種結(jié)構(gòu)承載能力強(qiáng),易于控制,調(diào)速能力優(yōu)良。四輪構(gòu)型如下圖:圖2.4 四輪構(gòu)型2.5 電源選擇機(jī)器人驅(qū)動(dòng)需要有電池供電。普通干電池價(jià)格便宜,但是放電快,只能使用一次不符合循環(huán)使用的要求,因此決定采用充電電池,充電電池分為鋰電池和鎳氫電池,鎳氫電池高容量,大電流,可循環(huán)使用,且價(jià)格更便宜,所以使用鎳氫充電電池。我使用的是VB品牌的鎳氫電池,電壓7.2V,容量3600毫安,電池規(guī)格23mm,電池實(shí)物圖如圖2.5:圖2.5 鎳氫電池實(shí)物圖2.6 微控制

23、器選擇目前我們的課程學(xué)習(xí)了51系列單片機(jī)和stm32系列單片機(jī),51單片機(jī)較簡(jiǎn)單,控制方便但是速度、功能沒有stm32強(qiáng)大,搬運(yùn)機(jī)器人涉及大量數(shù)據(jù)處理,所以單片機(jī)速度越快越好,而且stm32外圍接口豐富能滿足機(jī)器人的各種設(shè)計(jì)要求,為了將課堂學(xué)習(xí)的知識(shí)運(yùn)用到實(shí)際,本設(shè)計(jì)選擇了增強(qiáng)型stm32單片機(jī)stm32f103zet6作為機(jī)器人的微控制器。2.7 測(cè)距抓取機(jī)器人搬運(yùn)物體需要知道在什么地方停下抓取物體,所以機(jī)器人和物體之間的測(cè)距是必要的。本設(shè)計(jì)剛開始使用的方案是超聲波測(cè)距,圖2.6為超聲波傳感器。但是實(shí)際測(cè)試過程中發(fā)現(xiàn)超聲波測(cè)距精度不高,機(jī)器人不能到達(dá)正確位置抓取物體,所以拋棄此方案。我轉(zhuǎn)而采

24、用紅外測(cè)距,圖2.7為紅外光電開關(guān),事實(shí)證明紅外測(cè)距具有探測(cè)距離遠(yuǎn),精度高的優(yōu)點(diǎn),滿足設(shè)計(jì)要求。 圖2.6 超聲波傳感器 圖2.7 紅外光電開關(guān)2.8 機(jī)器人整體框圖搬運(yùn)機(jī)器人整體結(jié)構(gòu)如圖2.8所示:圖2.8 機(jī)器人整體結(jié)構(gòu)組建好的搬運(yùn)機(jī)器人硬件平臺(tái)如圖2.9所示:圖2.9 搬運(yùn)機(jī)器人第三章 硬件電路設(shè)計(jì)3.1 微控制器MCU主控制器選用的是意法半導(dǎo)體公司出品的stm32f103zet6芯片,其內(nèi)核是Cortex-M3。該芯片是增強(qiáng)型的32位單片機(jī),具有64KB SRAM、512KB FLASH、基本定時(shí)器和高級(jí)定時(shí)器各2個(gè)、通用定時(shí)器4個(gè)、3個(gè)SPI、2個(gè)IIC、5個(gè)串口、1個(gè)USB、1個(gè)C

25、AN、3個(gè)12位ADC、1個(gè)12位DAC、1個(gè)SDIO接口、1個(gè)FSMC接口以及112個(gè)通用IO口。其主要特點(diǎn)如下:a) 超低的價(jià)格。雖然是32位機(jī)卻只有8位機(jī)的價(jià)格。b) 72MHz的工作頻率,具有快捷強(qiáng)力的的數(shù)值運(yùn)算和邏輯運(yùn)算能力。c) 超多的外設(shè)。擁有包括FSMC、TIMER、SPI、USB、CAN、IIC、IIS、SDIO、ADC、DAC、RTC、DMA等眾多外設(shè)及功能,具有極高的集成度。d) 優(yōu)異的實(shí)時(shí)性能。84個(gè)中斷,16級(jí)可編程優(yōu)先級(jí),并且所有的引腳都可以作為中斷輸入。e) 杰出的功耗控制。STM32擁有獨(dú)立時(shí)鐘開關(guān)控制各個(gè)外設(shè),不需要的外設(shè)可以關(guān)閉相應(yīng)時(shí)鐘來降低功耗。f) 極低

26、的開發(fā)成本。STM32的開發(fā)不需要昂貴的仿真器,只需要一個(gè)串口即可下載代碼,并且支持SWD和JTAG兩種調(diào)試口。在本設(shè)計(jì)中采用stm32f103zet6正是利用了它的快速運(yùn)算處理能力以及豐富的片上資源,從而有效、快速、準(zhǔn)確地控制機(jī)器人運(yùn)動(dòng)。3.2 程序下載本設(shè)計(jì)下載程序使用德國(guó)SEGGER公司推出的Jlink仿真器,該仿真器配合IAR EWAR,ADS,KEIL,WINARM,RealView等集成開發(fā)環(huán)境支持所有ARM7/ARM9/ARM11,Cortex M0/M1/M3/M4,Cortex A4/A8/A9等內(nèi)核芯片的仿真適用于Keil、IAR等編譯環(huán)境,操作起來非常方便,學(xué)習(xí)也很簡(jiǎn)單,

27、是很好的學(xué)習(xí)開發(fā)ARM的開發(fā)工具。3.3 電源模塊本設(shè)計(jì)采用兩塊7.2V、3600mah的鎳氫電池供電,由于系統(tǒng)構(gòu)成復(fù)雜,各模塊供電要求不同,所以將電壓分為3.3V,5V,7.2V三個(gè)檔位。 穩(wěn)壓芯片由于STM系列芯片需要3.3V供電,供電電壓任何時(shí)刻都不能超過3.6V,否則會(huì)導(dǎo)致主芯片燒毀,采用低壓線差線性穩(wěn)壓器AMS1117-3.3提供3.3V電壓?;叶葌鞲衅?、紅外光電開關(guān)、觸碰開關(guān)、舵機(jī)都需要5V供電,如果還采用單片的線性穩(wěn)壓器件,當(dāng)輸入輸出壓差較大時(shí)器件就會(huì)因電流過大而被擊穿,所以最后決定采用開關(guān)型集成穩(wěn)壓芯片LM2596,該器件功耗很低,轉(zhuǎn)換效率可達(dá)75%88%。 穩(wěn)壓電路輸入5V電

28、壓,通過AMS1117-3.3穩(wěn)壓芯片轉(zhuǎn)換輸出3.3V電壓給單片機(jī)供電,其電路圖如圖3.0所示。圖3.0 3.3V穩(wěn)壓電路穩(wěn)壓芯片LM2596輸出5V電壓供給各個(gè)模塊使用,其電路圖如圖3.1所示。圖3.1 LM2596穩(wěn)壓電路3.4 驅(qū)動(dòng)模塊本設(shè)計(jì)采用直流減速電機(jī)為系統(tǒng)提供必須的的驅(qū)動(dòng)力。單片機(jī)的I/O口能輸出的電流很小無法驅(qū)動(dòng)電機(jī)這種大功率器件,通過添加驅(qū)動(dòng)電路可以解決這一問題。 電機(jī)驅(qū)動(dòng)模塊選擇有兩種方案可供考慮:方案1:設(shè)計(jì)由分離元件組成的驅(qū)動(dòng)電路實(shí)現(xiàn),但是設(shè)計(jì)反鎖,使用不便。方案2:采用專用的驅(qū)動(dòng)芯片加以實(shí)現(xiàn)。由于專用的驅(qū)動(dòng)芯片結(jié)構(gòu)簡(jiǎn)單、可靠性高、價(jià)格便宜,所以決定采用方案2。設(shè)計(jì)選擇

29、L298N專用芯片驅(qū)動(dòng)電機(jī)。該芯片是ST公司生產(chǎn)的一種工作電壓高,輸出電流大的電機(jī)驅(qū)動(dòng)芯片。其主要特點(diǎn)是:工作電壓高,最高工作電壓可達(dá)46V,輸出電流大,最大電流可達(dá)3A,持續(xù)工作電流為2A,內(nèi)部集成了兩個(gè)H橋,能同時(shí)驅(qū)動(dòng)兩個(gè)電機(jī)。圖3.2為L(zhǎng)298N電機(jī)驅(qū)動(dòng)模塊。圖3.2 L298N電機(jī)驅(qū)動(dòng) 電機(jī)驅(qū)動(dòng)電路設(shè)計(jì)圖3.3為典型的H橋電路,H橋式電機(jī)驅(qū)動(dòng)電路由四個(gè)三極管和一個(gè)電機(jī)組成。當(dāng)對(duì)角線上的一對(duì)三極管導(dǎo)通時(shí)電機(jī)工作。電流流向隨不同三極管對(duì)導(dǎo)通而改變,以此來控制電機(jī)轉(zhuǎn)動(dòng)的方向。圖3.3 H橋電路例如,如圖3.4所示,當(dāng)三極管對(duì)Q1、Q4導(dǎo)通時(shí),電流從電源正極經(jīng)過Q1,流過電機(jī),最后經(jīng)過Q4流向

30、負(fù)極,電流流向是從左至右,驅(qū)動(dòng)電機(jī)順時(shí)針旋轉(zhuǎn);當(dāng)三極管對(duì)Q2、Q3導(dǎo)通時(shí),電流從電源正極經(jīng)過Q3,流過電機(jī),最后經(jīng)過Q2流向負(fù)極,電流流向是從右至左,驅(qū)動(dòng)電機(jī)逆時(shí)針旋轉(zhuǎn)。 圖3.4 電機(jī)正轉(zhuǎn) 圖3.5 電機(jī)反轉(zhuǎn)可以直接用單片機(jī)的I/O口給L298N提供控制信號(hào)。IN1、IN2和IN3、IN4分別接在兩組單片機(jī)引腳上控制邏輯信號(hào),然后單片機(jī)輸出PWM來控制使能端ENA和ENB的占空比從而調(diào)整轉(zhuǎn)速,OUT1、OUT2和OUT3、OUT4分別接兩個(gè)電機(jī)輸出。L298N電機(jī)控制引腳功能表如圖3.6所示。直流電機(jī)旋轉(zhuǎn)方式IN1IN2IN3IN4調(diào)速PWM信號(hào)調(diào)速端A調(diào)速端BM1正轉(zhuǎn)高低/高/反轉(zhuǎn)低高/高

31、/停止低低/高/M2正轉(zhuǎn)/高低/高反轉(zhuǎn)/低高/高停止/低低/高圖3.6 L298N邏輯功能圖電機(jī)驅(qū)動(dòng)模塊的電路圖如圖3.7所示,IN1、IN2、IN3、IN4直接接單片機(jī)引腳,單片機(jī)輸出兩路PWM給ENA和ENB端,VS引腳接電源電壓,電壓范圍為+2.546V,VSS引腳接5V電壓,引腳1和15接地。圖3.7 L298N電路圖3.5 灰度檢測(cè)模塊灰度傳感器包含高亮LED和光敏電阻兩部分。其基本電路是讓LED串聯(lián)一個(gè)限流電阻接在電源兩端,在電路中并聯(lián)的電阻起到分壓作用,LED是光源,光敏電阻阻值隨光照強(qiáng)度變化而變化。電路圖如圖3.8所示。地面顏色越深,吸收光線的能力越強(qiáng),則光敏電阻接受到的反射光

32、越弱,光敏電阻值越大,灰度傳感器的輸出電壓也越大;反之,地面灰度淺,輸出電壓小。圖3.8 灰度檢測(cè)電路本設(shè)計(jì)選用的灰度傳感器實(shí)物圖如圖4.1所示,該模塊內(nèi)置AD轉(zhuǎn)換模塊,輸出方式為數(shù)字輸出,即1或0輸出,可以直接接單片機(jī)引腳根據(jù)電平高低判斷線路。3.6 舵機(jī)控制電路舵機(jī)連接到單片機(jī)的電路如圖3.9所示:圖3.9 舵機(jī)和單片機(jī)連接電路舵機(jī)有三條線,一條電源線,一條底線,一條信號(hào)線,由單片機(jī)產(chǎn)生周期為20ms,脈寬12ms的信號(hào),通過PWM設(shè)置占空比改變脈寬從而改變舵機(jī)旋轉(zhuǎn)角度。舵機(jī)角度和脈寬的要求如圖4.0所示。圖4.0 舵機(jī)控制要求3.7 碰撞開關(guān)碰撞開關(guān)即微動(dòng)開關(guān),它具有很小間隔的接點(diǎn)機(jī)構(gòu),

33、用一定的力可以連接接點(diǎn)完成開關(guān)動(dòng)作。本設(shè)計(jì)利用車體前安裝的微動(dòng)開關(guān)檢測(cè)觸碰病床并返回。下圖是碰撞開關(guān)原理結(jié)構(gòu)圖:圖4.1 碰撞開關(guān)原理結(jié)構(gòu)3.8 紅外光電開關(guān)紅外光電開關(guān)是一種光電傳感器,可以發(fā)射和接受光信號(hào)。檢測(cè)距離可以根據(jù)要求進(jìn)行調(diào)節(jié),本設(shè)計(jì)選用的傳感器工作電壓5V,長(zhǎng)5cm,直徑17mm,有效距離3-80cm可調(diào)。具有探測(cè)距離遠(yuǎn)、受可見光干擾小、價(jià)格便宜、易于裝配、使用方便等優(yōu)點(diǎn),由于是數(shù)字輸出可以直接接單片機(jī)引腳,前方無障礙輸出高電平,有障礙輸出低電平。紅外光電開關(guān)與單片機(jī)連接圖如下:圖4.2 光電開關(guān)和單片機(jī)連接電路第四章 軟件設(shè)計(jì)4.1 小車運(yùn)動(dòng)控制算法搬運(yùn)機(jī)器人是由車體和機(jī)械臂兩

34、部分組成。小車要循跡完整跑完賽道就需要有算法,依靠車體前方安裝的七路循跡傳感器和車體中間安裝的兩路循跡傳感器可以檢測(cè)道路信息并反饋給單片機(jī),單片機(jī)對(duì)數(shù)據(jù)做出處理并控制小車行駛。(1)直線行駛只有傳感器3在白線上放,傳感器1、2、4、5都不在白線上當(dāng)只有傳感器3引腳輸出低電平時(shí),則傳感器3檢測(cè)到白線,此時(shí)傳感器分布如圖4.3所示,小車保持直線行駛。圖4.3 傳感器3在白線上只有傳感器2或1在白線上方當(dāng)只有傳感器2或1引腳輸出低電平時(shí),則傳感器2或1檢測(cè)到白線,此時(shí)傳感器分布如圖4.4、4.5所示,小車右偏,單片機(jī)控制左輪電機(jī)減速同時(shí)右輪電機(jī)加速,小車向左修正。 圖4.4 傳感器2在白線上 圖4.

35、5 傳感器1在白線上只有傳感器4或5在白線上方當(dāng)只有傳感器4或5引腳輸出低電平時(shí),則傳感器4或5檢測(cè)到白線,此時(shí)傳感器分布如圖4.6、4.7所示,小車左偏,單片機(jī)控制左輪電機(jī)加速右輪電機(jī)減速,小車向右修正。 圖4.6 傳感器4在白線上 圖4.7 傳感器5在白線上走直線的算法流程圖如圖4.8所示:圖4.8 走直線算法流程圖(2)十字路口和T型路口辨別當(dāng)小車沿白線循跡時(shí)只有辨別出十字路口和T型路口才能做出正確判斷。十字路口傳感器1、2、4、5都輸出低電平,并且隔一段時(shí)間傳感器3也輸出低電平。如圖所示: 圖4.9 傳感器1、2、4、5在白線上 圖5.0 傳感器3在白線上T型路口傳感器1、2、4、5都

36、輸出低電平,但是隔一段時(shí)間傳感器3輸出高電平。如圖所示: 圖5.1 傳感器1、2、4、5都在白線上 圖5.2 傳感器3不在白線上(3)左轉(zhuǎn)路口和分叉路口分辨在小車實(shí)際行駛中會(huì)遇到兩條相似的道路如圖所示。所以要有算法分辨這兩種道路。 圖5.3 左轉(zhuǎn)路口 圖5.4 分叉路口左轉(zhuǎn)路口傳感器9和1輸出低電平,但是隔一段時(shí)間后傳感器3輸出高電平。如圖所示: 圖5.5 傳感器9和1在白線上 圖5.6 傳感器3不在白線上分叉路口傳感器9和1輸出低電平,過一段時(shí)間后傳感器3也輸出低電平。如圖所示: 圖5.7 傳感器9和1在白線上 圖5.8 傳感器3在白線上(4)右轉(zhuǎn)路口和分叉路口分辨在小車實(shí)際行駛中會(huì)遇到兩條

37、相似的道路如圖所示。所以要有算法分辨這兩種道路。 圖5.9 左轉(zhuǎn)路口 圖6.0 分叉路口右轉(zhuǎn)路口傳感器10和5輸出低電平,但是隔一段時(shí)間后傳感器3輸出高電平。如圖所示: 圖6.1 傳感器10和5在白線上 圖6.2 傳感器3不在白線上分叉路口傳感器10和5輸出低電平,并且隔一段時(shí)間后傳感器3也輸出低電平。如圖所示: 圖6.3 傳感器10和5在白線上 圖6.4 傳感器3在白線上4.2 機(jī)械臂控制算法搬運(yùn)機(jī)器人的機(jī)械臂整體是由三個(gè)舵機(jī)和鋁質(zhì)支架組裝成的,具有三個(gè)自由度。通過單片機(jī)的定時(shí)器2的三個(gè)通道輸出三路PWM控制舵機(jī)的旋轉(zhuǎn)角度,車前的紅外光電開關(guān)用來檢測(cè)物體距離,相互配合從而完成抓住物體,搬運(yùn)物

38、體,放下物體的整個(gè)過程。具體做法如下:首先對(duì)三個(gè)舵機(jī)初始化:TIM2_PWM_Init(199,7199); /定時(shí)器2產(chǎn)生20ms的周期信號(hào)TIM_SetCompare2(TIM2,8); /設(shè)置通道2占空比TIM_SetCompare3(TIM2,7); /設(shè)置通道3占空比TIM_SetCompare4(TIM2,10); / 設(shè)置通道4占空比 當(dāng)光電開關(guān)第一次檢測(cè)到物體時(shí)輸出口電平會(huì)從高電平變成低電平,單片機(jī)接受到信號(hào)設(shè)置三個(gè)舵機(jī)的占空比完成抓住物體的過程:if(LED11=0) /紅外光電開關(guān)輸出低電平 num+; /計(jì)數(shù)num加一次 if(num=1) /第一次檢測(cè)到物體 TIM_S

39、etCompare2(TIM2,8); /設(shè)置通道2占空比 TIM_SetCompare3(TIM2,7); /設(shè)置通道3占空比 TIM_SetCompare4(TIM2,19); /設(shè)置通道4占空比 當(dāng)光電開關(guān)第二次檢測(cè)到物體時(shí)輸出口電平會(huì)從高電平變成低電平,單片機(jī)接受到信號(hào)設(shè)置三個(gè)舵機(jī)的占空比完成放下物體的過程:if(LED11=0) /紅外光電開關(guān)輸出低電平 num+; /計(jì)數(shù)num加一次 if(num=2) /第二次檢測(cè)到物體 TIM_SetCompare4(TIM2,10); /設(shè)置通道4占空比 TIM_SetCompare3(TIM2,7); /設(shè)置通道3占空比 TIM_SetCo

40、mpare2(TIM2,8); /設(shè)置通道2占空比 搬運(yùn)機(jī)器人要重復(fù)完成兩套這樣的抓物,放物過程,其算法同理。4.3 搬運(yùn)機(jī)器人關(guān)鍵函數(shù)為方便軟件程序的編寫和可讀性,本設(shè)計(jì)所包含主要關(guān)鍵函數(shù)如下:void delay_init();函數(shù)說明:延時(shí)函數(shù)初始化。void LED_Init();函數(shù)說明:stm32f103zet6需要用到的引腳的配置void TIM3_PWM_Init(u16 arr,u16 psc) 函數(shù)說明:TIME3 PWM部分初始化,arr:自動(dòng)重裝值;psc:時(shí)鐘預(yù)分頻數(shù)。該函數(shù)用來生成PWM控制電機(jī)轉(zhuǎn)動(dòng)。void TIM2_PWM_Init(u16 arr,u16 ps

41、c)函數(shù)說明:TIME2 PWM部分初始化,arr:自動(dòng)重裝值;psc:時(shí)鐘預(yù)分頻數(shù)。該函數(shù)用來生成PWM控制舵機(jī)轉(zhuǎn)動(dòng)。void zheng(void);函數(shù)說明:配置電機(jī)驅(qū)動(dòng)的邏輯信號(hào),使四個(gè)電機(jī)正轉(zhuǎn)。void left_f(void);函數(shù)說明:配置電機(jī)驅(qū)動(dòng)的邏輯信號(hào),使左邊兩個(gè)電機(jī)反轉(zhuǎn),右邊兩個(gè)電機(jī)正轉(zhuǎn)。void right_f(void);函數(shù)說明:配置電機(jī)驅(qū)動(dòng)的邏輯信號(hào),使左邊兩個(gè)電機(jī)正轉(zhuǎn),右邊兩個(gè)電機(jī)反轉(zhuǎn)。void fan(void);函數(shù)說明:配置電機(jī)驅(qū)動(dòng)的邏輯信號(hào),使四個(gè)電機(jī)反轉(zhuǎn)。4.4 軟件開發(fā)平臺(tái)軟件開發(fā)平臺(tái)多種多樣,各有各的優(yōu)勢(shì)和特色,常見的如IAR,Keil,因?yàn)镮AR

42、平臺(tái)沒有涉及過而學(xué)起來比較困難,Keil正是單片機(jī)教學(xué)使用的開發(fā)平臺(tái),所以本設(shè)計(jì)采用Keil uVision5作為搬運(yùn)機(jī)器人的軟件開發(fā)平臺(tái)。Keil uVision5是美國(guó)Keil Software公司出品的51系列兼容單片機(jī)C語言軟件開發(fā)系統(tǒng),這款軟件的開發(fā)方案非常完整,包含了宏匯編、庫管理、C編譯器、連接器、仿真調(diào)試器等功能,這些功能被集成在一個(gè)開發(fā)環(huán)境中。開發(fā)界面如圖6.5所示:圖6.5 Keil操作界面第五章 實(shí)地調(diào)試5.1 基于紅外傳感器的循跡方案試驗(yàn)設(shè)計(jì)剛開始采用紅外探測(cè)法,其原理是紅外光在不同顏色地面反射情況不同,當(dāng)紅外光照射到淺色地面時(shí),紅外光大部分被反射回來,接收管接收到紅外

43、光;當(dāng)紅外光照射到深色地面時(shí),紅外光大部分被吸收,接收管收不到紅外光。不斷向地面發(fā)射紅外光通過反射回來的紅外光接收情況可以判斷小車和軌跡的相對(duì)位置。使用的紅外傳感器如圖6.6所示:圖6.6 紅外傳感器模塊實(shí)際測(cè)試過程中發(fā)現(xiàn)這種紅外傳感器檢測(cè)距離短,道路參數(shù)檢測(cè)精度低,雖然能夠識(shí)別黑白線,但是對(duì)綠底白線的賽道識(shí)別度不高,特別容易受外界光線干擾,經(jīng)常判斷出錯(cuò)跑出賽道。5.2 基于高亮LED的循跡方案試驗(yàn)還有一種光電循跡方案是發(fā)光源采用高亮白色聚光LED,如圖6.7所示,接收管對(duì)不同反射光的強(qiáng)弱對(duì)比處理,只要對(duì)白光反射強(qiáng)弱不同即可,差值越大,分辨越好。實(shí)際測(cè)試發(fā)現(xiàn)該方案靈敏度高,能精確分辨綠白色,而

44、且抗干擾能力強(qiáng),普通照明燈基本對(duì)其無影響。所以最后采用該方案循跡。圖6.7 高亮LED循跡模塊5.3 車速及轉(zhuǎn)彎調(diào)試 車速調(diào)試小車的車速是通過控制輸出給電機(jī)的PWM波形的占空比調(diào)節(jié)的。調(diào)試過種中發(fā)現(xiàn)由于小車整體結(jié)構(gòu)重心的問題小車車速過快容易偏離白線,為了減少偏差,經(jīng)過反復(fù)測(cè)試得到小車在不同路況下理想的占空比如表6.8所示。表6.8 不同路況占空比路況左輪占空比右輪占空比直線55%63%左轉(zhuǎn)81%78%右轉(zhuǎn)78%84%T型路口左轉(zhuǎn)81%78%T型路口右轉(zhuǎn)78%87%十字路口左轉(zhuǎn)82%78%十字路口右轉(zhuǎn)78%87% 轉(zhuǎn)彎調(diào)試四輪小車轉(zhuǎn)彎相比較兩輪車更加復(fù)雜,因?yàn)樵谒妮嗆囋谵D(zhuǎn)彎過程中要考慮到車子重心

45、、四個(gè)輪子的不同阻力等問題?,F(xiàn)有兩種方案:一是左轉(zhuǎn)彎時(shí)左邊車輪不轉(zhuǎn),右邊車輪正轉(zhuǎn),右轉(zhuǎn)彎時(shí)右邊車輪不轉(zhuǎn),左邊車輪正轉(zhuǎn);第二種方案是左轉(zhuǎn)彎時(shí)左邊車輪反轉(zhuǎn),右邊車輪正轉(zhuǎn),右轉(zhuǎn)彎時(shí)右邊車輪反轉(zhuǎn),左邊車輪正轉(zhuǎn)。實(shí)際測(cè)試發(fā)現(xiàn),第一種方案由于有半邊車輪不轉(zhuǎn),電機(jī)動(dòng)力不夠,經(jīng)常會(huì)發(fā)生車子轉(zhuǎn)不過彎甚至原地打滑的情況,相比較而言第二種方案能使小車轉(zhuǎn)彎時(shí)有足夠動(dòng)力,而且減少與地面摩擦更好完成轉(zhuǎn)彎。所以最終采用方案二。機(jī)器人在賽道正常循跡如下圖:圖6.9 機(jī)器人循跡第六章 總結(jié)與展望6.1 創(chuàng)新與可取點(diǎn)本課題以第五屆江蘇省大學(xué)生機(jī)器人大賽為基礎(chǔ),設(shè)計(jì)一款光電導(dǎo)引自主式搬運(yùn)機(jī)器人,前期閱讀大量機(jī)器人相關(guān)資料文獻(xiàn),了解

46、了機(jī)器人發(fā)展的相關(guān)技術(shù)。后期進(jìn)行了搬運(yùn)機(jī)器人的硬件和軟件設(shè)計(jì)并最終實(shí)現(xiàn)了目標(biāo)。在具體實(shí)施過程中主要完成了以下工作:我根據(jù)比賽要求對(duì)機(jī)器人的整體結(jié)構(gòu)做出規(guī)劃設(shè)計(jì),包括導(dǎo)航方式,小車驅(qū)動(dòng)方式,電源,微控制器,機(jī)械手結(jié)構(gòu)的設(shè)計(jì),最終確定小車搭載機(jī)械臂的整體方案,設(shè)計(jì)制作賽道,基于賽道完成測(cè)試。在硬件設(shè)計(jì)方面學(xué)習(xí)并靈活運(yùn)用stm32單片機(jī),研究了包括電源,電機(jī)驅(qū)動(dòng)等模塊的電路和使用方法,并且將各個(gè)模塊搭建融合在一起組成了一個(gè)完整的系統(tǒng),使之能相互配合工作。深入查閱學(xué)習(xí)機(jī)器人循跡各種方式和算法,在比較和總結(jié)后,拋棄了傳統(tǒng)的四路、五路循跡,而是采取了一種創(chuàng)新的方式即七路循跡,相比傳統(tǒng)循跡,這種循跡方式更加

47、精確穩(wěn)定?;谒O(shè)計(jì)的賽道不斷試跑測(cè)試,觀察機(jī)器人各種運(yùn)動(dòng)態(tài)勢(shì)并收集數(shù)據(jù),修改參數(shù)最終達(dá)到最穩(wěn)定的狀態(tài)。6.2 不足和改進(jìn)機(jī)器人是一個(gè)極其復(fù)雜的系統(tǒng),由于第一次接觸這類搬運(yùn)機(jī)器人,所以在硬件電路設(shè)計(jì)不盡合理,軟件方面也需優(yōu)化。主要的不足與日后改進(jìn)如下:車體面積不大導(dǎo)致各個(gè)模塊安裝擁擠雜亂,不僅影響美觀而且重心不穩(wěn)定影響行駛。若要改進(jìn)可以選用更大的車體;在測(cè)試過程中發(fā)現(xiàn)雖然是同型號(hào)的電機(jī),但是在性能上還是有微小差異,這就需要不斷調(diào)速,但是本設(shè)計(jì)沒有速度檢測(cè)裝置,只能通過差速?gòu)浹a(bǔ)的方式。若要改進(jìn)可以安裝測(cè)速碼盤或編碼器檢測(cè)車速做到閉環(huán)控制,使機(jī)器人運(yùn)動(dòng)更加穩(wěn)定快速。軟件編寫沒有統(tǒng)一的規(guī)劃,看上去比

48、較雜亂,缺乏邏輯性,以后編寫程序可以先設(shè)計(jì)好思路,按模塊分部編寫再整合。參考文獻(xiàn)1 張明路,丁承君,段萍.移動(dòng)機(jī)器人的研究現(xiàn)狀與趨勢(shì)J.河北工業(yè)大學(xué)學(xué)報(bào),2004,33(2):110-1152 張輝. 非完整性移動(dòng)機(jī)器人體系結(jié)構(gòu)設(shè)計(jì)與軌跡跟蹤控制研究D.湖南:湖南大學(xué),2007:1-73 孟慶春.智能機(jī)器人及其發(fā)展J.中國(guó)海洋大學(xué)學(xué)報(bào),2004,34(5):831-8384 陳建業(yè).移動(dòng)機(jī)械臂動(dòng)力學(xué)控制與基于視覺的物體抓取D.杭州:杭州電子科技大學(xué),20105 譚民.機(jī)器人技術(shù)研究進(jìn)展J.自動(dòng)化學(xué)報(bào),2013,39(7):963-9726 魏全盛,丁莉英.移動(dòng)機(jī)器人關(guān)鍵技術(shù)分析J.科技資訊,2

49、014,(9):25-267 王川.移動(dòng)機(jī)器人導(dǎo)航中的路徑規(guī)劃與運(yùn)動(dòng)控制技術(shù)研究D.武漢:武漢科技大學(xué),20098 李愛蓮,高策,梁惠明.移動(dòng)機(jī)器人導(dǎo)航方法的分析與研究J.儀表技術(shù),2013,(5):42-449 劉承俊.一種基于視覺信息的自主搬運(yùn)機(jī)器人J.科學(xué)技術(shù)與工程,2007,7(3):314-31910 徐國(guó)保,尹欣怡,周美娟.移動(dòng)機(jī)器人技術(shù)現(xiàn)狀及展望J.機(jī)器人技術(shù)與應(yīng)用,2007,(2):29-3411 駱敏舟,楊秀清,梅濤.機(jī)械人手爪的研究現(xiàn)狀與進(jìn)展J.機(jī)器人技術(shù)與應(yīng)用.2008,(2):24-2512 李燦.智能移動(dòng)機(jī)器人導(dǎo)航策略研究與實(shí)現(xiàn)D.浙江:浙江工業(yè)大學(xué),201313 楊

50、奇.輪式機(jī)器人的實(shí)時(shí)障礙物識(shí)別和視覺導(dǎo)引D.沈陽:沈陽理工大學(xué),201114 楊文亮.蘋果采摘機(jī)器人機(jī)械手結(jié)構(gòu)設(shè)計(jì)與分析D.鎮(zhèn)江:江蘇大學(xué),200915 王志文.移動(dòng)機(jī)器人導(dǎo)航技術(shù)現(xiàn)狀與展望J.機(jī)器人,2003,25(5):470-47416 何發(fā)昌.我國(guó)機(jī)械手和機(jī)器人J.吉林工業(yè)大學(xué)學(xué)報(bào),1981,(1):135-13917 楊明,程磊,黃衛(wèi)華,吳斌華.基于光電管循跡的智能車舵機(jī)控制J.光電技術(shù)應(yīng)用,2007,(1):50-5318鄭吉,王學(xué)普.無刷直流電機(jī)控制技術(shù)綜述J.微特電機(jī),2002,(3):11-1319莫宏偉,董會(huì)云.基于光電傳感器的移動(dòng)機(jī)器人室內(nèi)定位J.2014,33(10):

51、33-3720賀龍豹.競(jìng)賽用搬運(yùn)機(jī)器人的設(shè)計(jì)與實(shí)現(xiàn)D.南京:南京財(cái)經(jīng)大學(xué),201321李兆盈.裝卸車機(jī)械手的結(jié)構(gòu)優(yōu)化研究D.河北:河北聯(lián)合大學(xué),201322蔡公華,洪乃剛.一種智能車循跡算法的研究J.電子科技,2009,(6):10-1323賈翔宇,季厭庸,丁芳.前饋-改進(jìn)PID算法在智能車控制上的應(yīng)用J.計(jì)算機(jī)與信息技術(shù),2008,(12):28-3024高月華.基于紅外光電傳感器的智能車自動(dòng)循跡系統(tǒng)設(shè)計(jì)J.半導(dǎo)體光電,2009,(1):134-13725張敏杰,盧倩,崔治.轉(zhuǎn)彎差速在智能車上的應(yīng)用J.企業(yè)技術(shù)開發(fā),2011,(19):32-3326付國(guó)迎.機(jī)電一體化智能車電源總成的制作J.

52、電子制作,2009,(5):55-5727李珊珊.基于單片機(jī)的兩輪智能車設(shè)計(jì)D.南京:南京理工大學(xué),201328陳軍,王軍強(qiáng).基于MC33886智能車電機(jī)驅(qū)動(dòng)電路設(shè)計(jì)J.洛陽師范學(xué)院學(xué)報(bào),2012,(5):37-38+8329于娟.提高智能車速度的研究D.西安:電子科技大學(xué),201030徐錦康,馬銀忠.小型5自由度關(guān)節(jié)式機(jī)器人J.南京工程學(xué)院學(xué)報(bào),2004,(1):27-31致謝時(shí)間流逝轉(zhuǎn)眼四年大學(xué)生活就要結(jié)束了,在論文即將完成之際我衷心的感謝那些在生活和學(xué)習(xí)上給予我?guī)椭娜?。首先感謝我的導(dǎo)師王鑫國(guó)老師,在制作畢業(yè)設(shè)計(jì)過程中他給予我資金和技術(shù)方面的支持,當(dāng)我遇到問題時(shí)他總是耐心指導(dǎo)我,給我的方

53、案提出了很多有益的意見。在寫論文的過程中他也非常負(fù)責(zé)任的監(jiān)督我,幫助我修改論文,他淵博的學(xué)識(shí)和認(rèn)真嚴(yán)謹(jǐn)?shù)墓ぷ鲬B(tài)度都使我印象深刻。我還要感謝和我一起做畢業(yè)設(shè)計(jì)的同學(xué),當(dāng)我們發(fā)現(xiàn)問題時(shí)會(huì)互相提醒、請(qǐng)教,正是這種良好積極的學(xué)習(xí)氛圍使我能更好的完成畢業(yè)設(shè)計(jì)。最后我想感謝我的家人,感謝他們四年來對(duì)我的關(guān)懷和鼓勵(lì),正是他們的支持讓我能堅(jiān)持不懈順利完成學(xué)業(yè)。您好,為你提供優(yōu)秀的畢業(yè)論文參考資料,請(qǐng)您刪除以下內(nèi)容,O(_)O謝謝!A national survey was recently launched to evaluate 

54、;the eye health of Chinese children andteenagers.On June 6, China's annual National Day for Eye Care, the China Youth Development ServiceCenter and Zhejiang Medicine, a le

55、ading listed Chinese pharmaceutical company, jointlyannounced the kickoff of the survey.In about one month, a questionnaire compiled by top eye care medical experts in China w

56、illbe distributed through multiple online partners, including H, as well asthrough offline survey events held in universities, middle schools and primary schools acrossthe country.A

57、0;report will be released based on the survey statistics and analysis, and most importantly,guidelines for parents and youth on how to care for the eyes and prevent 

58、myopia  agrowing problem in China's digitized society, will also be attached on the report."Myopia is not only a disease that makes people see things blurrily, b

59、ut also leads to severecomplications, such as glaucoma (increased pressure within the eyeball), and can causeblindness," said Zhou Yuehua, an established eye care specialist with Beijing TongrenHospital."It is very important for parents and children to know about t

溫馨提示

  • 1. 本站所有資源如無特殊說明,都需要本地電腦安裝OFFICE2007和PDF閱讀器。圖紙軟件為CAD,CAXA,PROE,UG,SolidWorks等.壓縮文件請(qǐng)下載最新的WinRAR軟件解壓。
  • 2. 本站的文檔不包含任何第三方提供的附件圖紙等,如果需要附件,請(qǐng)聯(lián)系上傳者。文件的所有權(quán)益歸上傳用戶所有。
  • 3. 本站RAR壓縮包中若帶圖紙,網(wǎng)頁內(nèi)容里面會(huì)有圖紙預(yù)覽,若沒有圖紙預(yù)覽就沒有圖紙。
  • 4. 未經(jīng)權(quán)益所有人同意不得將文件中的內(nèi)容挪作商業(yè)或盈利用途。
  • 5. 人人文庫網(wǎng)僅提供信息存儲(chǔ)空間,僅對(duì)用戶上傳內(nèi)容的表現(xiàn)方式做保護(hù)處理,對(duì)用戶上傳分享的文檔內(nèi)容本身不做任何修改或編輯,并不能對(duì)任何下載內(nèi)容負(fù)責(zé)。
  • 6. 下載文件中如有侵權(quán)或不適當(dāng)內(nèi)容,請(qǐng)與我們聯(lián)系,我們立即糾正。
  • 7. 本站不保證下載資源的準(zhǔn)確性、安全性和完整性, 同時(shí)也不承擔(dān)用戶因使用這些下載資源對(duì)自己和他人造成任何形式的傷害或損失。

最新文檔

評(píng)論

0/150

提交評(píng)論