機械手-智能巡線機器人設(shè)計

機械手-智能巡線機器人設(shè)計,機械手,智能,機器人,設(shè)計 四川理工學(xué)院畢業(yè)設(shè)計（論文）開題報告 設(shè)計（論文）名稱 智能巡線機器人設(shè)計 設(shè)計（論文）類型 機械類設(shè)計 指導(dǎo)教師 孫祥國 學(xué)生 姓名 彭進秀 學(xué)號 030110528 系、專業(yè)、班級 機電03.3 一、選題依據(jù)：（簡述研究現(xiàn)狀或生產(chǎn)需求情況，說明該設(shè)計（論文）目的意義。） 現(xiàn)代數(shù)控機床是綜合應(yīng)用計算機、自動控制、自動檢測以及精密機械等高等技術(shù)的產(chǎn)物，是典型的機電一體化產(chǎn)品，作為數(shù)控車床的一部分—三坐標(biāo)數(shù)控機械定位系統(tǒng)，也是全新型的自動化產(chǎn)品。通過對三維掃描檢測裝置的機械傳動系統(tǒng)的設(shè)計和總體結(jié)構(gòu)的設(shè)計，能初步掌握機電一體化系統(tǒng)或產(chǎn)品機械傳動設(shè)計方法和重點考慮的問題、總體機構(gòu)設(shè)計的基本要求和方法等方面的技能，并能對該機構(gòu)的運動學(xué)仿真進行設(shè)計與分析。由于產(chǎn)品變化的頻繁，為有效的保證產(chǎn)品質(zhì)量，提高勞動生產(chǎn)率和降低成本，要求機床不僅具有較好的通用性和靈活性，而且要求加工過程實現(xiàn)自動化，那么所設(shè)計的定位系統(tǒng)也同樣應(yīng)該具備高精度、高效率、高質(zhì)量、高可靠性的優(yōu)點。 在老師的指導(dǎo)下，對三維掃描檢測裝置的機械傳動系統(tǒng)設(shè)計和總體結(jié)構(gòu)設(shè)計的摸索過程中，不但能對已有知識進行查缺補漏，而且接觸、掌握更多的零件選型原則，還能吸收前延知識理念，從而為畢業(yè)后能更好的適應(yīng)機電產(chǎn)品不斷更新?lián)Q代的新環(huán)境奠定基礎(chǔ)。 二、設(shè)計（論文研究）思路及工作方法 l X，Y，Z三方向的伺服電機選擇與傳動機構(gòu)設(shè)計。 l 各個方向定位導(dǎo)向機構(gòu)設(shè)計。 l 三維掃描檢測裝置總體結(jié)構(gòu)設(shè)計。 l 合理選用相關(guān)標(biāo)準(zhǔn)件、通用件、外購件。 l 應(yīng)用Pro/E繪制裝配圖進行動態(tài)仿真。 l 根據(jù)要求完成設(shè)計報告及圖紙。 三、設(shè)計（論文研究）任務(wù)完成的階段內(nèi)容及時間安排。 l 查閱和搜集設(shè)計資料，在此基礎(chǔ)上指定設(shè)計方案 07.03.05---07.03.25 l 進行整體方案設(shè)計 07.03.25---07.04.02 l 機械整體設(shè)計 07.04.02---07.05.03 l 控制設(shè)計 07.05.03---07.05.22 l 編寫設(shè)計說明書 07.05.22---07.05.26 l 檢查 07.05.29---07.06.02 指導(dǎo)教師意見 指導(dǎo)教師簽字： 年 月 日 教研室畢業(yè)設(shè)計（論文）工作組審核意見 難度 分量 綜合訓(xùn)練程度 教研室主任： 年 月 日 設(shè)計（論文）類型：A—理論研究；B—應(yīng)用研究；C—軟件設(shè)計；D-其它等。 前 言 四 川 理 工 學(xué) 院 畢 業(yè) 設(shè) 計 說 明 書 題 目 智能巡線機器人設(shè)計 學(xué) 生 彭 進 秀 系 別 機電工程系 專 業(yè) 班 級 機械設(shè)計制造及其自動化機電03.3班 學(xué) 號 030110528 指 導(dǎo) 教 師 李 開 世 四 川 理 工 學(xué) 院 畢業(yè)設(shè)計（論文）任務(wù)書 設(shè)計（論文）題目： 智能巡線機器人設(shè)計 系： 機電系 專業(yè)： 機械設(shè)計制造及其自動化（機電一體化） 班級： 2003級3班 學(xué)號： 030110528 學(xué)生： 彭進秀 指導(dǎo)教師： 李開世 接受任務(wù)時間 2007/3/5 教研室主任 （簽名）　　系主任 （簽名） 1．畢業(yè)設(shè)計（論文）的主要內(nèi)容及基本要求 1.總體方案設(shè)計； 2機械整體設(shè)計； 3.控制設(shè)計； 4編寫設(shè)計說明書； 2．指定查閱的主要參考文獻(xiàn) 1.《機器人控制電子學(xué)》 2.《機器人探索》 3.《機器人的創(chuàng)意設(shè)計與實踐》 4．《MSP430系列——FLASH型超低功耗16位單片機》 （電子和機械方面的書） 3．進度安排 設(shè)計（論文）各階段名稱 起 止 日 期 1 查閱和搜集設(shè)計資料，在此基礎(chǔ)上指定設(shè)計方案 2007.3.5—2007.3.25 2 進行整體方案設(shè)計 2007.3.25—2007.4.2 3 機械整體設(shè)計 2007.4.2—2007.5.3 4 控制設(shè)計 2007.5.3—2007.5.22 5 編寫設(shè)計說明書 2007.5.22—2007.5.29 6 檢查 2007.5.29—2007.6.2 前 言 第3頁 摘 要 近年來機器人的研究和應(yīng)用已經(jīng)不僅僅局限于軍用領(lǐng)域。許多應(yīng)用于軍用機器人上的成功技術(shù)已經(jīng)在民用機器人中得到了一定的應(yīng)用。在工業(yè)機器人的基礎(chǔ)上，運用了傳感器技術(shù)和單片機智能控制技術(shù)，設(shè)計出了一種能自動運送貨物的職能巡線機器人。 論文首先對智能巡線機器人總體設(shè)計方案進行敘述，闡述其各要素的工作原理，然后就整個智能巡線機器人系統(tǒng)劃分為五個模塊，分章節(jié)對各個模塊設(shè)計制作進行闡述。 機器人機械結(jié)構(gòu)部分，通過分析常用的車輪驅(qū)動配置方式，擇優(yōu)選擇了前排安裝兩個萬向輪、后排安裝兩個獨立驅(qū)動輪的設(shè)計方案，充分考慮到了巡線的簡易性和穩(wěn)定性。 機器人傳感器接口與驅(qū)動電路部分，詳細(xì)闡述了光電傳感器檢測信號原理，敘述了設(shè)計所采用的光電傳感器接口電路詳細(xì)設(shè)計方案，分析了傳感器采用該種布局方案的原因。針對機器人的機械特性和速度要求，選用了L298N驅(qū)動芯片驅(qū)動電機，分析了它的優(yōu)缺點和可行性。 機器人主控系統(tǒng)硬件部分闡述了主控芯片選型，主控電路設(shè)計方案，以及相應(yīng)的接口說明。軟件部分在MSP430平臺上實現(xiàn)了快速、穩(wěn)定、準(zhǔn)確的巡線方法。 關(guān)鍵詞: 機器人；巡線；光電檢測；PWM驅(qū)動。 Abstract In recent years, research and design of robot has not been limited just in military field. Many technologies, which had been used in the military field cuccessfully, have been used in the field of civilian robot. Based on the industrial robot, and by applying sensor interface control and SCM intelligent control, this project has designed one kind of biranpower line walking robot that is able to carry the goods by itself. In this thesis, the overall design of autonomous line-tracking robot and principle of each essential element have been described. The robot system has been divided into five parts as fellow. The autonomous line-tracking arithmetic is the key of this project research. The relative position relationship between the robot and the leading line is divided into seven typical states; the adjustment strategy has been described respectively. An implementation principle to enable centerline approaching the leading-line gradually has been described by adjusting continuously chassis posture. In mechanical structure part, by analyzing the normal wheel drive configurations, it has been choiced that two universal wheels are installed in the front and two independent driving wheels are installed in the rear, which takes fully into account the simplicity and stability of the line-tracking. In sensor interface and drive circuit part, a detail explanation of photoelectric sensor and interface circuit has been discussed carefully. To adapt the robot mechanical properties and speed requirement, two motor driving circuits based on different principles have been designed and their advantages and feasibility analyied. In robot control system part, hardware and software have been discussed such as CPU choosing, control circuit designing, and hardware interface assigning, etc. Based on the MSP430, the speed difference from left and right wheel created by the Pulse-Width Modulation adjusts the position of the robot and leading line, which carries out the autonomous runs along with the leading line quickly, stably and accurately. Keywords: Robot; Line-tracking; Photoelectric Sensor; PWM. 前言 機電一體化是綜合應(yīng)用機械技術(shù)、微電子技術(shù)、信息技術(shù)、自動控制技術(shù)、傳感測試技術(shù)、電力電子技術(shù)、接口技術(shù)及軟件編程技術(shù)等，機器人則是機電一體化的顯著代表。機器人根據(jù)系統(tǒng)功能目標(biāo)和優(yōu)化組織結(jié)構(gòu)目標(biāo)，以智力、動力、結(jié)構(gòu)、運動和感知組成要素為基礎(chǔ)，對各組成要素及其間的信息處理、接口耦合、運動傳遞、物質(zhì)運動、能量變換機理進行研究，使得整個系統(tǒng)有機結(jié)合與綜合集成，并在系統(tǒng)程序和微電子電路的有序信息流控制之下，形成物質(zhì)和能量的有規(guī)則運動，在高功能、高質(zhì)量、高精度、高可靠性、低能耗意義上實現(xiàn)各種技術(shù)功能組合以得到最佳功能價值的系統(tǒng)工程技術(shù)。 機器人技術(shù)作為20世紀(jì)人類最偉大的發(fā)明之一，自1960年代初問世以來，經(jīng)歷40年的發(fā)展已取得長足的進步。機器人的出現(xiàn)并高速發(fā)展是社會和經(jīng)濟發(fā)展的必然，是為了提高社會的生產(chǎn)水平和人類的生活質(zhì)量，讓機器人代替人干那些人干不了、干不好的工作。在現(xiàn)實生活中有些工作會對人體造成傷害，比如噴漆、重物搬運等；有些工作要求質(zhì)量很高，人難以長時間勝任，比如汽車焊接、精密裝配等；有些工作人無法身臨其境，比如火山探險、深海探密、空間探索等；有些工作不適合人去干，比如一些惡劣的環(huán)境、一些枯燥單調(diào)的重復(fù)性勞作等；這些都是機器人大顯身手的地方。服務(wù)機器人還可以治病保健、保潔保安；水下機器人可以幫助打撈沉船、鋪設(shè)電纜；工程機器人可以上山入地、開洞筑路；農(nóng)業(yè)機器人可以耕耘播種、施肥除蟲；軍用機器人可以沖鋒陷陣、排雷排彈……。 可以說，機器人的應(yīng)用范圍非常之廣。據(jù)國外專家預(yù)測，2l世紀(jì)將是機器人技術(shù)革命的世紀(jì)，機器人作為全面延伸和擴展人的體力和智力的手段將實現(xiàn)“當(dāng)代最高意義上的自動化”。機器人的應(yīng)用和普及正在改變?nèi)祟惖纳a(chǎn)方式、生活方式和作戰(zhàn)方式。 編者 2007.5 四川理工學(xué)院畢業(yè)設(shè)計 第11頁 目 錄 摘要 1 Abstract 2 前言 3 第1章 緒論 1 1．1 機電一體化技術(shù)簡介 1 1. 2智能巡線機器人的概況 2 1. 3 課題的主要內(nèi)容 2 第2章 自動巡線機器人總體方案設(shè)計 4 2．1 機器人要素分析 4 2．2 機器人總體分析 5 2.2.1 場地分析 5 2.2.2 機械結(jié)構(gòu)分析 5 2.2.2控制系統(tǒng)框架設(shè)計 5 2.2.4運動姿態(tài)分析 5 第3章 機械結(jié)構(gòu)設(shè)計 7 3．1 移動機器人的車輪驅(qū)動配置 7 3.1.1 機器人常用車輪驅(qū)動配置介紹 7 3.1.2 本系統(tǒng)所采用的車輪驅(qū)動方式配置 10 3．2 機器人機械尺寸設(shè)計 11 第4章 傳感器接口電路設(shè)計 13 4．1 機器人對巡線傳感器的要求 13 4．2 超聲波傳感器 13 4.2.1超聲波傳感器的原理 13 4.2.2 超聲波的發(fā)射與接受電路 15 4．3 紅外光電反射式傳感器 15 4.3.1 紅外光電反射式傳感器原理 16 4.3.2 基于反射光強度測量的紅外光電反射式傳感器電路 17 4．4 紅外光電反射式傳感器布局 19 第5章 電機驅(qū)動電路設(shè)計 21 5．1 驅(qū)動電機的選用 21 5.1.1電機減速器的選擇 22 5.1.2 所選電機性能校核 23 5．2 直流電機的轉(zhuǎn)動控制 24 5．3 直流電機的速度控制 26 5．4基于L298的驅(qū)動電路 28 第6章 智能巡線機器人之態(tài)調(diào)整方法 31 6．1 總體分析 31 6．2 姿態(tài)分析 32 第7章 主控系統(tǒng)的設(shè)計 36 7．1 主控制芯片的選型 36 7.1.1 MSP430系列與89C51系列單片機 36 7.1.2 選用的MSP430F449的原因 38 7.1.3 MSP430F449的引腳 39 7．2 主控單元電路設(shè)計 39 7．3 MSP430實現(xiàn)巡線算法 43 7. 4巡線改進方法的實現(xiàn) 46 7. 5轉(zhuǎn)彎分析 51 總結(jié)與展望 56 致謝 57 參考文獻(xiàn) 58 附件一：程序 60 附件二：元件 76 第1章 緒論 本章首先從機器人的發(fā)展歷程引出機器人研究的發(fā)展趨勢，再具體到本次設(shè)計針對的任務(wù)要求，明確了設(shè)計任務(wù)的主要內(nèi)容。 1．1 機電一體化技術(shù)簡介 “機電一體化”源于“Mechatronic”,是一個新興的邊緣學(xué)科，國內(nèi)外都處于發(fā)展階段，她代表著機械工業(yè)技術(shù)革命的前沿方向。她是當(dāng)代科學(xué)技術(shù)發(fā)展最為活躍的領(lǐng)域之一。機電一體化是綜合應(yīng)用機械技術(shù)、微電子技術(shù)、信息技術(shù)、自動控制技術(shù)、傳感測試技術(shù)、電力電子技術(shù)、接口技術(shù)及軟件編程技術(shù)等，根據(jù)系統(tǒng)功能目標(biāo)和優(yōu)化組織結(jié)構(gòu)目標(biāo)，以智力、動力、結(jié)構(gòu)、運動、和感知組成要素為基礎(chǔ)，對各組成要素及其間的信息處理、接口耦合、運動傳遞、物質(zhì)運動、能量變換機理進行研究，使得整個系統(tǒng)有機結(jié)合與綜合集成，并在系統(tǒng)程序和微電子電路有序信息流控制之下，形成物質(zhì)和能量的有規(guī)則運動，在高功能、高精度、高可靠性、低能耗意義上實現(xiàn)各種技術(shù)功能組合以得到最佳功能價值的系統(tǒng)工程技術(shù)。機電一體化技術(shù)的產(chǎn)生與發(fā)展的根本原因在于社會的發(fā)展和科學(xué)技術(shù)的進步，系統(tǒng)工程、控制工程和信息論是機電一體化的理論基礎(chǔ)，是機電一體化技術(shù)的方法論。半導(dǎo)體大規(guī)模集成電路制造技術(shù)的進步則為機電一體化奠定了物質(zhì)基礎(chǔ)，機電一體化技術(shù)的研究與應(yīng)用融合于學(xué)科交叉。機電一體化依賴于相關(guān)技術(shù)的發(fā)展，同時也促進了相關(guān)技術(shù)的發(fā)展。 目前世界上普遍認(rèn)為機電一體化可以分為兩大類：生產(chǎn)過程機電一體化和機電產(chǎn)品一體化。機電產(chǎn)品的機電一體化是機電一體化的核心，是生產(chǎn)過程機電一體化的物質(zhì)基礎(chǔ)。傳統(tǒng)的產(chǎn)品加上微機控制即可轉(zhuǎn)變?yōu)樾乱淮漠a(chǎn)品，而新產(chǎn)品較之舊產(chǎn)品具有功能強、性能好、密度高、體積小、重量輕、更可靠、更方便、經(jīng)濟效益顯著等優(yōu)點。機電一體化產(chǎn)品小到兒童玩具、家用電器、辦公設(shè)備，大到數(shù)控機床、機器人、自動化生產(chǎn)線、航空航天器，因此，可以說機電一體化技術(shù)幾乎涉及到社會的各個方面。其中，生產(chǎn)過程的機電一體化包括產(chǎn)品設(shè)計、加工、裝配、檢測的自動化，生產(chǎn)過程自動化，經(jīng)營管理自動化等。 當(dāng)傳統(tǒng)機電產(chǎn)品引入電子技術(shù)、計算機技術(shù)和自動控制技術(shù)時，就形成所謂的新一代機電一體化產(chǎn)品。典型的機電一體化產(chǎn)品體現(xiàn)了機械技術(shù)、電子技術(shù)、計算機技術(shù)等的有機結(jié)合，幾種多種高新技術(shù)，并把多種功能集成在一起，在市場上具有極強的競爭能力。機電一體化是機械、微電子、控制、計算機、信息處理等多學(xué)科的交叉融合，起發(fā)展和進步有賴于相關(guān)技術(shù)的進步與發(fā)展。其主要發(fā)展方向為數(shù)字化、智能化、模塊化、網(wǎng)絡(luò)化、人性化、微型化、集成化、帶源化和綠色化。機電產(chǎn)品高性能一般包含高速、高精度、高效率和高可靠性，人工智能在機電一體化技術(shù)中的研究日益得到重視，機器人與數(shù)控機床的智能化就是機電一體化技術(shù)的重要應(yīng)用。 1.2智能巡線機器人的概況 智能巡線機器人的產(chǎn)生已有20多年的歷史，它被人們關(guān)注于機器人賽事?，F(xiàn)在各種機器人賽事，范圍普及世界。截止到2000年共有20余項公認(rèn)的機器人賽事，如機器人足球世界杯比賽、微機器人世界杯錦標(biāo)賽、日本相撲機器人大賽、機器鼠比賽等。這些機器人賽事有些就是巡線機器人。把比賽的尋線機器人和玩具機器人進行一定的改進，使它具有一定的承載能力，能夠被運用于工業(yè)的機器人。 1.3 課題的主要內(nèi)容 針對機器人的巡線特征，設(shè)計出能夠自動巡線的智能巡線機器人，內(nèi)容包括機器人機械外形的設(shè)計、傳感器設(shè)計、驅(qū)動電路設(shè)計、智能巡線的控制設(shè)計。 具體工作是： 1、 根據(jù)一定要求設(shè)計出機器人的機械結(jié)構(gòu)。該機器人可以用于不同場合的循跡，但是必須是引導(dǎo)線的顏色與地面的顏色成鮮明對比。由于考慮到傳感器的使用比較多，所以該次設(shè)計的機器人主要是用于10cm～50cm寬的引導(dǎo)線循跡。 2、選擇辨色傳感器，必須可靠地識別出淺色引導(dǎo)線和深色地板。傳感器是機器人的眼睛，需要選擇幾種效果很好的傳感器，通過比較，擇優(yōu)選擇當(dāng)前條件下最好的傳感器，才能給機器人一雙明亮的眼睛。辨色傳感器需要識別淺色引導(dǎo)線和深色地板，能夠很好將檢測到的高低電平傳送給控制系統(tǒng)。 3、傳感器的布局策略制定。在布置傳感器的過程中，需要考慮到機器人底盤的外形和驅(qū)動方法，充分考慮到機器人在行進時可能遇到的各種情況，在調(diào)整過程中是否可能會讓所有傳感器偏離出檢測物體，使得巡線失敗。要考慮機器人直走和轉(zhuǎn)彎等狀態(tài)可能產(chǎn)生的各種情況。 4、選擇合適的電機。由于是載重機器人，電機不僅要有足夠大的力矩驅(qū)動機器人動作，速度也要快。 5、選擇驅(qū)動芯片。芯片要求能夠同時驅(qū)動兩臺電機，且能夠?qū)崿F(xiàn)速度控制。 6、選擇適合本次設(shè)計的單片機型號，設(shè)計制作性能良好的主控制板。選型是根據(jù)單片機輸入量的個數(shù)和輸出量的個數(shù)，還要合理留出備用端口方便擴展使用。輸入量除了用于巡線的光電傳感器信號以外，還包括用超聲波傳感器檢測有無障礙物和是否到達(dá)目的地；輸出量主要是所有電機需要提供的控制信號的個數(shù)。除了端口選擇的要求外，還應(yīng)該滿足單片機的運行速度較高，處理信息及時穩(wěn)定，友好的開發(fā)環(huán)境，易于在市場上購得等條件。采用主--從式控制或是單--單片機控制都需要在試驗中驗證可靠性和簡易性。 7、設(shè)計穩(wěn)定準(zhǔn)確快速的巡線方法。這是本設(shè)計的關(guān)鍵技術(shù)問題，在傳感器檢測機器人所在位置的基礎(chǔ)上，制定穩(wěn)定、快速的行進方法。 第2章 智能巡線機器人總體方案設(shè)計 完整的機器人系統(tǒng)就是一個移動的測控系統(tǒng)，包括檢測部分、控制部分以及相應(yīng)的驅(qū)動部分。這幾個部分是彼此相互關(guān)聯(lián)的，檢測部分根據(jù)機械結(jié)構(gòu)選擇合理的檢測手段，驅(qū)動部分根據(jù)任務(wù)要求和機械結(jié)構(gòu)設(shè)計相應(yīng)的驅(qū)動電路，控制部分則需從機械結(jié)構(gòu)、檢測手段、驅(qū)動方法綜合考慮。 2．1 機器人要素分析 智能巡線機器人裝備包含以下幾個要素：機械機構(gòu)、動力與驅(qū)動單元、執(zhí)行機構(gòu)、傳感測試單元以及信息處理與控制單元五個部分。 這五個基本組成要素可以與人體的五大要素進行對比，如圖2-1所示。 圖2-1 機器人設(shè)備與人體五大要素比較圖 機械機構(gòu)的作用類似于人體的骨骼。包括工作模塊以及裝備所有功能元素的機械支持結(jié)構(gòu)以及機身、框架、連接等。機械機構(gòu)要在結(jié)構(gòu)、材料、加工工藝性以及幾何尺寸等方面可靠、小型、輕量、美觀等要求。 傳感與測試單元的作用相當(dāng)于人體的五官，對裝備本身和外界環(huán)境的各種參數(shù)及狀態(tài)進行檢測，并將其變換成可識別信號，傳輸?shù)叫畔⑻幚韱卧?。它由各種類型的傳感器和信號處理電路或測試儀表構(gòu)成。傳感器與測試單元的主要問題在于提高可靠性、靈敏度和精密度。而提高可靠性的關(guān)鍵在于提高抗干擾能力。傳感器包括光電傳感器（巡線和計數(shù)）、超聲波傳感器（檢測是否到達(dá)目標(biāo)和有無障礙物）。 執(zhí)行機構(gòu)相當(dāng)于人體的手和足。它根據(jù)控制單元的指令，快速高精度地完成要求的動作。目前常用的執(zhí)行機構(gòu)是電磁式、液壓式和氣動式機構(gòu)。此外，還有一些新型的執(zhí)行機構(gòu)如超聲波驅(qū)動器、形狀記憶合金驅(qū)動器等。執(zhí)行機構(gòu)需要根據(jù)機器人裝備的匹配性要求，考慮改善性能，如何提高精度和快速性，減輕重量，實現(xiàn)組件化、標(biāo)準(zhǔn)化和系列化，提高系統(tǒng)整體的可靠性。 動力和驅(qū)動單元相當(dāng)于人體的內(nèi)臟或肌肉。它在控制單元作用下，提供動力驅(qū)動和各種執(zhí)行機構(gòu)完成要求的動作和功能。機器人裝備一方面要求驅(qū)動的高效率和快速反應(yīng)特性，同時要求對水、油、溫度、塵埃等外部環(huán)境的適應(yīng)性和可靠性。智能巡線機器人的動力單元包括步進和直流電機。 信息處理與控制單元相當(dāng)于人體中的頭腦。將來自傳感器與測試單元的檢測信息和外部輸入命令進行集中、存貯、分析、加工，根據(jù)信息處理結(jié)果和預(yù)設(shè)的控制算法，發(fā)出相應(yīng)的指令控制整個系統(tǒng)有目的地運行。一般由計算機、可編程控制器（PLC）和計算機外部設(shè)備等組成。機器人系統(tǒng)對控制和信息處理單元的基本要求是：提高信息處理速度，提高可靠性，增強抗干擾能力以及完善系統(tǒng)自我診斷功能，實現(xiàn)信息處理智能化和小型、輕量、標(biāo)準(zhǔn)化等。 2．2 機器人總體分析 2．2．1 場地分析 智能巡線機器人是在針對特定的場地，找到適合自身機械特點的定位方法，通過不斷調(diào)整到達(dá)目標(biāo)，最終完成設(shè)定的任務(wù)。如何采用簡潔、快速、穩(wěn)定的控制方法和檢測設(shè)備是機器人的關(guān)鍵。它是在深色地板上放置白色引導(dǎo)線，特點是地面必須與引導(dǎo)線呈鮮明對比。機器人通過傳感器循跡，實時反映巡線信息直到CPU發(fā)出中斷請求停止循跡。一般的工廠不可能絕對無障礙物，為了避免機器人碰撞損傷，機器人需具有蔽障能力和終點停止的功能。 2．2．2 機械結(jié)構(gòu)分析 智能巡線機器人是用于運送貨物，它的承載能力為150kg。將機器人設(shè)計為小車形式，這樣運送貨物就更加的方便。為滿足運動的準(zhǔn)確性，避免在轉(zhuǎn)彎的時候因慣性而偏出路線導(dǎo)致巡線失敗，所以機器人的自身重量<=50kg。裝貨箱的尺寸和形狀可以根據(jù)實際情況來定，這樣既能充分的滿足設(shè)計的要求，又能使控制的原理更加的簡單可靠。底盤是設(shè)計的關(guān)鍵，因為底盤車輪配置方式?jīng)Q定著巡線算法的簡易程度和可靠程度。 2．2．3 控制系統(tǒng)框架設(shè)計 對于控制系統(tǒng)模塊，光電傳感器獲取機器人位置姿態(tài)信息，超聲波傳感器判斷是否到達(dá)目的地和前面是否有障礙物。機器人行走或做其它運動都需要電機將電能轉(zhuǎn)化為機械能。 如圖2-2所示，CPU根據(jù)傳感器檢測發(fā)送的信號，控制電機轉(zhuǎn)動，便可調(diào)整機器人運動。由此構(gòu)成了機器人測控系統(tǒng)。 圖2-2 控制系統(tǒng)框架圖 2．2．4 運動姿態(tài)分析 機器人的性能好與壞，通常都是指它能不能快捷的完成指定的任務(wù)，智能巡線機器人則是要求它能夠準(zhǔn)確的按照指定的路線行走，不會現(xiàn)出相晃動或偏移。分析它在運行的過程可能出現(xiàn)的狀態(tài)，設(shè)計出相應(yīng)的策略， 就可以解決這些問題。 第3章 機械結(jié)構(gòu)設(shè)計 機械部分是機器人運行的載體，設(shè)計性能良好的機械結(jié)構(gòu)，將有利于簡化機器人控制算法的設(shè)計，并且機構(gòu)在執(zhí)行過程中可以很好的實現(xiàn)控制精度。在這一章里，將分別論述了車輪配置方式、底盤和尺寸。 3．1 智能機器人的車輪驅(qū)動配置 機器人的運動方式有輪式、履帶式和步行方式。輪式和履帶式機器人適合于條件較好的路面，而步行機器人則適合條件較差的路面。為了適應(yīng)各種路面的情況，可采用輪、腿、履帶并用。在本節(jié)中主要討論各種方式的車輪驅(qū)動配置類別的特點，并且根據(jù)本課題的需要選擇恰當(dāng)?shù)尿?qū)動配置方式。 3．1．1 機器人常用車輪驅(qū)動配置介紹 1、獨輪驅(qū)動配置方式 其原理上不僅可以在平地行走，也可以在不平整的地面和傾斜的地面上行走。車體的轉(zhuǎn)彎可以利用伴隨陀螺儀加速、減速的反力矩。由于其在穩(wěn)定性方面的弊病，將獨輪機構(gòu)應(yīng)用于機器人上面基本沒有實用性。 2、兩輪驅(qū)動配置方式 兩輪驅(qū)動配置的簡圖如下圖3-1所示： 圖3-1 兩輪車簡圖 將自行車或摩托車用于機器人的試驗很早就有人進行了。主要依靠手的操作和體重的移動力求穩(wěn)定行走，這種陀螺兩輪車，把車體傾斜成比例的力矩作用在軸系上，利用陀螺效果使車體穩(wěn)定。但是這種結(jié)構(gòu)的機器人的速度、傾斜等物理量檢測、控制精度很難提高。另外在這種機器人上使用相對簡單，可靠性高的傳感器也很難，而且制動或者低速時的穩(wěn)定性極難保證，所以目前的研究基本上提留在提高穩(wěn)定性能力的試驗上面。 3、三輪配置的驅(qū)動方式 從理論上講，三點決定一個平面，因此輪式移動載體的平穩(wěn)運動至少需要3個輪子支撐，所以3輪配置的驅(qū)動方式是輪式機器人的基本移動機構(gòu)。三輪配置驅(qū)動主要方式如下圖3-2所示： 圖3-2 三輪移動配置方式 典型三輪移動機器人通常采用1個中心輪和2個后輪的車輪布置，要解決的主要問題是移動方向和速度的控制。3個車輪配置與功能的不同組合又可以將3輪機器人分為圖3-2所示的若干類型。 圖3-2(a)所示為雙輪驅(qū)動移動機器人，其組合是前輪 1 為可以任意方向滾動的小腳輪，小腳輪的作用是使車體穩(wěn)定，但會給車體帶來力學(xué)上的干擾沖突，后輪 2 和后輪 3 為獨立驅(qū)動輪，利用它們的轉(zhuǎn)速差實現(xiàn)轉(zhuǎn)向。這種組合的特點是機構(gòu)組合容易，而且當(dāng)兩個驅(qū)動輪以相同速度、相反方向轉(zhuǎn)動時車體能繞兩個驅(qū)動輪連線的中點自轉(zhuǎn)，但自轉(zhuǎn)中心與車體中心不一致。 圖3-2(b)的組合是操舵機構(gòu)和驅(qū)動機構(gòu)集中在前輪 1 上，2個后輪只起支撐從動的作用。與圖 3-2(a)相比，該機構(gòu)也能繞 2個后輪連線的中點自轉(zhuǎn)，但其前輪驅(qū)動集中，結(jié)構(gòu)比較復(fù)雜。 圖3-2(c)的車輪配置組合是前輪 1操舵輪，后輪 2 和后輪 3 中一個為驅(qū)動輪，另一個為從動輪。這種車輪機構(gòu)的特點是結(jié)構(gòu)簡單，組成容易，但單邊驅(qū)動的驅(qū)動性差，穩(wěn)定性不好，不能自轉(zhuǎn)。 圖3-2(d)的車輪組合將圖3-2(c)的單輪驅(qū)動改為雙后輪差動驅(qū)動，提高了驅(qū)動性，但加了一個差動齒輪裝置，使結(jié)構(gòu)更復(fù)雜，也增加了質(zhì)量。 三輪結(jié)構(gòu)比較簡單，能夠滿足一般的需要，應(yīng)用也比較廣泛。其轉(zhuǎn)向裝置的結(jié)構(gòu)通常有兩種方式：（1）鉸軸轉(zhuǎn)向式：轉(zhuǎn)向輪裝在轉(zhuǎn)向鉸軸上，轉(zhuǎn)向電機通過減速器和機械連桿機構(gòu)控制鉸軸從而控制轉(zhuǎn)向輪的轉(zhuǎn)向。（2）差速轉(zhuǎn)向式：在移動裝置的左右輪上分別裝上兩個獨立的驅(qū)動電機，通過控制左右輪的速度比來實現(xiàn)車體的轉(zhuǎn)向。在這種情況下，非驅(qū)動輪應(yīng)為自由輪。 4、四輪配置的驅(qū)動方式 四輪移動機構(gòu)的典型配置形式如下圖3-3所示。 圖3-3 四輪移動機構(gòu)的典型配置 圖3-3(a)的組合是前后輪均為萬向腳輪或球形輪，左右兩輪為獨立的驅(qū)動輪。與圖3-2(a)的三輪車體相比，其自轉(zhuǎn)中心與車體中心重合，當(dāng)兩個驅(qū)動輪以相反速度方向轉(zhuǎn)動時，車體能繞自身的中心自轉(zhuǎn)，所以便于在狹長的場所改變方向，這種車輪布置方式在靈活性和穩(wěn)定性上都是比較好的，但它的缺點是前后輔助腳輪有時不能同時著地支撐，在高速啟動和剎車時車體會產(chǎn)生俯仰和前沖。 圖3-3(b)是常見的汽車車輪配置方式。它與圖3-2(d)所示的三輪車驅(qū)動方式類似，只是將前面一個操舵機改為兩個輪子，提高了車體的穩(wěn)定性。兩個操舵輪需要同一個操舵機構(gòu)來協(xié)調(diào)轉(zhuǎn)向，此外為了減少后輪的摩擦損耗，配備了差動齒輪裝置，增加了機構(gòu)的復(fù)雜性。 四輪配置方式的轉(zhuǎn)向方式和三輪配置方式的方法基本相同。 3．1．2 本系統(tǒng)所采用的車輪驅(qū)動方式配置 在參考常用車輪驅(qū)動方式配置的基礎(chǔ)上，結(jié)合具體系統(tǒng)的實際情況做出適合本系統(tǒng)的最佳選擇，當(dāng)然這種選擇不是一個方面的最優(yōu)，但是它必須是在考慮到各種實際情況（如機器人車體的載重、材質(zhì)、控制方法以及加工手段）之后的一個最優(yōu)方案。在本設(shè)計中，機器人在搬運物塊過程中的穩(wěn)定性是我們要考慮的另外一個最為重要的因素。 從以上分析的關(guān)于機器人車體設(shè)計的兩個關(guān)鍵問題著手，我們知道三輪移動機構(gòu)配置的方式雖然簡單而且在實際應(yīng)用中比較多，但是結(jié)合本課題的具體實際情況，由于機器人的總重量比較大、重心較高，如果采取三輪移動機構(gòu)配置的方式，前面只有一個萬向輪，而萬向輪將和后面的驅(qū)動輪共同承擔(dān)機器人本身的重量，這將導(dǎo)致在轉(zhuǎn)向的過程中前面的萬向輪因為承重的原因摩擦力過大而不能靈活的完成轉(zhuǎn)向。而且從穩(wěn)定性的角度考慮，雖然三點可以決定一個平面，但是如果采用三輪的移動機構(gòu)配置方式，機器人在巡線時不斷調(diào)整車身以及轉(zhuǎn)彎時車體擺動是很大的，難免將機器人的重心改變到前輪和其中一個驅(qū)動輪中心的連線以外，這樣很容易造成機器人的側(cè)翻。綜合上面的考慮，在本系統(tǒng)中我們采用了四輪移動機構(gòu)的配置方式?？紤]圖3-3(a)所示，如果采用這種移動機構(gòu)配置方式，它的靈活性和穩(wěn)定性都是相當(dāng)好的，而且能夠使機器人在比較狹長的空間內(nèi)實現(xiàn)轉(zhuǎn)向。綜合圖3-3所示的兩幅四輪驅(qū)動配置圖，我們可以利用它們的優(yōu)點，去除它們的缺點，最終我們設(shè)計的機器人四輪移動機構(gòu)配置如下圖3-4所示。 圖3-4 本系統(tǒng)所用的四輪移動配置方式 本次機器人使用如上圖3-4所示的四輪移動配置方式，它充分綜合了圖3-2和圖3-3所示的四輪移動配置方式的優(yōu)點，既避免了使作用力過多的作用在一個輪子上，又有效防止了三個輪子配置所帶來的側(cè)翻問題，而且使生產(chǎn)加工更為方便，從多個方面解決了我們前面提到的要使機器人系統(tǒng)有很好的承重性能和穩(wěn)定性的問題。 3．2 機器人機械尺寸設(shè)計 1、設(shè)計要求： 底盤是安裝輪子和上層機構(gòu)的重要聯(lián)機部件，要求其十分牢固，與輪子和上層機構(gòu)可以緊密配合 2、結(jié)構(gòu)： 采用兩層機構(gòu):：第一層底盤裝萬向輪和驅(qū)動輪電機等；第二層底盤用于連接上層機構(gòu)。兩層之間用角鋁連接，采用了在同一連接處緊固兩個螺釘?shù)姆椒▉砑訌姀姸?。結(jié)構(gòu)如圖3-5和圖3-6所示： 圖3-5 兩層底盤 圖3-6 萬向輪和驅(qū)動輪的安裝圖 3、尺寸及分析： 第一層底盤的尺寸為：700mm×850mm 第二層底盤的尺寸為：680cm×750mm 兩層底盤間間距為： 100mm. 選擇兩層底盤間距離為100mm，主要是為了有足夠的空間安裝輪子，電路板布線和電機，防止兩者產(chǎn)生干擾。這樣，也使上層構(gòu)建更牢固。 寬度方向上選擇為750mm，在保證運行穩(wěn)定的情況下，為了減小體積和重量。 四川理工學(xué)院畢業(yè)設(shè)計 第31頁 第4章 傳感器接口電路設(shè)計 機器人需要感知外界的環(huán)境和自身的狀態(tài)信息，從而做出正確的判斷并告知CPU獲取相應(yīng)的信息。針對要求選用的傳感器類型有：超聲波傳感器、紅外光電反射式傳感器。紅外光電傳感器檢測巡線軌跡，超聲波傳感器檢測障礙物。 4.1機器人對巡線傳感器的要求 機器人對巡線傳感器的要求大致如下： 抗干擾性：不同的環(huán)境可能存在各種形式的強光干擾、電磁干擾、顏色干擾，必須有較好的抗干擾能力。 可調(diào)性：比賽場地上機器人的運行環(huán)境可能有別于當(dāng)初調(diào)試的環(huán)境，可能出發(fā)位置、燈光光照角度、日光光照情況均會變化，必須留有調(diào)節(jié)各種參數(shù)的環(huán)節(jié)，使得傳感器工作在最佳狀態(tài)。 穩(wěn)定性和快速性：一旦傳感器移動到引導(dǎo)條帶邊緣，傳感器應(yīng)當(dāng)及時、快速、穩(wěn)定地觸發(fā)，不允許有狀態(tài)的抖動，否則會引起機器人的搖晃。 成本低廉：對于機器人通用性來說，價格是一個重要的因素。盡管市售產(chǎn)品中有性能良好的光電傳感器，但是一般還是以自己開發(fā)制作為宜。 4．2 超聲波傳感器 4.2.1超聲波傳感器的原理 在相撲機器人之類的格斗型機器人中超聲波傳感器是經(jīng)常采用的傳感器之一，用來檢測對方的機器人的有無和距離。本次用到超聲波傳感器的目的是為了檢測是否有障礙物和有沒有到達(dá)目的地。其原理有如蝙蝠，它的嘴發(fā)出超聲波，當(dāng)超聲波遇到小昆蟲的時候，蝙蝠的耳朵能夠接受和反射回波，從而判斷餌食的位置和距離并給與捕殺。超聲波傳感器的工作方式是通過發(fā)送器（相當(dāng)于蝙蝠的嘴）發(fā)射出來的超聲波被物體反射后傳到接收器（相當(dāng)于蝙蝠的耳朵）接受來判斷是否檢測到物體。 超聲波傳感器的實物照片如圖4-1： 圖4-1 超聲波傳感器的實物 人的聽覺所能感覺的頻率范圍往往因人而異，大約為20Hz～20kHz。所謂超聲波，即空氣中傳播的超過人類聽覺頻率極限的聲波。kHz（千赫）代表一個頻率單位，20kHz即在1秒鐘內(nèi)來回振動2萬次的頻率狀態(tài)。眾所周知，超聲波的傳播速度V可以用以下式表示： V=331.5+0.6T（m/s） （4.1） 式中T(°C)為環(huán)境溫度，在23°C的常溫下超聲波的傳播速度為345.3m/s。超聲波傳感器一般就是利用這樣的超聲波來檢測物體的。 具體到超聲波傳感器的結(jié)構(gòu)，一般它的內(nèi)部都有一個振子，所謂振子是一塊金屬片上貼著壓電陶瓷，通過給壓電陶瓷加上電壓，它就會根據(jù)電壓的大小產(chǎn)生相應(yīng)的機械變形，進而產(chǎn)生機械振動，這就是所謂的壓電現(xiàn)象。超聲波傳感器就是利用這中原理實現(xiàn)超聲波的發(fā)射與接收的。 如圖4-2和圖4-3所示： 圖4-2 超聲波傳感器的結(jié)構(gòu) 圖4-3 振動模擬 超聲波傳感器也有透過式和反射式之分。超聲波傳感器不但可以檢測到物體，還可以通過發(fā)射器的回波返回接收器所需要的時間來測量距離。 4.2.2 超聲波的發(fā)射與接受電路 圖4-4是超聲波的發(fā)送和接受電路，將接受的信號通過運算直接輸送CPU芯片。 圖4-4 超聲波發(fā)送和接受電路 4．3 紅外光電反射式傳感器 機器人到達(dá)目標(biāo)可以選擇幾種方法： 1、根據(jù)起點與終點的位置關(guān)系，編制機器人行走路徑（通過制定步進電機轉(zhuǎn)動的步數(shù)或者通過直流電機編碼盤反饋控制電機轉(zhuǎn)動步數(shù)）。這種方法在工業(yè)機器人控制中比較普遍，可以非常精確的控制機器人關(guān)節(jié)運動位置和軌跡，但它對機械尺寸和穩(wěn)定性要求相當(dāng)高，機器人在制作中的同軸度、平行度、具體尺寸等必須滿足設(shè)計要求，不允許有偏差。 2、采用巡線的方法。所謂巡線指在白色引導(dǎo)條帶深色地板的環(huán)境下，沿條帶指示的路徑實現(xiàn)跟蹤運動的過程。 由于底盤安裝精度和后排左右驅(qū)動輪子之間的轉(zhuǎn)動速度在制作時并不能保證完全一致，一些關(guān)鍵部件的尺寸在手工制作時也不是嚴(yán)格遵循設(shè)計尺寸，因此即使驅(qū)動板向左右驅(qū)動電機輸出的功率相同，也會使機器人的中心線偏離引導(dǎo)線。所以，采用巡線是比較符合要求的。 巡線光電傳感器就是基于對場地及線路反射光的處理結(jié)果來識別路線的一類光電傳感器。根據(jù)巡線采用的光電傳感器原理不同，可分為兩種類型： 1、紅外光電反射式傳感器：根據(jù)反射光強度巡線。光電傳感器由一個發(fā)射光源和一個接收器（光敏二極管）組成。基于白線與場地底色反射光強的差異，導(dǎo)致輸出電壓不同，從而識別白線。 2、辨色傳感器：根據(jù)線路顏色巡線。當(dāng)條帶與場地底色的反射性能區(qū)別不明顯時，根據(jù)反射光強識別線路的效果不會很好，這時可以通過色彩識別來巡線。辨色傳感器的功能比較強，應(yīng)用面廣，工作穩(wěn)定，識別效果好，但是元件多，電路復(fù)雜，成本較高。 4．3．1 紅外光電反射式傳感器原理 紅外線的波長介于可見光和無線電波之間，大約0.76～1000 um。一般紅外光電反射式傳感器都選擇工作在近紅外區(qū)，即0.76～2.5 um段內(nèi)。大多數(shù)發(fā)光器件為880 nm、930nm兩個系列。880 nm較易受到外界光的干擾。 紅外發(fā)光管的材料一般為砷化鉀（GaAS）半導(dǎo)體。發(fā)光波長范圍0.76～1.5 um。小功率（小于100 mW）的管壓降為1.0～1.3 V，平均工作電流20～50 mA。紅外發(fā)光管有指向角、光軸、波長、輝度等性能指標(biāo)。 光敏元件常用光電二極管（也稱光敏二極管）與光電三極管（也稱光敏三極管），均為近紅外線接收管。它們接收到光的變化之后造成電流的改變，再經(jīng)過放大及相關(guān)處理，用于各種控制目的。 光電二極管是一種光電變換器件，當(dāng)光照到PN結(jié)上時，它能吸收光能將之轉(zhuǎn)變?yōu)殡娔堋Ｋ袃煞N工作狀態(tài)： 加反向電壓時，二極管中的電流隨光照強度的大小而改變，光照強度越大，反向電流越大； 不加電壓時，PN結(jié)受光照射作用，產(chǎn)生正向電壓，可充當(dāng)微型光電池。 在無光照情況下，光電二極管的正向電阻約10 kΩ，反向電阻為 ∞；有光照時，反向電阻隨光照強度增加而減小，阻值可達(dá)幾kΩ 或1 kΩ以下。無反壓時，正向電壓與光照強度成比例，一般可達(dá)0.2～0.4 V。 4．3．2 基于反射光強度測量的紅外光電反射式傳感器電路 如圖4-5所示，光電二極管工作在反向電壓下，當(dāng)無反射光照射或光照較弱時（即檢測到深色底色），電阻為 ∞。比較器的負(fù)端由于上拉了電阻，與地之間有阻值為∞的光電二極管隔開，所以此時2端的電壓值較高；當(dāng)反射光較強時（檢測到白色引導(dǎo)線），阻值下降到幾kΩ，在R6和D構(gòu)成的回路中，比較器的輸入端2口分得電壓，這時的電壓值較小。可見在檢測白色和深色時2端的電壓值是不同的，因此在比較端3口調(diào)整輸入一個合適的比較值就可以根據(jù)檢測的顏色在1端輸出相應(yīng)的信號值了。即當(dāng)檢測到深色時，通過比較器輸出低電平，經(jīng)過反向器輸出高電平，用于表示檢測到深色底色的指示燈亮；當(dāng)檢測到白色時，通過比較器輸出高電平，經(jīng)過反向器輸出低電平，指示燈滅。為了使辨色性能更好，采用增強光來加強效果，即每個接收管周圍放置四個紅色發(fā)光二極管，讓發(fā)射的光線中心部分好在接收管中心。經(jīng)試驗證明，這種增強光起到了很好的改善效果。 圖4-5 紅外光電反射式傳感器電路 在實際設(shè)計中，根據(jù)擺放位置和分模塊設(shè)計的需要，將光電二極管單獨布置于兩塊PCB板上如圖4-6，只輸出光電二極管是否導(dǎo)通的信號；后排同理，也至于另一塊PCB板上，可調(diào)電阻和比較器布置在另一塊PCB板上(圖4-7)，將光電二極管是否導(dǎo)通的信號轉(zhuǎn)化成相應(yīng)的高低電平。然后用扁線把他們連接起來，這樣達(dá)到了分模塊的構(gòu)想，也使得在不同的場地情況下，很方便快速地調(diào)節(jié)可調(diào)電阻部分。 圖4-6 置于板上光電二極管檢測電路 圖4-7 置于板上傳感器調(diào)節(jié)電路 4．4 紅外光電反射式傳感器布局 光電傳感器應(yīng)盡量靠近地面，以便減少外界光源對傳感器的入侵。一般垂直高度為5～10 mm。離地面過遠(yuǎn)，光反射效果差，信號不強；離地面過近，會導(dǎo)致反射角度太大，加劇光漫射干擾的影響，故應(yīng)適當(dāng)，以保證傳感器具有最佳的反應(yīng)。 實際使用過程中總會遇到意想不到的問題，因此調(diào)試環(huán)節(jié)很重要。實際調(diào)試時可以先讓傳感器分別在兩種不同顏色的區(qū)域工作，觀察其正常電壓輸出，應(yīng)當(dāng)調(diào)整到兩種電壓有明顯區(qū)別的效果；然后讓傳感器在工作狀態(tài)下反復(fù)通過兩種顏色的邊界區(qū)，即由一個顏色區(qū)進入另一個顏色區(qū)，觀察輸出變化的幅度和響應(yīng)的靈敏度。通過調(diào)整發(fā)射光強度、各個傳感器距地面的距離和位姿、輸出放大倍數(shù)或增加調(diào)制電路，以獲取最佳效果。比賽現(xiàn)場調(diào)定也是改善光電傳感器性能重要的一步，因為實際場地與模擬現(xiàn)場的條件總會存在差別，要在電路中備留臨時可調(diào)整環(huán)節(jié)，這就是為什么要把調(diào)節(jié)電路單獨布置在一塊PCB上的原因。 光電傳感器的布置及線路設(shè)置與使用傳感器的目的有關(guān)。若只是要求機器人不偏離路線，在行走方向的兩側(cè)各安一個或一組（3～5個）傳感器以控制機器人的左右偏轉(zhuǎn)就可；若要求機器人時刻紀(jì)錄巡線信息，可將光電傳感器排成一條線（直線形或弧線形皆可），由傳感器的返回信息可以判斷哪個在線上，通過計算就可以求出偏離的大概方位；若要求機器人從一個或多個方向接近路線時都能計算出位置信息，則可將傳感器安裝成圓形，結(jié)合機器人的旋轉(zhuǎn)角度就可計算出相對于路線的位置。 當(dāng)光電傳感器檢測到的顏色是路面底色(深色)時向單片機輸出高電平；當(dāng)檢測到的顏色是引導(dǎo)線顏色（白色）時向單片機輸出低電平。這些向單片機輸入的高低電平實際是底盤與引導(dǎo)線的相對位置的表征量，單片機根據(jù)這些表征量來做出調(diào)整輸出，通過電機驅(qū)動電路控制直流電機的起或停。 由于機器人的底盤整體較大，所以布置在底盤的傳感器應(yīng)盡量多，這樣可以檢測到底盤的多個位置，做出相應(yīng)位置的快速響應(yīng)。 圖4-8傳感器布局圖 如圖4-8所示傳感器布置方法，傳感器采用20個，其中18個用于機器人姿態(tài)定位，2個為超聲波傳感器檢測有無障礙和是否到達(dá)目的地。前后兩排傳感器分別居于前后輪的中心線上.在這種排布方式下，某排傳感器檢測到水平白色引導(dǎo)線時，對應(yīng)該排的輪中心剛好在白色引導(dǎo)線上，可方便轉(zhuǎn)彎和在交叉引導(dǎo)線處及時調(diào)整。每排每兩個傳感器的間距為30 mm。對其標(biāo)號為～。 第5章 電機驅(qū)動電路設(shè)計 驅(qū)動部分是機器人運動的源動力，控制著機器人的運動方向和速度。設(shè)計性能穩(wěn)定、快速響應(yīng)CPU信號的電機驅(qū)動電路是機器人運動精度的重要保證。 5．1 驅(qū)動電機的選用 移動機器人的主動輪有多種驅(qū)動方式，其中采用電機加必要的傳動裝置應(yīng)用最為廣泛。驅(qū)動電機為小車移動提供動力源泉，傳動裝置具有調(diào)速、改變運動方式、方向等作用。利用電壓、電流、頻率（包括指令脈沖）等控制方式，可以實現(xiàn)定速或變速驅(qū)動、反復(fù)起停的增量驅(qū)動以及復(fù)雜驅(qū)動。 目前常用的控制電機有：電壓控制感應(yīng)電動機（制動電動機或兩相伺服電動機）、電壓控制直流電動機（DC伺服電動機）、頻率控制同步（SM）電動機（步進型伺服電動機）、頻率控制感應(yīng)(IM)電動機（感應(yīng)型伺服電動機）、頻率控制磁阻電動機（步進電動機）等，每種電機又衍生出不同的小類型，不同電機的控制方式、特點和應(yīng)用場合也不相同。 本設(shè)計中考慮使用電機驅(qū)動車輪，且盡力縮小車體的體積，所以帶減速器的電機成為首選，這樣只需要將電機輸出軸和驅(qū)動輪連接起來即可。 目前移動機器人領(lǐng)域應(yīng)用較多的是步進電機和直流無刷電機（BLDC）兩種。步進電機是一種將電脈沖信號轉(zhuǎn)換成機械角位移模擬量的控制電機，其輸出的位移大小與輸入脈沖個數(shù)成正比且時間上與脈沖同步，通過改變脈沖頻率調(diào)節(jié)步進電機轉(zhuǎn)速。步進電機一般分為反應(yīng)式（VR）、用磁式（PM）和混合式（HM）三種。反應(yīng)式結(jié)構(gòu)簡單、工作可靠、運行頻率高但轉(zhuǎn)子阻尼大、噪聲大，步距角一般在1.50～150之間；永磁式功率小、效率高、價格低，步距角一般在7.50～180之間；混合式介于二者之間，具有步距角小、頻率高、功率小的有點，但結(jié)構(gòu)相對來說比較復(fù)雜，步距角一般在0.360～3.60之間。 直流無刷電動機（BLDC）通過位置傳感器檢測磁鋼位置后，控制相電流通斷實現(xiàn)電子換向，避免換向火花，且不產(chǎn)生電磁干擾，具有壽命長、運行可靠、維修簡便、變速不受換向條件限制、高速運行、調(diào)速范圍寬等優(yōu)點。如果采用PWM控制，只需要通過軟件改變PWM波的占空比就可實現(xiàn)調(diào)速，這對提高移動機器人在運動中的靈活性非常有用。另外，隨著具有PWM輸出的單片機在機器人控制器中的廣泛應(yīng)用，采用直流無刷電動機（BLDC）作為驅(qū)動電動機的越來越多。 對比二者的特點，尤其是考慮到使用單片機作為控制器時設(shè)計的可靠性，本設(shè)計的驅(qū)動電機就選用帶減速器的直流無刷電動機（BLDC）電機。 直流電機的優(yōu)點表現(xiàn)在以下方面： 1、 具有較大的轉(zhuǎn)矩，從而能夠克服傳動裝置的摩擦轉(zhuǎn)矩和負(fù)載轉(zhuǎn)矩； 2、 具有快速響應(yīng)能力，可以適應(yīng)復(fù)雜的速度變化和控制信號的變換； 3、 電機的負(fù)載特性硬，有較大的過載能力，確保運行速度不受負(fù)載沖擊的影響，增加的系統(tǒng)的可靠性； 4、 直流電機的空載力矩大，在控制系統(tǒng)發(fā)出停轉(zhuǎn)的同時可以立刻響應(yīng)，并且可以產(chǎn)生相當(dāng)大的力矩阻止機器人由于慣性繼續(xù)向前移動； 5、 直流電機具有很好的環(huán)境適應(yīng)能力。 除此之外，DC直流電機相對其他電機來說運動起來平穩(wěn)，而且噪聲小。 5.1.1電機減速器的選擇 這里選用上海朗能機電設(shè)備有限公司生產(chǎn)的ZYT60-JB80永磁直流電機。其主要技術(shù)參數(shù)是： Unom=24V； Inom=4.8A ； nnom=2500r/min；Pnom=90W，Gnom =1:5～1:230。 具體的實物形狀如下圖所示 圖5-1 機器人巡線驅(qū)動用的直流電機及減速器 直流電機的低速性能是偏軟的，為使電機工作在穩(wěn)態(tài)下，必須根據(jù)巡線機器人的實際運行需要，選擇合適的減速器。另外電機的轉(zhuǎn)速比較高，對于巡線機器人來說，容易在轉(zhuǎn)彎的時候因慣性而循跡失敗，所以它的速度在6km/小時左右就可以滿足要求。 根據(jù)機器人中一些主要零件的參數(shù)，對其電機減速器的減速比計算如下： 后輪驅(qū)動輪的直徑：; 驅(qū)動輪走一周所滿足的路程：； （5.1） 速度V轉(zhuǎn)化為：； 由得：； （5.2） 減速比為：； 選取減速器的減速比為10，針對所選的減速器，對巡線機器人的移動速度進行再計算： 減速后輪子的轉(zhuǎn)速：； 輪子的轉(zhuǎn)速 ： ；（5.3） 經(jīng)過上面的校核計算，得知選用減速比為1：10的減速器滿足這次設(shè)計的需要。 經(jīng)過以上對電機和減速器相關(guān)分析計算后，我們可以最后確認(rèn)電機和減速器的型號。由于電機、減速器，輪子都要安裝在機器人的下面，當(dāng)機器人的體積和底面的面積是一定時，電機和輪子的尺寸也相應(yīng)地受到一定限制。為此采取的辦法是去掉電機到輪子中間的齒輪傳動機構(gòu)，取而代之的是與電機相配的小型減速器，該減速器安裝在電機上后，整個尺寸不過280作用長，直徑90mm左右，其質(zhì)量比較輕，大概為1.5kg，效率η取0.8，轉(zhuǎn)動慣量Ｊr取0.8=0.00011（kg·m·m）。 5.1.2 所選電機性能校核 在智能巡線機器人機構(gòu)中，由于需要一定側(cè)承重量以及加工制造的方便，驅(qū)動部分以及支持部分都采用扁鋼為材料，機器人結(jié)構(gòu)重量約為50kg，所承受貨物的上限為150kg,因而整車載重極限N為200kg。該載重極限由兩個萬向輪與兩個驅(qū)動輪共同分擔(dān)，機器人驅(qū)動輪受力如圖所示。 圖5-2 輪子的受力 驅(qū)動輪在減速器的驅(qū)動下，克服與地面間的摩擦力F1 旋轉(zhuǎn)前進，同時兩個轉(zhuǎn)向分別與地面間同樣在機體重力及貨物重力的作用下存在一定的摩擦力F2。當(dāng)F1 > F2 時,驅(qū)動輪才不至于打滑或空轉(zhuǎn)。初定驅(qū)動機構(gòu)雙輪承受重力的60%，兩個萬向輪承受其余的40%，取驅(qū)動輪輪胎與地面間的摩擦系數(shù)?=0.02，驅(qū)動輪直徑=15cm,支撐輪直徑D2=4cm. 單個驅(qū)動輪承受的正壓力： （5.4） 單個支撐輪承受的正壓力： （5.5） 單個驅(qū)動輪克服的摩擦力： （5.6） 單個支撐輪承受的摩擦力： （5.7） 在一定的轉(zhuǎn)矩作用下驅(qū)動輪克服摩擦力，則轉(zhuǎn)向輪處于從動狀態(tài)。而在轉(zhuǎn)彎的狀態(tài)下，一個驅(qū)動輪將推動兩個萬向輪運動，從而在這種要考慮兩個驅(qū)動輪的摩擦阻力。 機器人在運動時承受的最大阻力： （5.8） 機器人驅(qū)動所需的電機的功率：