技術(shù)頻道

娓娓工業(yè)
您現(xiàn)在的位置: 中國傳動網(wǎng) > 技術(shù)頻道 > 技術(shù)百科 > 基于無線通信的嵌入式機器人控制系統(tǒng)設(shè)計

基于無線通信的嵌入式機器人控制系統(tǒng)設(shè)計

時間:2008-12-26 15:55:19來源:ronggang

導(dǎo)語:?以支持實時仿真和嵌入式跟蹤的32位ARM7處理器LPC2129為控制核心,設(shè)計開發(fā)了輪式機器人控制系統(tǒng)硬件平臺;系統(tǒng)集成了無線通信數(shù)據(jù)收發(fā)模塊PTR2000、光電傳檢測模塊及超聲波導(dǎo)航模塊
1 引言   輪式移動機器人是機器人研究領(lǐng)域的一項重要內(nèi)容,它集機械、電子、檢測技術(shù)與智能控制于一體,是一個典型的智能控制系統(tǒng)。智能機器人比賽集高科技、娛樂、競技于一體,已成為國際上廣泛開展的高技術(shù)對抗活動?,F(xiàn)以ARM7處理器為控制核心,采用無線通信技術(shù),并移植嵌入式實時操作系統(tǒng)μC/0S一Ⅱ設(shè)計了一套智能機器人控制系統(tǒng)。 2 硬件設(shè)計   根據(jù)競技機器人的功能要求進(jìn)行總體設(shè)計,將各個功能進(jìn)行模塊化,其控制系統(tǒng)硬件框圖如圖1所示。中央處理器采用微控制器結(jié)構(gòu),用以控制外圍設(shè)備協(xié)調(diào)運行。舵機控制機器人的運動方向;驅(qū)動電機電動機采用輸出軸配有光電編碼器的小型直流電機驅(qū)動車輪旋轉(zhuǎn)。電磁鐵作為機械手夾緊的執(zhí)行元件。設(shè)置了兩路超聲波傳感器、8路光電檢測輸入和8路開關(guān)量檢測接口。整個機器人的運行狀態(tài)和運行參數(shù)通過LCD動態(tài)顯示。
  2.1 微控制器的選型   機器人要實現(xiàn)的動作和功能較多,需要多個傳感器對外界進(jìn)行檢測,并實時控制機器人的位置、動作和運行狀態(tài)。系統(tǒng)中的所有任務(wù)最終都掛在實時操作系統(tǒng)μC/0S一Ⅱ上運行,因此不僅要考慮微控制器的內(nèi)部資源,還要看其可移植性和可擴(kuò)展性。LPC2129是Philips公司生產(chǎn)的一款32位ARM7TDMI—S微處理器,嵌入256 KB高速Flash存儲器,它采用3級流水線技術(shù),同時進(jìn)行取指、譯碼和執(zhí)行,而且能夠并行處理指令,提高CPU的運行速度。由于它的尺寸非常小,功耗極低,抗干擾能力強,適用于各種工業(yè)控制。2個32位定時計數(shù)器、6路PWM輸出和47個通用I/0口,所以特別適用于對環(huán)境要求較低的工業(yè)控制和小型智能機器人系統(tǒng)。因此選用LPC2129為主控制器,可以獲得設(shè)計結(jié)構(gòu)簡單、性能穩(wěn)定的智能機器人控制系統(tǒng)。   2.2 無線通信接口設(shè)計   系統(tǒng)采用迅通公司生產(chǎn)的PTR2000無線通信數(shù)據(jù)收發(fā)模塊。電路接口如圖2所示。該模塊基于NORDIC公司生產(chǎn)的射頻器件nRF401開發(fā),其特點是:①有兩個頻道可供選擇,工作速率高達(dá)20 Kb/s;②接收發(fā)射合一,適合雙工和單工通信,因而通信方式比較靈活;③體積小,所需外圍元件少,接口電路簡單,因此特別適合機器人小型化要求;④可直接接單片機串口模塊,控制簡單;⑤抗干擾能力強;⑥功耗小,通信穩(wěn)定。
  2.3 光電檢測模塊設(shè)計   2.3.1 光電檢測過程   設(shè)計光電檢測模塊,使機器人能夠檢測地面上的白色引導(dǎo)線。光電檢測電路主要包括發(fā)射部分和接收部分,其原理如圖3所示。發(fā)射部分的波形調(diào)制采用了頻率調(diào)制方法。由于發(fā)光二極管的響應(yīng)速度快,其工作頻率可達(dá)幾兆赫茲或十幾兆赫茲,而檢測系統(tǒng)的調(diào)制頻率在幾十至幾百千赫茲范圍之內(nèi),因此能夠滿足要求。光源驅(qū)動主要負(fù)責(zé)將調(diào)制波形放大到足夠的功率去驅(qū)動光源發(fā)光。光源采用紅外發(fā)光二極管,工作頻率較高,適合波形為方波的調(diào)制光發(fā)射。   
  接收部分采用光敏二極管接收調(diào)制光線,將光信號轉(zhuǎn)變?yōu)殡娦盘?。這種電信號通常較微弱,需進(jìn)行濾波和放大后才能進(jìn)行處理。調(diào)制信號的放大采用交流放大形式,可以將調(diào)制光信號與背景光信號分離開來,為信號處理提供方便。調(diào)制信號處理部分對放大后的信號進(jìn)行識別,判斷被檢測對象的特性。因此,該模塊的本質(zhì)是將“交流”的、有用的調(diào)制光信號從“直流”的、無用的背景光信號中分離出來,從而達(dá)到抗干擾的目的。   2.3.2 光電探頭   在機器人底盤前部安裝有光電探頭,共設(shè)置了5個檢測點,其結(jié)構(gòu)如圖4所示。
  從理論上講,檢測點越多,越密,識別的準(zhǔn)確性與可靠性越高。但是硬件的開銷與軟件的復(fù)雜程度也相應(yīng)增加。采用該尋線系統(tǒng)保證了檢測的精確度,也節(jié)約了硬件的開銷。發(fā)光二極管發(fā)出的調(diào)制光經(jīng)地面反射到光敏二極管。光敏二極管產(chǎn)生的光電流隨反射光的強弱線性變化。檢測出這種變化,即可判斷某一個檢測點是否在白色引導(dǎo)線的上方,從而判斷機器人和白色引導(dǎo)線的相對位置。   2.4 超聲波測距傳感器設(shè)計與實現(xiàn)   兩路超聲波傳感器用以控制機器人避開障礙物,并預(yù)測機器人相對目的地距離,起導(dǎo)航作用,其接收部分與微控制器的捕獲和定時管腳相連接。整個超聲波檢測系統(tǒng)由超聲波發(fā)射、超聲波接收和單片機控制等部分組成。發(fā)射部分由高頻振蕩器、功率放大器及超聲波換能器組成。經(jīng)功率放大器放大后,通過超聲波換能器發(fā)射超聲波。   圖5給出由數(shù)字集成電路構(gòu)成的超聲波振蕩電路,振蕩器產(chǎn)生的高頻電壓信號通過電容C2隔除掉了信號中的直流量并給超聲波換能器MA40S2S。其工作過程:U1A和UlB產(chǎn)生與超聲波頻率相對應(yīng)的高頻電壓信號,該信號通過反向器U1C變?yōu)闃?biāo)準(zhǔn)方波信號,再經(jīng)功率放大,C2隔除直流信號后加在超聲波換能器MA40S2S進(jìn)行超聲波發(fā)射。如果超聲波換能器長時間加直流電壓,會使其特性明顯變差,因此一般對交流電壓進(jìn)行隔除直流處理。U2A為74ALS00與非門,control_port(控制端口)引腳為控制口,當(dāng)control_port為高電平時,超聲波換能器發(fā)射超聲波信號。
  圖6示出為超聲波接收電路。超聲波接收換能器采用MA40S2R,對換能器接收到的信號采用集成運算放大器LM324進(jìn)行信號放大,經(jīng)過三級放大后,通過電壓比較器LM339將正弦信號轉(zhuǎn)換為TTL脈沖信號。INT_Port與單片機中斷管腳相連,當(dāng)接收到中斷信號后,單片機立即進(jìn)入中斷并對超聲波信號進(jìn)行處理和判斷。
