［編纂簡介］：伴隨著科學(xué)技術(shù)發(fā)展和人民生活水平進步，機器人曾經(jīng)入手下手進入了人們的生活中。這個時期的光降，呈現(xiàn)了各類新型機器人，如打掃機器人、安防機器人。移動機器人的最主要的部份之一：導(dǎo)航系統(tǒng)，越發(fā)造成機器人行業(yè)的存眷。機器人導(dǎo)航系統(tǒng)對很多機器人應(yīng)用行業(yè)至關(guān)主要如：智能堆棧，超市導(dǎo)購，家用機器人，自動化藏書樓，智能病院等。比擬遍及的是尋線機器人。作者在讀研時期，屢次到場這種機器人角逐和設(shè)計。事實設(shè)計中發(fā)明：由于受到固定線的限定，這種體系并不可以實現(xiàn)真正意義上的全方位的自立運轉(zhuǎn)。別的，這種辦法受到光的影響很大，不可以事實
［關(guān)鍵詞］：RFID 機器人 導(dǎo)航 地磁場感到 電子羅盤
1媒介
伴隨著科學(xué)手藝發(fā)展和人民生活水平進步，機器人已入手下手進入了人們的生活中。這個時期的到臨，泛起了各類新型機器人，如打掃機器人、安防機器人。移動機器人的最主要的局部之一：導(dǎo)航體系，愈加惹起機器人范疇的存眷。機器人導(dǎo)航體系對很多機器人運用范疇至關(guān)主要如：智能堆棧，超市導(dǎo)購，家用機器人，自動化藏書樓，智能病院等。比擬遍及的是尋線機器人。作者正在讀研時期，屢次到場這種機器人角逐和設(shè)計。預(yù)期設(shè)計中發(fā)覺：由于受到固定線的限定，這種體系并不可以實現(xiàn)真正意義上的全方位的自立運轉(zhuǎn)。別的，這種要領(lǐng)受到光的危害很大，不可以預(yù)期的運用取生活中。線正在地表還會危害空中美妙。正在經(jīng)由充足的文獻查找和思考后提出了一種新的機器人導(dǎo)航體系，把RFID，地磁場感到，DSP等手藝融會。進行了預(yù)期的體系硬軟件設(shè)計和穩(wěn)定性測試。
2 導(dǎo)航硬件體系
我們開辟的硬件體系主要由：DSP焦點板,RFID板,體系主板，電子羅盤，驅(qū)動板組成。
2.1 DSP中心板
我們自行設(shè)計的DSP體系采取TMS320F2812為焦點，2812是TI公司的一款適用于操縱的高性能、多功能、高性價比的32位定點DSP芯片。焦點采取高速的處置機，主如果思量今后關(guān)于體系的二次開發(fā)。和利便算法的移植。指令體系最高可在150MHZ主頻下事情，并帶有18k的0守候周期片上 SRAM和128k片上存取工夫為36ns FLASH。其片上外設(shè)次要包孕ADC、雙SCI、SPI、McBSP、eCAN等，并帶有事務(wù)治理模塊（EVA、EVB），辨別包孕6路 PWM/CMP、2路QEP、3路CAP、2路16位定時器。個中的雙SCI能夠一路接傳感器一路接PC實時輸出調(diào)試信息。16位的PWM能夠?qū)崿F(xiàn)精致的調(diào)速。CAP等利便了取傳感器的接口。最大輸入為3V的16路、12位,轉(zhuǎn)換工夫為80ns的ADC能夠取此同時接16路間隔傳感器。2812具有16×16 位雙乘法累加器，可覺得處置射頻和地磁場標(biāo)的目的旌旗燈號給予充足的處置速度。因為2812焦點電壓（1.8V）和起振頻次的特殊性，此焦點板采取無源晶振。
中心板采納TPS767D318雙路輸出高壓降LDO。給予雙電源，包管了中心電壓1.8V的穩(wěn)固供應(yīng)。TPS767D318有高速的瞬態(tài)相應(yīng)，專適用于 DSP，最大能夠給予1A的電流。能夠?qū)崿F(xiàn)對IO和中心的分時復(fù)位。有上電復(fù)位功用，高壓掩護功用，其復(fù)位延遲時間為200ms。有過熱掩護功用。最大功率較量爭論能夠用式1較量爭論。
(1)
此中TJMAX是最大容許溫度，依據(jù)履歷一樣平常TPS767D318為125度擺布。TA是環(huán)境溫度。RθJA是銜接阻抗。關(guān)于28管腳一般為27.9°C/W?，F(xiàn)實的功耗可由式2較量爭論，此中VI和VO分別為輸入輸出電壓，IO為輸出電流。
(2)
正在外圍電壓濾波層面接納多級坦電容（104和220uF）并聯(lián)的方法。如許的設(shè)計可以發(fā)生低ESR的結(jié)果。按照履歷，正在頻域，104能極大的濾除高頻滋擾，而220uF可以最好水平的低落電壓的低頻滋擾。
2.2 體系主板取傳感模塊
關(guān)于電源，體系采納12V鋰電池供電，采納三規(guī)矩電壓調(diào)治器調(diào)治電壓。內(nèi)部集成功率回護。輸出電流能夠達到1A。輸入耐壓能夠達到30V。供應(yīng)充電接口，根據(jù)開關(guān)開展節(jié)制，電路板上留有接口,能夠?qū)︿囯姵亻_展充電。
定位安裝采納射頻手藝（RFID）。RFID已經(jīng)成為一個熱點的手藝。近來沃爾瑪經(jīng)過了一項"要求其前100家供應(yīng)商正在2000年1月之前向其配送中間發(fā)送貨盤和包裝箱時運用RFID手藝，2006年后逐漸正在單件商品中運用這項手藝"的決定。由信息傳送的基本原理而言，射頻辨認手藝正在低頻段基于變壓器耦合模子(低級取次級之間的能量傳送及旌旗燈號傳送)，正在高頻段基于雷達探測目的的空間耦合模子(雷達發(fā)射電磁波旌旗燈號遇到目的后攜帶目的信息返回雷達接收機)。最基本的RFID系統(tǒng)由三一些構(gòu)成：標(biāo)簽、閱讀器、天線。按作用間隔可分為密耦合卡(作用間隔小于1厘米)、近耦合卡(作用間隔小于15厘米)、疏耦合卡 (作用間隔約1米)和遠間隔卡(作用間隔由1米到10米，乃至更遠)。本系統(tǒng)采納近耦合卡。射頻模塊取2812的SCIA口開展通訊。經(jīng)過對數(shù)據(jù)流開展解碼，推斷機器人的位置。
接著是紅外躲障模塊。一樣平常機器人的躲障能夠接納紅外反射的方式，這在機器人角逐中比擬遍及。GPIO節(jié)制紅外線的發(fā)射，然后假如碰到停滯物會反射返來，吸收管子收到光芒后引發(fā)電阻變革，檢驗其電阻變革就能夠判定是不是有停滯物了。然則這類方式輕易受到光噪聲的滋擾。所以間隔比擬近，一樣平常只會到達2-3cm。本人在屢次角逐中，顛末查資料和研討，提出了一種利用尺度高頻旌旗燈號38KHZ的紅外線開展停滯的探測的電路。由于利用高頻旌旗燈號和高頻運放，有了必定的抗滋擾才能，與此同時探測的間隔的最大提高到8cm。首先，經(jīng)由過程555發(fā)射紅外線。接著，旌旗燈號經(jīng)由過程紅外吸收管后顛末隔直電容，送入高頻運放LM318N，如圖4。然后，顛末50倍的放大。如圖5和圖6。
圖 1 555發(fā)射電路
圖 2 頻次辨認電路
圖 3 檢驗放大電路
LM567是鎖相環(huán)電路， 8腳雙列直插封裝。第5、6腳外接的電阻和電容決意了內(nèi)部壓控振蕩器的中間頻次。1、2腳平常辨別經(jīng)過一個電容器接地，發(fā)生輸出濾波網(wǎng)絡(luò)和環(huán)路單級低通濾波網(wǎng)絡(luò)。2腳接的電容決意鎖相環(huán)路的捕獲帶寬：電容值越大，環(huán)路帶寬越窄。壓控振蕩器的中間頻次和濾波帶寬可由式子3和式子4決意。
(3)
(4) (此中Vi為輸入電壓)
然后是電子羅盤模塊。CMPS03 電子羅盤是平面角度傳感器。經(jīng)由過程檢驗當(dāng)前傳感器取地球磁場直接的角度，電子羅盤能夠獲得分辨率為0.1度的絕對扭轉(zhuǎn)角度。這個電子羅盤模塊是專門為機器人而制作，目標(biāo)為了為機器人供應(yīng)適合的標(biāo)的目的導(dǎo)航旌旗燈號。關(guān)于任何標(biāo)的目的，皆能夠生成當(dāng)世無雙的編碼。該傳感器利用PHILIPS的KMZ51地磁場感到芯片，其精度很高。有兩種輸出體例，第一種：I2C體例，由Pin2(SCL)和Pin3(SDA)輸出。Pin7和Pin5必需懸空。Pin6用來舉行校訂。這一些管腳皆收到主板上，由于模塊是5V供電，而DSP是3.3V所以還需要用74LVC245舉行電平轉(zhuǎn)換。經(jīng)由過程2812的GPIOB經(jīng)由過程Pin6對體系舉行校訂。校訂只需要做一次，由于數(shù)據(jù)會保存在電子羅盤中的PIC單片機的EEPROM。第6腳有一個上拉電阻。舉行校訂只需要經(jīng)由過程GPIO為Pin6一個背相脈沖，并且由于有上拉電阻，所以，此管腳取體系斷開也是能夠的。
末了是體系的驅(qū)動模塊的設(shè)計。接納L298芯片。L298是SGS公司的產(chǎn)物，對照普遍的是15腳Multiwatt封裝的L298N，內(nèi)部一樣包羅4通道邏輯驅(qū)動電路。L298內(nèi)含的功率輸出器件設(shè)計制造正在一塊石英基片上，因為制造工藝的同一性，因此具有分立元件組合電路不行對比的性能參數(shù)一致性，事情穩(wěn)固。15腳是輸出電流反應(yīng)引腳，其它與L293不異。正在平常運用中這兩個引腳還能夠直接接地。它是高電壓的，高電流的雙全橋驅(qū)動芯片。能夠直接接受尺度的TTL邏輯電平。能夠驅(qū)動各類負載如機電，繼電器等。有兩個使能輸入，經(jīng)由過程它操縱PWM波的有效性。L298集成有兩個能量輸出塊A，B。別的，我們設(shè)計的板子上加有續(xù)流二極管。
2.3 驅(qū)動程序設(shè)計
根據(jù)編寫InitSysCtrl()函數(shù)，對看門狗節(jié)制寄存器WDCR舉行設(shè)置，其WDFLAG位是看門狗復(fù)位狀況位。若是該位置位表現(xiàn)一個看門狗復(fù)位。向WDDIS位寫1會使看門狗模塊無效。寫0對看門狗使能。而關(guān)于WDPS位主如果決意看門狗計數(shù)器的時鐘速率。因為法式中包含有很多輪回，所以關(guān)于看門狗的設(shè)置要特別注意。然后根據(jù)設(shè)置PLLCR對體系鎖相環(huán)舉行設(shè)置。這時候要注意，法式需求插手，5000次輪回守候鎖相穩(wěn)固。這一點正在2407里并非須要的，而針對2812體系要注意這點。然后根據(jù)HISPCP和LOSPCP來對高速和低速外設(shè)來舉行婚配。因為正在法式中使用了停止，所以需求對外設(shè)停止擴大PIE舉行設(shè)置。標(biāo)的目的傳感器根據(jù)捕捉單位和DSP中心舉行毗連。一次脈沖的捕捉需求兩次停止，根據(jù)節(jié)制和讀取FIFO寄存器來掏出標(biāo)的目的的信息的脈沖編碼。別的，紅外躲障模塊根據(jù)74LV245模塊，轉(zhuǎn)換電平后，和停止管腳舉行毗連。所以要對停止函數(shù)舉行編程。和RFID傳感器通訊是根據(jù)2812的雙線異步串口。SCI模塊支撐CPU取采納非返回至0（non-return-to-zero）(NRZ)尺度花樣的異步外圍設(shè)備之間的數(shù)字通信。2812的 SCI接收器有一個16級深度的FIFO，如許能夠降低空頭的辦事。法式根據(jù)分辨TxRDY位來分辨有無RFID停止。如許，能夠立即的發(fā)明機器人是不是到了一個新的位置。然后讀取SCIRXBUF。最終，根據(jù)EV單位設(shè)置PWM 脈沖，進而節(jié)制機器人的走向。
3 結(jié)論和實現(xiàn)后的體系
最終，正在聯(lián)華超市四周調(diào)試全部體系。顛末頻頻調(diào)試，和對順序的點竄，實現(xiàn)了對射頻途徑點的導(dǎo)航。終極體系運轉(zhuǎn)狀況如圖6所示：
圖4 機械人在超市的現(xiàn)實運轉(zhuǎn)