您現(xiàn)在的位置:專區(qū)首頁(yè)>> 優(yōu)秀作品>>作品
輪式/四足可變形智能偵察機(jī)器人是一款能在較復(fù)雜地形環(huán)境下行走運(yùn)動(dòng)的偵察機(jī)器人,它是在輪式運(yùn)動(dòng)的車體上增加四足行走機(jī)構(gòu),通過(guò)車體變形達(dá)到行走模式轉(zhuǎn)變的目的,該機(jī)器人將輪式行走和四足行走兩種運(yùn)動(dòng)形式相結(jié)合,前者適于平坦地面的輪式快速移動(dòng),后者適于較復(fù)雜地面(如廢墟)上的四足行走。同時(shí)可通過(guò)自行設(shè)計(jì)的手持遙控器對(duì)機(jī)器人移動(dòng)及攝像頭云臺(tái)進(jìn)行控制,將獲得的傳感器數(shù)據(jù)及視頻實(shí)時(shí)傳至手持遙控器及上位計(jì)算機(jī)平臺(tái)。
1 控制系統(tǒng)的方案設(shè)計(jì)與實(shí)現(xiàn)
1. 1 嵌入式控制系統(tǒng)的設(shè)計(jì)
針對(duì)偵察行動(dòng)中對(duì)環(huán)境數(shù)據(jù)的采集和對(duì)機(jī)器人運(yùn)動(dòng)控制的雙重需求,以及對(duì)機(jī)器人跟隨式遙控和計(jì)算機(jī)監(jiān)控的要求,設(shè)計(jì)了一套控制系統(tǒng),包括:機(jī)器人本體控制系統(tǒng),手持式遙控器,上位計(jì)算機(jī)平臺(tái)監(jiān)控軟件。
機(jī)器人本體控制系統(tǒng)包括:負(fù)責(zé)為整機(jī)各個(gè)部分提供電能的電源系統(tǒng)、負(fù)責(zé)整機(jī)控制的主控制電路、負(fù)責(zé)所有傳感器數(shù)據(jù)采集的傳感器控制電路、控制舵機(jī)動(dòng)作的舵機(jī)控制器、控制電機(jī)動(dòng)作的電機(jī)控制器、負(fù)責(zé)同手持遙控器無(wú)線通訊的無(wú)線模塊和拍攝圖像的無(wú)線攝像頭。
手持式遙控器包括:負(fù)責(zé)遙控器控制的遙控板、負(fù)責(zé)同機(jī)器人及計(jì)算機(jī)端監(jiān)控軟件通信的無(wú)線模塊、顯示無(wú)線攝像頭所拍攝頭像的顯示系統(tǒng)、顯示環(huán)境數(shù)據(jù)的LCD及指示燈系統(tǒng)和負(fù)責(zé)發(fā)出命令信息的矩陣式鍵盤(pán)。
上位計(jì)算機(jī)平臺(tái)監(jiān)控軟件包括: 機(jī)器人運(yùn)動(dòng)姿態(tài)的顯示、遙控器所傳回?cái)?shù)據(jù)的顯示、機(jī)器人各參數(shù)的在線設(shè)置、對(duì)機(jī)器人環(huán)境進(jìn)行監(jiān)控的報(bào)警系統(tǒng)和與手持遙控器交換信息等功能。
1.2 嵌入式控制系統(tǒng)
嵌入式控制系統(tǒng)主要分三部分:安裝于機(jī)器人體內(nèi)的機(jī)器人本體控制系統(tǒng)、手持式遙控器和上位計(jì)算機(jī)平臺(tái)監(jiān)控軟件。
機(jī)器人本體控制系統(tǒng)
1. 主控制電路是整個(gè)機(jī)器人本體系統(tǒng)的核心,負(fù)責(zé)傳感器數(shù)據(jù)的接收,轉(zhuǎn)發(fā)及分析,遙控命令的執(zhí)行,直接控制機(jī)器人的運(yùn)動(dòng)姿態(tài)。
2. 傳感器控制電路、電機(jī)控制電路及舵機(jī)控制器的串口都與主控制電路的串口相連,通過(guò)自行設(shè)計(jì)的串口通信方向控制電路,主控制電路可以與各個(gè)控制電路分時(shí)通訊。
3. 電機(jī)控制電路和舵機(jī)控制器受主控制電路直接控制。
4. 傳感器控制電路循環(huán)掃描環(huán)境數(shù)據(jù),將數(shù)據(jù)按照通信協(xié)議傳給主控制電路,主控制電路將數(shù)據(jù)通過(guò)無(wú)線模塊轉(zhuǎn)發(fā)給手持遙控器,同時(shí)進(jìn)行數(shù)據(jù)的分析。
5. 無(wú)線攝像頭將所攝圖像直接傳至手持遙控器上的接收機(jī)。
手持式遙控器
1. 遙控器電路是整個(gè)遙控系統(tǒng)的核心,負(fù)責(zé)從機(jī)器人處接收數(shù)據(jù)并顯示至LCD,同時(shí)將數(shù)據(jù)分析處理后轉(zhuǎn)發(fā)至計(jì)算機(jī)端監(jiān)控軟件。
2. 無(wú)線圖像接收機(jī)將接收到的圖像顯示在液晶屏上。
3. 通過(guò)矩陣鍵盤(pán),可以對(duì)機(jī)器人運(yùn)動(dòng)模式進(jìn)行設(shè)置或下達(dá)行動(dòng)命令,也可與計(jì)算機(jī)端軟件進(jìn)行通信。
上位計(jì)算機(jī)平臺(tái)監(jiān)控軟件
1. 機(jī)器人姿態(tài)顯示窗口,顯示機(jī)器人當(dāng)前的運(yùn)動(dòng)狀態(tài),是以輪式運(yùn)動(dòng),還是以四足行走。
2. 傳感器數(shù)據(jù)顯示窗口,顯示各個(gè)傳感器當(dāng)前數(shù)據(jù)。
3. 報(bào)警系統(tǒng),可對(duì)機(jī)器人各個(gè)方面進(jìn)行監(jiān)控,及時(shí)發(fā)出警報(bào)。可對(duì)預(yù)警值進(jìn)行設(shè)置。
4. 通信窗口,可與手持遙控器進(jìn)行信息交換。
2 機(jī)器人本體說(shuō)明
2. 1 運(yùn)動(dòng)機(jī)構(gòu)的創(chuàng)新性說(shuō)明
本課題研究的輪式/四足可變形復(fù)合式移動(dòng)機(jī)器人從結(jié)構(gòu)上講是一種新的設(shè)計(jì)結(jié)構(gòu)概念和創(chuàng)新,它可以更好的把兩種單一運(yùn)動(dòng)方式的移動(dòng)機(jī)器人的優(yōu)點(diǎn)相結(jié)合, 達(dá)到更佳的工作效率和實(shí)用價(jià)值。
首先,引用中心對(duì)稱結(jié)構(gòu)設(shè)計(jì):變?yōu)樗淖闶叫螒B(tài)時(shí),機(jī)器人轉(zhuǎn)向任何方向后不影響運(yùn)動(dòng)方式, 依然可以前后左右進(jìn)行相同運(yùn)動(dòng);變?yōu)檩喪叫螒B(tài)時(shí),前后對(duì)稱。
其次, 各個(gè)關(guān)節(jié)相互獨(dú)立,可單獨(dú)控制。
第三, 利用增加的自由度,可實(shí)現(xiàn)更好的姿態(tài)控制。例如,輪式形態(tài)時(shí),配合變形結(jié)構(gòu)可實(shí)現(xiàn)改變重心高度,傾斜機(jī)身,左、右轉(zhuǎn)彎;四足形態(tài)時(shí)可實(shí)現(xiàn)高重心行走和低重心行走。
第四,利用機(jī)器人可轉(zhuǎn)動(dòng)的支撐底盤(pán),可實(shí)現(xiàn)攝像頭的左右轉(zhuǎn)動(dòng)及機(jī)器人的原地轉(zhuǎn)身。
復(fù)合式移動(dòng)機(jī)器人在秉承了多種移動(dòng)機(jī)器人的優(yōu)點(diǎn)的同時(shí), 充分考慮到運(yùn)動(dòng)環(huán)境的影響, 對(duì)于不同的運(yùn)動(dòng)環(huán)境采用不同的運(yùn)動(dòng)方式, 以不同的運(yùn)動(dòng)方式各自的優(yōu)勢(shì)來(lái)應(yīng)對(duì)環(huán)境??梢愿鶕?jù)周圍環(huán)境的變化隨時(shí)調(diào)整運(yùn)動(dòng)姿態(tài),達(dá)到提高的運(yùn)動(dòng)效率的目的。例如同樣是輪式運(yùn)動(dòng),但可以調(diào)整機(jī)器人重心的高低和左右偏移。如在寬闊平坦的路上以輪式運(yùn)動(dòng)方式, 在狹縫中可以采用低重心的輪式運(yùn)動(dòng),當(dāng)路面不平整時(shí)可以改為四足行走。
也可根據(jù)偵查任務(wù)需要調(diào)整機(jī)器人的高低,進(jìn)而調(diào)整機(jī)身上攝像頭的視線范圍。例如,廢墟中有人困于一塊墻體下,機(jī)器人可身體放低,就可用攝像頭觀察廢墟中的情況。
2.2 運(yùn)動(dòng)模式說(shuō)明
整機(jī)自由度為17。
不同于一般四足機(jī)器人的單腿3自由度,本機(jī)器人單腿自由度為4,精確調(diào)整舵機(jī)動(dòng)作可更好地控制機(jī)器人姿態(tài),可原地轉(zhuǎn)向。
機(jī)器人底部支撐底盤(pán)自由度為1。
四足式運(yùn)動(dòng)方式主要用于不適合輪式移動(dòng)的崎嶇路面。本機(jī)器人四足式運(yùn)動(dòng)采用靜態(tài)步行方式:即在任一時(shí)刻至少有3 條腿與地面接觸,用于支撐機(jī)器人本體,且保證機(jī)器人重心落在三足支撐點(diǎn)構(gòu)成的三角形區(qū)域內(nèi)。
位于機(jī)器人中心有一個(gè)支撐底盤(pán),自由度為1,可以接觸地面支撐整個(gè)機(jī)器人的重量,使得四條機(jī)械腿可以離開(kāi)地面,進(jìn)而控制整個(gè)機(jī)器人的原地轉(zhuǎn)向。
輪式運(yùn)動(dòng)方式應(yīng)用于較平坦地面的快速移動(dòng)。通常采用上圖所示姿態(tài)的四輪驅(qū)動(dòng)方式運(yùn)行:將腳掌轉(zhuǎn)向機(jī)身外側(cè),膝關(guān)節(jié)收緊,旋轉(zhuǎn)二號(hào)臀關(guān)節(jié)使膝關(guān)節(jié)驅(qū)動(dòng)輪接觸地面,并支撐起來(lái)(如下圖),可用輪式在平面內(nèi)自由運(yùn)動(dòng)。輪式運(yùn)動(dòng)通過(guò)控制驅(qū)動(dòng)輪轉(zhuǎn)速來(lái)實(shí)現(xiàn)機(jī)體的速度控制;一號(hào)臀關(guān)節(jié)及二號(hào)臀關(guān)節(jié)可以調(diào)整驅(qū)動(dòng)輪之間相對(duì)位置,進(jìn)而控制行駛的位置和方向。同時(shí)利用PWM調(diào)速,可實(shí)現(xiàn)簡(jiǎn)單的差速驅(qū)動(dòng)。
2. 3 機(jī)器人結(jié)構(gòu)部件說(shuō)明
不銹鋼部件
機(jī)器人結(jié)構(gòu)零件用型號(hào)304不銹鋼激光切割后,用彎折機(jī)彎折而成。(附有部分結(jié)構(gòu)零件工程圖紙及部分機(jī)器人分解圖)
舵機(jī)
本機(jī)器人采用的舵機(jī)產(chǎn)品型號(hào)為T(mén)OWERPRO MG995及9805MG,金屬齒輪,采用6伏電壓供電,力矩分別為13kg.cm和25kg.cm。
MG995安裝于一號(hào)臀關(guān)節(jié)、腳掌關(guān)節(jié)及支撐底盤(pán)。
9805MG安裝于二號(hào)臀關(guān)節(jié)及膝關(guān)節(jié)。
直流電機(jī)
本作品采用的直流電機(jī)調(diào)速性能好,起動(dòng)力矩大,采用降電壓起動(dòng)。即由單獨(dú)的可調(diào)壓直流電源對(duì)電機(jī)電樞供電,結(jié)合PWM、既可使電機(jī)平滑起動(dòng),又能實(shí)現(xiàn)調(diào)速。
2. 4 嵌入式控制系統(tǒng)
系統(tǒng)整體功能說(shuō)明
如下圖為本系統(tǒng)的原理組成框圖,主要由主控制電路、串口方向選擇電路、傳感器控制電路、超聲波模塊控制電路、電源電路、電機(jī)控制電路、以及輔助電路組成。其中主控制電路、傳感器控制電路和電機(jī)控制電路主要由MCU及時(shí)序電路組成,負(fù)責(zé)相應(yīng)電路的時(shí)序控制、通信控制和數(shù)據(jù)處理;而串口方向選擇電路、超聲波模塊控制電路主要由組合邏輯電路組成,為系統(tǒng)提供高速的通信線路配置服務(wù)。電源電路則包含整個(gè)系統(tǒng)的電源供電接口,以及無(wú)線數(shù)傳模塊的3.3V供電電源。輔助電路則為系統(tǒng)提供一些輔助性服務(wù),比如復(fù)位、指示燈等。
(附有整體系統(tǒng)PCB圖)
串口通信方向選擇電路
本系統(tǒng)使用多個(gè)單片機(jī)進(jìn)行協(xié)作的,各MCU各司其責(zé),需要相互通信。一般情況下單片機(jī)系統(tǒng)的通信可以使用傳統(tǒng)單片機(jī)多機(jī)通信協(xié)議來(lái)實(shí)現(xiàn)的,但是本系統(tǒng)涉及到要與舵機(jī)控制器進(jìn)行通信的問(wèn)題。舵機(jī)控制器負(fù)責(zé)控制機(jī)器人執(zhí)行動(dòng)作,也通過(guò)串口與控制系統(tǒng)進(jìn)行通信。單片機(jī)通過(guò)串口向舵機(jī)控制器發(fā)送動(dòng)作指令,舵機(jī)就會(huì)執(zhí)行相應(yīng)的動(dòng)作。如果還是使用傳統(tǒng)的多機(jī)通信協(xié)議,由于舵機(jī)控制器無(wú)法識(shí)別協(xié)議,將會(huì)導(dǎo)致舵機(jī)執(zhí)行錯(cuò)誤的動(dòng)作。
因此有必要設(shè)計(jì)一個(gè)串口通信方向選擇電路,由主控MCU來(lái)進(jìn)行通信方向選擇,保證系統(tǒng)不發(fā)生錯(cuò)誤動(dòng)作,而且設(shè)計(jì)增加一個(gè)這樣的電路有利于波特率不同的子系統(tǒng)之間進(jìn)行通信。
(1)RXD選擇電路
RXD是單片機(jī)串口的數(shù)據(jù)接收端,這里特指主控制MCU的串口接收端。由于其通信方向是固定的,因此可以使用數(shù)據(jù)選擇器實(shí)現(xiàn)電路功能。本電路使用四選一數(shù)據(jù)選擇器74HC153實(shí)現(xiàn)數(shù)據(jù)選擇功能。被選擇的數(shù)據(jù)為子系統(tǒng)MCU的串口數(shù)據(jù)發(fā)送端TXDn。當(dāng)子系統(tǒng)要求發(fā)生通信時(shí),先申請(qǐng),再由主控制MCU建立連接后便可進(jìn)行通信。
(2)TXD分配電路
TXD是單片機(jī)串口的數(shù)據(jù)發(fā)送端,這里特指主控制MCU的串口數(shù)據(jù)發(fā)送端。由于其數(shù)據(jù)傳輸方向是固定的,因此可以使用數(shù)據(jù)分配器實(shí)現(xiàn)其功能。本系統(tǒng)是使用2-4數(shù)據(jù)分配器/譯碼器74HC139實(shí)現(xiàn)數(shù)據(jù)分配功能。其數(shù)據(jù)輸入端為使能端E,當(dāng)E為高電平時(shí),芯片的輸出端為高電平,當(dāng)E變?yōu)榈碗娖綍r(shí),被選中的輸出端變?yōu)榈碗娖剑瑥亩鴮?shí)現(xiàn)數(shù)據(jù)分配功能。被分配的數(shù)據(jù)的目的端口就是子系統(tǒng)MCU的串口數(shù)據(jù)接收端RXDn。當(dāng)子系統(tǒng)要求發(fā)生通信時(shí),先申請(qǐng),再由主控制MCU建立連接后便可進(jìn)行通信。
主控制電路
主控制電路是機(jī)器人本體控制系統(tǒng)的核心,主要負(fù)責(zé)舵機(jī)控制、命令下達(dá)、數(shù)據(jù)處理、全局控制、通信控制等,是整個(gè)系統(tǒng)的控制中心。負(fù)責(zé)接收傳感器傳回?cái)?shù)據(jù)及接受遙控器的命令,可對(duì)舵機(jī)控制器、電機(jī)控制器直接下達(dá)命令。(后附有主控制電路部分核心代碼)
通信部分
主控要和數(shù)據(jù)采集模塊,舵機(jī)控制器,無(wú)線數(shù)傳模塊進(jìn)行通信,其過(guò)程為不斷從數(shù)據(jù)采集模塊獲得環(huán)境采集數(shù)據(jù),進(jìn)行相應(yīng)的判斷,針對(duì)分析結(jié)果發(fā)送相應(yīng)的控制命令,同時(shí)控制無(wú)線數(shù)傳模塊把相關(guān)信息發(fā)給遙控器和計(jì)算機(jī)端軟件。
數(shù)據(jù)分析部分
這一部分主要體現(xiàn)在程序設(shè)計(jì)上,通過(guò)分析障礙物和機(jī)器人的距離判斷是否遇到了臺(tái)階等的障礙物,另一方面對(duì)溫度數(shù)據(jù)進(jìn)行比較判斷是否進(jìn)入了異常的環(huán)境。
傳感器控制電路
傳感器控制電路是機(jī)器人的感知系統(tǒng),是直接對(duì)傳感器進(jìn)行操作并獲取相關(guān)數(shù)據(jù)的電路。電路由STC89C58組成控制元件,負(fù)責(zé)時(shí)序控制、數(shù)據(jù)獲取、與其他電路交換信息,并負(fù)責(zé)部分?jǐn)?shù)據(jù)處理任務(wù)。與MCU直接相連的芯片為ADC0809,它是光線傳感電路的核心元件,負(fù)責(zé)光強(qiáng)數(shù)據(jù)的采集。它也控制著超聲波選擇電路(第27頁(yè)有詳細(xì)說(shuō)明)。
電機(jī)控制電路
電機(jī)控制電路負(fù)責(zé)驅(qū)動(dòng)電機(jī)的速度控制及數(shù)據(jù)通信。其作用為產(chǎn)生PWM信號(hào)控制電機(jī)控制器,進(jìn)而控制電機(jī)的轉(zhuǎn)速。該電路的核心元件為STC14C5410,該芯片具有四路PWM輸出可以對(duì)機(jī)器人的四個(gè)驅(qū)動(dòng)輪進(jìn)行差速控制。其內(nèi)置的AD轉(zhuǎn)換模塊也可應(yīng)用到相關(guān)電路中,方便拓展更多功能,例如對(duì)驅(qū)動(dòng)輪進(jìn)行測(cè)速等。
其他電路
包括電源接口、無(wú)線數(shù)傳模塊穩(wěn)壓電源電路及接口電路、濾波電容、蜂鳴器控制電路、指示燈電路、復(fù)位電路等。這些電路能對(duì)系統(tǒng)電路的工作提供必要的輔助。
舵機(jī)控制器
此舵機(jī)控制器是整個(gè)機(jī)器人動(dòng)作控制的核心部件,是本機(jī)器人實(shí)現(xiàn)對(duì)復(fù)雜地形適應(yīng)能力的基礎(chǔ)。
本機(jī)器人利用了舵機(jī)控制器的17路輸出來(lái)控制機(jī)器人各個(gè)關(guān)節(jié)。
數(shù)模轉(zhuǎn)換模塊
本機(jī)器人利用此模塊實(shí)現(xiàn)了對(duì)5個(gè)光敏電阻的數(shù)據(jù)轉(zhuǎn)換。
ADC0809 是帶有8位A/D 轉(zhuǎn)換器、8 路多路開(kāi)關(guān)以及微處理機(jī)兼容的控制邏輯的CMOS 組件。它是逐次逼近式A/D 轉(zhuǎn)換器,可以和單片機(jī)直接接口。
在轉(zhuǎn)換期間,ST 應(yīng)保持低電平。EOC 為轉(zhuǎn)換結(jié)束信號(hào)。當(dāng)EOC 為高電平時(shí),表明轉(zhuǎn)換結(jié)束;否則,表明正在進(jìn)行A/D 轉(zhuǎn)換。OE 為輸出允許信號(hào),用于控制三條輸出鎖存器向單片機(jī)輸出轉(zhuǎn)換得到的數(shù)據(jù)。OE=1,輸出轉(zhuǎn)換得到的數(shù)據(jù);OE=0,輸出數(shù)據(jù)線呈高阻狀態(tài)。D7-D0 為數(shù)字量輸出線。CLK 為時(shí)鐘輸入信號(hào)線。因ADC0809 的內(nèi)部沒(méi)有時(shí)鐘電路,所需時(shí)鐘信號(hào)必須由外界提供,通常使用頻率為500KHZ,VREF(+),VREF(-)為參考電壓輸入。
光強(qiáng)傳感器
本機(jī)器人使用光敏電阻檢測(cè)環(huán)境中的光強(qiáng),通過(guò)ADC0809轉(zhuǎn)換為數(shù)字信號(hào)進(jìn)行相關(guān)的處理和控制,其中光敏電阻和AD的連接電路如下圖所示。
器件簡(jiǎn)介:光敏電阻是根據(jù)半導(dǎo)體的光電導(dǎo)效應(yīng)制成的。它所用的材料主要有:硒、硫化鎘、硫化鋁、硫化鉍、硒化鎘、硒化鋅、砷化鎵、硅等。其中對(duì)可見(jiàn)光敏感的硫化鎘光敏電阻是最有代表性的一種。光敏電阻在使用時(shí),可以加直流偏壓,也可以加交流偏壓,它的電流隨電壓呈線性變化。光敏電阻在無(wú)光照時(shí),其暗阻值一般大于1500 kΩ ,在有光照時(shí),其亮阻值為幾千歐,兩者相差大。
溫度傳感器 DS18B20
本機(jī)器人采用一共5個(gè)溫度傳感器進(jìn)行對(duì)機(jī)器人自身溫度和環(huán)境溫度的測(cè)量。
簡(jiǎn)介:此處使用度傳感器是DS18B20數(shù)字溫度計(jì),它是DALLAS公司生產(chǎn)的1-Wire,即單總線器件,具有線路簡(jiǎn)單,體積小的特點(diǎn)。因此用它來(lái)組成一個(gè)測(cè)溫系統(tǒng),具有線路簡(jiǎn)單,在一根通信線,可以連接多個(gè)數(shù)字溫度計(jì),十分方便。
本機(jī)器人利用了DS18B20產(chǎn)品的如下特點(diǎn):
(1)用一個(gè)端口即可實(shí)現(xiàn)通信。
(2)每個(gè)DS18B20中都有獨(dú)一無(wú)二的序列號(hào)。
(3)實(shí)際應(yīng)用中不需要外圍電路即可實(shí)現(xiàn)測(cè)溫。
超聲波測(cè)距系統(tǒng)
超聲波模塊
采用壓電脈沖反射式超聲波收發(fā)器。
超聲波模塊控制電路
一個(gè)超聲波模塊要占用兩位IO口,而本系統(tǒng)所使用的超聲波模塊的數(shù)量達(dá)到16個(gè),因?yàn)槌暡K無(wú)使能端,無(wú)法復(fù)用端口,若模塊直接與單片機(jī)相連,將會(huì)占用單片機(jī)32位I/O口,且這些I/O將無(wú)法和其他部件共用。為了節(jié)約端口資源,提高M(jìn)CU資源的利用率,必須設(shè)計(jì)添加超聲波模塊控制電路。
(1)TX端口分配電路
TX是單片機(jī)向超聲波模塊發(fā)送信號(hào)的端口,其數(shù)據(jù)方向是固定的,因此可以使用數(shù)據(jù)分配器來(lái)實(shí)現(xiàn)電路功能。TX端口分配電路的原理圖如圖1的下半部分所示。其核心元件是3-8譯碼器74HC138,由兩片74HC138組成4-16數(shù)據(jù)分配器。
由于74HC138的輸出端口在沒(méi)有選通的情況下是輸出高電平的,這樣會(huì)造成超聲波模塊誤觸發(fā),不斷地發(fā)送超聲波干擾正在工作的模塊,因此要在74HC138的輸出端接上非門(mén)。74HC138的輸入數(shù)據(jù)是從使能端OE1輸入的,這是為了保證數(shù)據(jù)相位的正確,當(dāng)OE1為高電平時(shí),芯片上被選擇的輸出端變?yōu)榈碗娖?,?duì)應(yīng)的非門(mén)就會(huì)輸出高電平;當(dāng)OE1為低電平時(shí),芯片的輸出端變?yōu)楦唠娖?,?duì)應(yīng)非門(mén)變?yōu)榈碗娖?,這就實(shí)現(xiàn)了數(shù)據(jù)分配功能。非門(mén)U1A輸入端為地址端的最高位A4,通過(guò)這個(gè)非門(mén)對(duì)兩個(gè)芯片的使能端OE2A和OE2B的控制,就可以把兩片3-8數(shù)據(jù)分配器組合成4-16數(shù)據(jù)分配器。
(2)RX端口選擇電路
RX是超聲波向單片機(jī)發(fā)送數(shù)據(jù)的端口,其數(shù)據(jù)傳輸方向是固定的,因此可以用數(shù)據(jù)選擇器來(lái)實(shí)現(xiàn)電路功能。RX端口選擇電路的原理圖如圖1的上半部分所示。其核心元件是8選1數(shù)據(jù)選擇器74HC151,由兩片74HC151組成16選1數(shù)據(jù)選擇器。
非門(mén)U1A輸入端為地址端的最高位A4,通過(guò)這個(gè)非門(mén)對(duì)兩個(gè)芯片的使能端STB的控制,就可以把兩片8選1數(shù)據(jù)選擇器組合成16選1數(shù)據(jù)選擇器。為了避免邏輯錯(cuò)誤,兩片8選1數(shù)據(jù)選擇器的輸出端需使用或門(mén)來(lái)進(jìn)行端口合并。
軟件控制系統(tǒng)
硬件系統(tǒng)必須配上適當(dāng)?shù)目刂栖浖到y(tǒng)才能正常工作。對(duì)本功能電路進(jìn)行控制的程序使用C語(yǔ)言編寫(xiě),統(tǒng)一放在頭文件中,其接口函數(shù)為:
unsigned char readdis(unsigned char n);
這個(gè)函數(shù)的返回值就是以厘米為單位的整數(shù)距離值,這個(gè)值的最大值為255cm,已經(jīng)能滿足系統(tǒng)的需要。入口參數(shù)n為指定超聲波模塊的序號(hào),函數(shù)將會(huì)根據(jù)序號(hào)給出硬件地址并進(jìn)行距離測(cè)量。該超聲波控制程序具有防卡死功能,當(dāng)測(cè)量距離超出范圍或沒(méi)有返射信號(hào)時(shí),函數(shù)可以自動(dòng)結(jié)束等待并返回最大值255cm。
無(wú)線數(shù)傳模塊
NRF24L01P+PA+LNA無(wú)線數(shù)傳模塊工作于免許可證的2.4G ISM頻段,可以點(diǎn)對(duì)點(diǎn)或組成星型網(wǎng)絡(luò),此模塊的核心為挪威NORDIC公司的最新的高性能無(wú)線數(shù)傳芯片NRF24L01+,外圍輔助以大功率PA和LNA芯片,射頻開(kāi)關(guān),帶通濾波器.
本作品使用的51內(nèi)核的STC89C58單片機(jī)不具備SPI硬件接口,所以用了一組I/O口實(shí)現(xiàn)了模擬SPI協(xié)議。
無(wú)線攝像頭
攝像頭安裝位置為機(jī)器人底部的支撐底盤(pán)(云臺(tái))上,可上下調(diào)整或隨底盤(pán)左右旋轉(zhuǎn),具備更好的視野。
本機(jī)器人使用彩色 CMOS無(wú)線攝像頭,可同時(shí)承載音頻信號(hào),在救災(zāi)中達(dá)到更好的效果。
2.5 手持式遙控器模塊說(shuō)明
手持式遙控器整體功能
本遙控器是連接機(jī)器人本體系統(tǒng)與計(jì)算機(jī)監(jiān)控軟件的中間節(jié)點(diǎn),起到了信息轉(zhuǎn)發(fā)的作用。其主要功能是顯示機(jī)器人所攝實(shí)時(shí)圖像,顯示機(jī)器人周邊環(huán)境數(shù)據(jù),以及遙控機(jī)器人的各種動(dòng)作。
遙控器接收機(jī)器人發(fā)出的環(huán)境數(shù)據(jù)后,進(jìn)行分析并判斷機(jī)器人目前所處的環(huán)境以及是否有特殊事件,比如前進(jìn)途中有溝壑障礙或環(huán)境溫度過(guò)高等,然后將環(huán)境數(shù)據(jù)及分析結(jié)果同時(shí)顯示在液晶屏上,供操作者參考,操作者可以按下不同的按鍵發(fā)送具體指令,完成相應(yīng)的動(dòng)作。
7寸彩色液晶屏
與無(wú)線攝像頭的手動(dòng)諧調(diào)接收器相連,顯示機(jī)器人所攝圖像。(后附實(shí)物圖及主要參數(shù))
矩陣鍵盤(pán)
鍵盤(pán)的功能是供操作者發(fā)送指令或設(shè)計(jì)機(jī)器人運(yùn)動(dòng)模式,如前進(jìn),后退,變形等。
分為兩部分:1)機(jī)器人模式設(shè)置鍵, 可對(duì)機(jī)器人運(yùn)動(dòng)模式進(jìn)行設(shè)置;2)機(jī)器人運(yùn)動(dòng)控制鍵,可對(duì)機(jī)器人前進(jìn)后退等運(yùn)動(dòng)進(jìn)行控制。
藍(lán)牙模塊
藍(lán)牙模塊是手持遙控器和計(jì)算機(jī)的連接紐帶,通過(guò)藍(lán)牙將采集的數(shù)據(jù)等發(fā)送到計(jì)算機(jī)端監(jiān)控軟件,計(jì)算機(jī)端監(jiān)控軟件可以發(fā)送簡(jiǎn)單的文字信息到手持遙控器
液晶顯示模塊
其主要工作是顯示環(huán)境數(shù)據(jù)和與計(jì)算機(jī)端監(jiān)控軟件交換的信息。
2.4上位計(jì)算機(jī)平臺(tái)監(jiān)控軟件說(shuō)明
監(jiān)控軟件是救災(zāi)指揮中心所使用的,其可以對(duì)機(jī)器人進(jìn)行簡(jiǎn)單的監(jiān)測(cè),有報(bào)警功能,可同手持遙控器進(jìn)行通訊。是對(duì)手持遙控器的補(bǔ)充。
第十二屆“挑戰(zhàn)杯”作品 三等獎(jiǎng)
2010年在學(xué)校某科技競(jìng)賽中獲得?!疤氐泉?jiǎng)”。
2011年第八屆“挑戰(zhàn)杯”陜西省大學(xué)生課外學(xué)術(shù)科技作品競(jìng)賽獲得“特等獎(jiǎng)”。