3 實時操作系統(tǒng)μC/OS—II的移植   μC/OS—II是一個嵌入式實時操作系統(tǒng)內(nèi)核,包含了任務(wù)調(diào)度、任務(wù)管理、時間管理、內(nèi)存管理和任務(wù)間的通信與同步等基本功能。μC/OS—II進(jìn)行任務(wù)調(diào)度時,會把當(dāng)前任務(wù)的CPU寄存器存放到該任務(wù)堆棧中,然后再從另一個任務(wù)堆棧中恢復(fù)原來的工作寄存器,繼續(xù)運行另一個任務(wù)。   根據(jù)各個控制功能和微控制器的資源結(jié)構(gòu)對任務(wù)進(jìn)行劃分,共劃分為7個應(yīng)用任務(wù),其劃分過程如圖7所示。無線串行通信采用中斷接收方式,保證數(shù)據(jù)接收的實時性。
  μC/OS一Ⅱ任務(wù)的建立包括定義任務(wù)堆棧、設(shè)定任務(wù)優(yōu)先級、初始化該任務(wù)要求的系統(tǒng)硬件及實現(xiàn)具體的控制過程等4部分?,F(xiàn)以任務(wù)1為例,介紹應(yīng)用任務(wù)的建立過程。
  在嵌入式實時操作系統(tǒng)環(huán)境下開發(fā)實時應(yīng)用程序,可使程序的設(shè)計和擴(kuò)展變得容易,而且無需大的改動即可增加新的功能。通過將應(yīng)用程序分割成若干獨立的任務(wù)模塊,可大大簡化應(yīng)用程序的設(shè)計過程;而且能快速、可靠地對實時性要求苛刻的事件。通過有效的系統(tǒng)服務(wù)、嵌入式實時操作系統(tǒng),能使系統(tǒng)資源得到更好的利用。 4 調(diào)試運行   在機器人控制系統(tǒng)起動時,μC/OS一Ⅱ?qū)Χ褩?臻g、各個控制寄存器和外設(shè)器件的硬件進(jìn)行初始化,并設(shè)定當(dāng)前各個功能部件的初始狀態(tài)。   在實時機器人系統(tǒng)下,機器人正常啟動后,系統(tǒng)實時監(jiān)視機器人在比賽場上的運行狀況,若出現(xiàn)某一動作或功能無效則給出出錯信息。正常運行時實時顯示機器人在比賽場上的坐標(biāo)值和動作狀態(tài),如圖8所示。
5 結(jié)語   根據(jù)智能機器人的控制要求,設(shè)計了基于無線通信的嵌入式機器人控制系統(tǒng)。在軟件設(shè)計上移植了嵌人式實時操作系統(tǒng)μC/OS一Ⅱ。利用光電檢測模塊和超聲波導(dǎo)航模塊感知外部信息,實現(xiàn)了對智能機器人的控制。

標(biāo)簽:

點贊

分享到:

上一篇:基于Actel Fusion FPGA的無位...

下一篇:微能WIN-V63矢量控制變頻器在...

中國傳動網(wǎng)版權(quán)與免責(zé)聲明:凡本網(wǎng)注明[來源:中國傳動網(wǎng)]的所有文字、圖片、音視和視頻文件,版權(quán)均為中國傳動網(wǎng)(www.treenowplaneincome.com)獨家所有。如需轉(zhuǎn)載請與0755-82949061聯(lián)系。任何媒體、網(wǎng)站或個人轉(zhuǎn)載使用時須注明來源“中國傳動網(wǎng)”,違反者本網(wǎng)將追究其法律責(zé)任。

本網(wǎng)轉(zhuǎn)載并注明其他來源的稿件,均來自互聯(lián)網(wǎng)或業(yè)內(nèi)投稿人士,版權(quán)屬于原版權(quán)人。轉(zhuǎn)載請保留稿件來源及作者,禁止擅自篡改,違者自負(fù)版權(quán)法律責(zé)任。

網(wǎng)站簡介|會員服務(wù)|聯(lián)系方式|幫助信息|版權(quán)信息|網(wǎng)站地圖|友情鏈接|法律支持|意見反饋|sitemap

中國傳動網(wǎng)-工業(yè)自動化與智能制造的全媒體“互聯(lián)網(wǎng)+”創(chuàng)新服務(wù)平臺

網(wǎng)站客服服務(wù)咨詢采購咨詢媒體合作

Chuandong.com Copyright ?2005 - 2024 ,All Rights Reserved 版權(quán)所有 粵ICP備 14004826號 | 營業(yè)執(zhí)照證書 | 不良信息舉報中心 | 粵公網(wǎng)安備 44030402000946號