專利名稱：導(dǎo)航機器人障礙探測方法及系統(tǒng)的制作方法
技術(shù)領(lǐng)域：
本發(fā)明屬于機器人導(dǎo)航技術(shù)領(lǐng)域，涉及一種導(dǎo)航機器人障礙探測方法及系統(tǒng)。
背景技術(shù)：
主動安全避障是導(dǎo)航機器人基本功能之一，現(xiàn)有多種實現(xiàn)技術(shù)紅外技術(shù)、機器視覺技術(shù)、激光技術(shù)、微波雷達技術(shù)和超聲波技術(shù)等。然而，這些技術(shù)都是各具特點，紅外分辨率最高達lum，測量范圍在幾十厘米到1米的距離，主要用于近距離障礙的檢測。機器視覺技術(shù)探測范圍廣，信息最大，難于區(qū)分探測目標(biāo)和背景。所需的圖像計算量很大，系統(tǒng)的實時性較差。激光方向性好，精度與分辨率均很高，但價格昂貴。微波雷達技術(shù)利用多普勒 (Doppler)原理，檢測速度快和靈活性高、自動選頻、自適應(yīng)波形的能力強、分辨率高、價格昂貴，一般用于檢測運動物體的距離。超聲測距衍射角范圍為20° 40°的面探測，一般探測距離0. 3-3m左右，分辨率2cm。綜上所述，激光和微波傳感器的價格昂貴，且激光雷達體積大，較為笨重，安裝在小型移動機器人上，會使其喪失靈活性。利用微波的多普勒雷達大多用來躲避快速運動的障礙物。機器視覺技術(shù)所需的圖像計算量很大，系統(tǒng)的實時性較差，成像的速度不能滿足自主移動機器人的應(yīng)用需要。

發(fā)明內(nèi)容
本發(fā)明所要解決的技術(shù)問題是提供一種導(dǎo)航機器人障礙探測方法及系統(tǒng)，本發(fā)明的導(dǎo)航機器人障礙探測方法及系統(tǒng)，探測精度高，探測角度大。發(fā)明的技術(shù)解決方案如下一種導(dǎo)航機器人障礙探測方法，將超聲探測模塊架于掃描舵機之上，實現(xiàn)正前方的掃描探測；通過控制PWM波的高電平時間來控制掃描舵機的轉(zhuǎn)角；為減小測量誤差，采用以下方法測量超聲波傳播時間利用信號發(fā)送至波峰經(jīng)歷的時間，再減去起振點至波峰的時間間隔，得到超聲波傳播時間間隔，所述的波峰通過回波信號的包絡(luò)線獲得。解釋超聲波信號傳播時間為信號發(fā)送時間至回波起振點的時間間隔。系統(tǒng)測量時間為信號發(fā)送時間至回波信號包絡(luò)線波峰的時間間隔。由于起振點至包絡(luò)線波峰的時間間隔相對固定，因此系統(tǒng)測量時間減去起振點至回波包絡(luò)線波峰的時間間隔，最終將得到相當(dāng)精度較高的超聲波傳播時間間隔。根據(jù)超聲波信號在標(biāo)準(zhǔn)實驗距離(如3米)中傳播實驗可知，起振點至波峰的時間間隔相對固定，多次標(biāo)準(zhǔn)實驗后取實驗平均值作為后續(xù)實驗的起振點至波峰時間間隔。采用諧振頻率為40kHZ壓電式超聲波傳感器，其原理是利用壓電晶體的諧振來工作，需要其兩極輸入頻率和壓電晶片固有諧振頻率相同的脈沖電壓使其處于工作狀態(tài)，因此發(fā)送超聲波信號時需要輸入40kHz的方波脈沖信號。具體使用中，也可以采用其他諧振頻率的壓電式超聲波傳感器，只要保證輸入的方波脈沖信號的頻率等于該諧振頻率即可。
PWM波的高電平時間在1 2ms之間變動，對應(yīng)掃描舵機的輸出轉(zhuǎn)角在0 180° 之間變化。將5個光電傳感器在導(dǎo)航機器人的前端排成扇形陣列用于探測導(dǎo)航機器人的障礙物，相鄰的光電傳感器之間的夾角為37. 5°。電源通過H橋與導(dǎo)航機器人的驅(qū)動電機連接，實現(xiàn)單電源驅(qū)動電機的正轉(zhuǎn)和反轉(zhuǎn)。一種導(dǎo)航機器人障礙探測系統(tǒng)，采用前述的導(dǎo)航機器人障礙探測方法，該導(dǎo)航機器人障礙探測系統(tǒng)包括超聲探測模塊、超聲掃描模塊和核心控制模塊；超聲探測模塊與超聲掃描模塊均與核心控制模塊連接；超聲探測模塊包括高壓驅(qū)動信號產(chǎn)生模塊和超聲波信號接收調(diào)整模塊；高壓驅(qū)動信號產(chǎn)生模塊的結(jié)構(gòu)為變壓器的初級線圈接方波信號；變壓器的次級線圈輸出升壓后的信號接超聲波發(fā)射頭；超聲波信號接收調(diào)整模塊的結(jié)構(gòu)為超聲波信號接收電路的輸出信號依次經(jīng)放大器和A/D轉(zhuǎn)換器與核心控制模塊連接；超聲掃描模塊包括掃描舵機和用于驅(qū)動掃描舵機的PWM驅(qū)動電路。所述的方波信號的頻率為40kHz。所述的放大器由兩級運算放大器級聯(lián)而成。所述的導(dǎo)航機器人障礙探測系統(tǒng)還包括紅外探測補償模塊，紅外探測補償模塊包括設(shè)置在導(dǎo)航機器人的前端的5個光電傳感器，5個光電傳感器排成扇形陣列，相鄰的光電傳感器之間的夾角為37. 5°。有益效果本發(fā)明導(dǎo)航機器人障礙探測方法及系統(tǒng)，其目的在于提高普通超聲探頭的探測范圍，補償超聲測距的盲區(qū)問題，并使回波信號的干擾減小，提高超聲測距技術(shù)的精度。將超聲掃描系統(tǒng)用于小型移動機器人平臺，實現(xiàn)自主機器人實時高精度導(dǎo)航。本發(fā)明利用40kHz 驅(qū)動信號產(chǎn)生模塊與超聲波信號接收調(diào)整模塊實現(xiàn)普通超聲探頭的長距離探測。設(shè)計超聲收發(fā)模塊駕于掃描舵機之上，達到平面內(nèi)多點探測的效果，同時減小了回波信號的干擾。在保障機器人平臺減速電機的控制精度的同時采用紅外與超聲技術(shù)實現(xiàn)小盲區(qū)大范圍的探測。本發(fā)明主要包括以下幾方面內(nèi)容(1)長距超聲探測的實現(xiàn)主要由40kHz高壓驅(qū)動信號產(chǎn)生模塊與超聲波信號接收調(diào)整模塊完成。40kHz驅(qū)動信號產(chǎn)生模塊是超聲測距方案中的關(guān)鍵部分之一，40kHz高壓驅(qū)動信號由單片機的PWM模塊產(chǎn)生占空比為50%的方波，并經(jīng)由與非門電路產(chǎn)生兩路周期相同電平相反的方波，同時利用一路通用I/O控制方波信號的輸出，既信號使能端。以上產(chǎn)生的兩路方波用以控制兩個MOS管控制脈沖變壓器初級端繞組的通斷，形成推挽輸出，以保證變壓器初級繞組電能的持續(xù)供應(yīng)，通過初級繞組的40kHz方波信號經(jīng)過變壓器的升壓作用，在次級繞組輸出峰峰值約為100V的驅(qū)動信號。利用此信號來驅(qū)動超聲波發(fā)射頭，可將峰峰值為12V的信號，升至峰峰值為108V的信號，并且能確保輸出功率足以驅(qū)動超聲波發(fā)射頭，電路圖如圖2所示。超聲波信號接收調(diào)整模塊是將超聲波信號遇到障礙物返回超聲接收頭，這個過程中會引起接收頭的共振從而產(chǎn)生共振電壓。該信號比較微弱需要經(jīng)過放大才能用AD進行采樣。放大電路采用儀表放大器INA129P進行第一級放大，放大倍數(shù)為100 倍。信號經(jīng)過第一級放大后，再輸入一個增益可控的儀表放大器PGA202AP進行二級放大， 其增益可以利用單片機的I/O控制，可分別設(shè)置增益為1/10/100/1000，根據(jù)信號的強弱改變增益大小，使信號處理更加靈活，進而提高測距的量程。(2)主控芯片與驅(qū)動電路模塊是設(shè)計機器人平臺控制的核心，小型機器人平臺是最小系統(tǒng)板上搭載主控芯片型號是MC9S12DG128。該芯片的特點是價格便宜，有兩個外部脈沖累加器，脈沖累加器在工作的時候不需占用芯片資源。機器人平臺驅(qū)動電路采用場效應(yīng)管搭建H橋而實現(xiàn)。該驅(qū)動電路的優(yōu)點在于正反驅(qū)動力強勁，但由于其反向?qū)〞r沒有相應(yīng)的保護措施，所以反向電流較大。增加兩種措施防止由于信號延時的問題使得同邊上下橋臂同時導(dǎo)通管情況。其一是改善數(shù)字電路，減少了 PWM 口的占用數(shù)量，將原先的4路PWM 輸入簡化為兩路PWM輸入，另外兩路則是高低電平性質(zhì)的Direction控制信號。其二是選擇PWM波在低電平時才作為有效控制信號輸出。由于主控芯片PWM引腳在無控制信號輸出時，默認的懸空電平會接近于高電平，所以，將PWM信號選為低電平有效就不會出現(xiàn)電機在無控制信號時空轉(zhuǎn)的情況出現(xiàn)。圖3是加入了數(shù)字電路的控制信號端原理圖，圖4是H橋電路原理圖。(3)設(shè)計超聲收發(fā)模塊駕于掃描舵機之上，達到平面內(nèi)多點探測的效果，同時減小了回波信號的干擾。超聲波測距在工作時，射到目標(biāo)物體上是一個區(qū)域，其返回的信號一般僅能表示障礙物最近點的信息，因此它屬于點對點測距。如果要獲得周圍環(huán)境的二維信息， 通常采用設(shè)置多個測距模塊形成環(huán)形的測距陣列來獲得多組信息。如此使收發(fā)模塊相互干擾程度很大，且成本高，用于移動機器人平臺時，其環(huán)境信息不能準(zhǔn)確反映。提出用單個超聲波測距模塊駕于平面掃描的舵機之上，測距模塊隨舵機轉(zhuǎn)軸轉(zhuǎn)動，以達到平面內(nèi)多點探測的效果。利用舵機的角度細分，可使測距模塊在平面內(nèi)的多個角度測量點對點距離。使得同一平面測量點數(shù)遠遠超過測距陣列；另外，由于在某一時刻只會有一個點在進行超聲波測距，再加上對回波數(shù)字信號的優(yōu)化處理，所以基本可以消除回波干擾的問題。(4)結(jié)合紅外與超聲技術(shù)實現(xiàn)更大范圍探測，利用紅外接近開關(guān)將超聲波傳感器的檢測盲區(qū)進一步消除，選用5個光電開關(guān)傳感器。接線參數(shù)如下圖左，本平臺選用的是 E3F-DS30C4, NPN型漫反射光電開關(guān)，有效監(jiān)測距離為30cm。利用12V電壓驅(qū)動，輸出電平信號，接入單片機引出的I/O 口。經(jīng)過調(diào)試，將5個光電傳感器在車前排成扇形陣列，光電開關(guān)的發(fā)散角較小，經(jīng)過布局后組成陣列覆蓋于車前的150°范圍，如圖5所示。與掃描舵機之上的超聲收發(fā)模塊相互配合，解決機器人前方檢測死角問題。所以本發(fā)明采用紅外技術(shù)與超聲波技術(shù)的有機結(jié)合，減小了盲區(qū)的范圍。采用一對超聲探頭掃描作業(yè)，實現(xiàn)平臺內(nèi)全探測，也達到了小型移動機器人便捷安裝的需求，同時也滿足低成本與實時響應(yīng)的要求。本發(fā)明的超聲探測模塊主要由40kHz高壓驅(qū)動與超聲接收信號放大實現(xiàn)。將該模塊架于掃描舵機之上，實現(xiàn)正前方無死角180°掃描探測。并結(jié)合紅外測距實現(xiàn)對導(dǎo)航機器人超聲盲區(qū)的補償。機器人本體核心控制芯片選用MC9S12DG128，驅(qū)動電路采用場效應(yīng)管搭建H橋?qū)崿F(xiàn)。本發(fā)明的導(dǎo)航機器人利用了一對超聲探頭實現(xiàn)平面多點感測，最遠測距范圍可至5. 9m，探測盲區(qū)縮小至2cm。系統(tǒng)具有成本低廉、探測盲區(qū)小、抗衍射能力強，實時性好等特點，產(chǎn)業(yè)化前景看好?？捎糜谖⑿⌒蜋C器人導(dǎo)航、環(huán)境探測、智能車主動安全等領(lǐng)域。


圖1是超聲測距系統(tǒng)框2是40kHz驅(qū)動信號產(chǎn)生模塊；圖3是加入了數(shù)字電路的控制信號端原理4是H橋電路原理圖；圖5是紅外光電傳感器陣列圖；圖6是超聲收發(fā)駕于掃描舵機的實施過程圖；圖7是紅外光電開關(guān)工作框圖。
具體實施例方式以下將結(jié)合附圖和具體實施例對本發(fā)明做進一步詳細說明如圖1所示，該探測系統(tǒng)核心部分為40kHz高壓驅(qū)動信號產(chǎn)生模塊和超聲波信號接收調(diào)整模塊的設(shè)計通過初級繞組的40kHz方波信號經(jīng)過變壓器的升壓作用，在次級繞組輸出峰峰值約為100V的驅(qū)動信號，利用此信號來驅(qū)動超聲波發(fā)射頭，可將峰峰值為12V 的信號，升至峰峰值為108V的信號，保障輸出功率驅(qū)動超聲波發(fā)射頭；超聲接收調(diào)整過程中信號比較微弱需經(jīng)放大才能AD采樣，放大電路采用儀表放大器INA129P進行第一級放大，放大倍數(shù)為100倍，再經(jīng)過增益可控儀表放大器PGA202AP進行二級放大，其增益可用單片機的I/O控制，可分別設(shè)置增益為1/10/100/1000倍，根據(jù)信號的強弱自適應(yīng)的改變增益大小，使信號處理更加靈活，提高測距的量程。核心控制器MC9S12 DG128與場效應(yīng)管搭建H橋驅(qū)動電路的設(shè)計DGU8芯片節(jié)省系統(tǒng)資源，擁有獨立的7路PWM波輸出口，機器人系統(tǒng)設(shè)計中采用兩路，其它輸出口引出作為搭載超聲傳感器的伺服電機的控制信號；H橋驅(qū)動電路增加兩種設(shè)計方式，以防止信號延時導(dǎo)致同邊上下橋臂的即時導(dǎo)通其一是加入數(shù)字電路，減少了 PWM 口的占用數(shù)量，將原 4路PWM輸入簡化為兩路PWM輸入，另外兩路則是高低電平性質(zhì)的Direction控制信號；其二是當(dāng)PWM處于低電平時才作為有效控制信號。一對探頭實現(xiàn)正前方180°無死角平面多點探測，機器人長距超聲收發(fā)模塊駕于掃描反應(yīng)速度為300° /s舵機之上，實現(xiàn)前方平面多點掃描與探測，此項設(shè)計能減小50% 的回波信號干擾。紅外傳感器補償超聲傳感器探測技術(shù)的盲區(qū)，使微小型導(dǎo)航機器人最遠測距范圍高達5. 9m，最近探測距離縮小至2cm，使得微小型導(dǎo)航機器人系統(tǒng)探測空間得到本質(zhì)上的提升。超聲感測系統(tǒng)經(jīng)由單片機的PWM模塊產(chǎn)生40kHz控制信號，信號經(jīng)由脈沖變壓器和MOS管組成的功率放大模塊發(fā)出強功率的超聲波信號，發(fā)送多個周期(比如10個周期) 的脈沖波后，單片機停止發(fā)送40kHz信號，同時啟動定時器和AD轉(zhuǎn)換模塊，等待回波信號。 超聲波信號遇障礙物后返回經(jīng)由超聲波接收頭接收，接收信號經(jīng)過放大調(diào)理后，輸入至AD 轉(zhuǎn)換模塊，回波信號的模數(shù)轉(zhuǎn)換信息連同定時器計數(shù)器的值被分別存到兩個數(shù)組中。根據(jù) AD轉(zhuǎn)換所得到的值，可得到回波信號的包絡(luò)線，如此便可以利用包絡(luò)線得到的其峰值，根據(jù)峰值確定其在數(shù)組中的位置，而位置數(shù)據(jù)可以最終在計數(shù)器數(shù)據(jù)數(shù)組中得到相對應(yīng)的時間信息，從而可得到超聲波傳輸間隔時間，進而推算距離值。超聲波測距中需要測量的時間間隔為開始發(fā)送脈沖到接收器接收回波信號起振間隔，但接收器起振輸出信號常常較小，并且穩(wěn)定性不高。若設(shè)置傳統(tǒng)閾值觸發(fā)容易造成較大誤差，而波峰出現(xiàn)具有一定穩(wěn)定性，且相對起振點的位置固定，因此利用信號發(fā)送至波峰經(jīng)歷的時間，再減去起振點至波峰點的時間間隔，便可得相對穩(wěn)定的超聲波傳播時間間隔。機器人平臺核心控制DGU8芯片，通過單片機自帶的脈沖計數(shù)器模塊對電機編碼盤處反饋回來的脈沖信號進行收集，但脈沖計數(shù)器的值累加到255時會向單片機發(fā)出計數(shù)器溢出中斷。單片機在接到溢出中斷時會將計數(shù)器中的值自動存儲到自帶的累加器中，并將計數(shù)器的值清0，以便繼續(xù)計入新的脈沖值。當(dāng)單片機檢測到定時器中斷到達后，單片機會讀出脈沖累加器中的值，并將累加器的值清零，以便開始進行下一個周期的脈沖計數(shù)。機器人平臺核心控制DG128芯片，通過單片機自帶的脈沖計數(shù)器模塊對電機編碼盤反饋的脈沖信號進行收集，當(dāng)脈沖計數(shù)器值累加到255時會向單片機發(fā)出計數(shù)器溢出中斷。單片機在接到溢出中斷時會將計數(shù)器中的值自動存儲到自帶的累加器中，并將計數(shù)器值清零，以便繼續(xù)計入新的脈沖值。當(dāng)單片機檢測到定時器中斷到達后，單片機會讀出脈沖累加器中的值，并將累加器值清零，以便開始下個周期的脈沖計數(shù)。通過電機編碼盤線數(shù)可得平臺驅(qū)動輪旋轉(zhuǎn)一圈所對應(yīng)的脈沖數(shù)，結(jié)合單位時間內(nèi)單片機反饋的脈沖數(shù)據(jù)，再利用單位時間內(nèi)單片機反饋脈沖與電機編碼盤線數(shù)的比值，即可得單位時間內(nèi)驅(qū)動輪轉(zhuǎn)動的角度，根據(jù)驅(qū)動輪的半徑即可推算行進距離。DG128有獨立工作的7路PWM波輸出口，機器人平臺設(shè)計中用到其中兩路，分別作為左右驅(qū)動電機的脈寬調(diào)制信號輸入。再任選一路作為搭載超聲傳感器的伺服電機的控制信號。其中電機PWM波頻率在IK 2KHz之間，舵機的控制信號則頻率不宜過高，以20ms 為周期，頻率控制在50Hz左右為佳，舵機內(nèi)部自帶有一個基準(zhǔn)電路和一個比較器，基準(zhǔn)電路產(chǎn)生周期為20ms，寬度1. 5ms的基準(zhǔn)信號，通過比較器將外加信號與基準(zhǔn)信號進行比較， 若給定信號小于基準(zhǔn)信號在Ims 1. 5ms之間變化，舵機的輸出轉(zhuǎn)角對應(yīng)為0 90°，并近似線性關(guān)系對應(yīng)；若給定信號大于基準(zhǔn)信號在1. 5ms 2ms之間變化，則舵機輸出對應(yīng)轉(zhuǎn)角為90 180°，并近似線性關(guān)系對應(yīng)。所以通過比較給定信號高電平的時間即可判斷出舵機對應(yīng)輸出的方向。此處高電平時間分別設(shè)為lmS、1.5mS、aiiS，分別對應(yīng)舵機的極左、居中和極右三種狀態(tài)。伺服電機的響應(yīng)速度在60° /0. Is左右，能匹配超聲波模塊收發(fā)速度，通過控制舵機左右左搖頭運動，可以基本實現(xiàn)本平臺所搭載的超聲波模塊對前方180°范圍內(nèi)零死角掃描。機器人平臺驅(qū)動電路利用場效應(yīng)管搭建H橋(H橋介紹由兩個三極管，一個可以對正極導(dǎo)通實現(xiàn)上拉，另一個可以對負極導(dǎo)通實現(xiàn)下拉。由兩套這樣的電路，在同一個電路中，同時一個上拉，另一個下拉，或相反，兩者總是保持相反的輸出，這樣可以在單電源的情況下使負載的極性倒過來。在此處是用于驅(qū)動電機正反轉(zhuǎn))而實施工作。H橋驅(qū)動電路主要利用的是N型場效應(yīng)管和P型場效應(yīng)管導(dǎo)通時門極電壓反向的特性來搭建上下橋臂，上橋臂選用P型MOS管，中間接通電機，下橋臂則使用N型MOS管，當(dāng)PWM波到來時，經(jīng)過數(shù)字電路的處理，輸入至光電耦合隔離單元將驅(qū)動信號放大，再用來驅(qū)動電機。超聲收發(fā)駕于掃描舵機的實施由兩部分組成，超聲波測距模塊和舵機模塊。舵機是直立著安裝在移動機器人的前端，而超聲波測距模塊則是通過一個連接件固定于舵機的轉(zhuǎn)軸上。當(dāng)舵機轉(zhuǎn)動時，超聲波測距模塊會隨著舵機的轉(zhuǎn)軸轉(zhuǎn)動。舵機屬于伺服電機，內(nèi)部擁有一個電位器反饋電機的轉(zhuǎn)角信息，形成內(nèi)反饋，從而可以精確地控制舵機的轉(zhuǎn)角，而控制轉(zhuǎn)角需控制PWM波的高電平時間在1 2ms之間變動，對應(yīng)舵機的輸出轉(zhuǎn)角在0 180° 之間變化，轉(zhuǎn)角與正脈寬時間成近似線性關(guān)系對應(yīng)。在精確控制轉(zhuǎn)角的同時，舵機還能夠?qū)刂浦噶钭龀隹焖俜磻?yīng)，它的反應(yīng)速度一般為0jS/60°。舵機的旋轉(zhuǎn)角度為180°，如此信息量已可滿足避障和路徑規(guī)劃的要求。具體工作過程如下系統(tǒng)初始化時，舵機偏轉(zhuǎn)回歸中值，即正對小車前方，準(zhǔn)備進行測距。接著進入測距掃描階段，在舵機到達程序要求角度位置之后，超聲波測距模塊開始測距，若在其量程范圍內(nèi)出現(xiàn)回波，則通過測距模塊主控單片機的串口模塊返回距離值，若沒有信號，則返回沒有獲得障礙物距離信號。系統(tǒng)的上一級處理單元獲得測量信號后，完成對信號的存儲和處理，同時發(fā)出舵機偏轉(zhuǎn)指令，使舵機偏轉(zhuǎn)一定的角度，等待下一次測距信號的返回。如果系統(tǒng)檢測到舵機偏轉(zhuǎn)已到某個方向的最大值，系統(tǒng)則會控制舵機朝另一個方向偏轉(zhuǎn)。流程圖如圖6。 紅外光電開關(guān)主要功能是對平臺前方約150°、30cm范圍內(nèi)的有效障礙物進行檢測，只要障礙物有足夠的反射面，經(jīng)過紅外光照射，接收管接收到反射信號后會將其轉(zhuǎn)換成為電平信號，再讀入單片機I/O 口中。通過讀取I/O 口的返回值，單片機將優(yōu)先對紅外開關(guān)的反饋信號做處理，因為在程序編寫時，將30cm默認為危險區(qū)域，需要優(yōu)先避障。具體的避障策略為保持原點，左右輪通過差速轉(zhuǎn)向，如圖7所示。
權(quán)利要求
1.一種導(dǎo)航機器人障礙探測方法，其特征在于，將超聲探測模塊架于掃描舵機之上，實現(xiàn)正前方的掃描探測；通過控制PWM波的高電平時間來控制掃描舵機的轉(zhuǎn)角；為減小測量誤差，采用以下方法測量超聲波傳播時間利用信號發(fā)送至波峰經(jīng)歷的時間，再減去起振點至波峰的時間間隔，得到超聲波傳播時間間隔，所述的波峰通過回波信號的包絡(luò)線獲得。
2.根據(jù)權(quán)利要求1所述的導(dǎo)航機器人障礙探測方法，其特征在于，PWM波的高電平時間在1 2ms之間變動，對應(yīng)掃描舵機的輸出轉(zhuǎn)角在0 180°之間變化。
3.根據(jù)權(quán)利要求1所述的導(dǎo)航機器人障礙探測方法，其特征在于，將5個光電傳感器在導(dǎo)航機器人的前端排成扇形陣列用于探測導(dǎo)航機器人的障礙物，相鄰的光電傳感器之間的夾角為37. 5°。
4.根據(jù)權(quán)利要求1所述的導(dǎo)航機器人障礙探測方法，其特征在于，電源通過H橋與導(dǎo)航機器人的驅(qū)動電機連接，實現(xiàn)單電源驅(qū)動電機的正轉(zhuǎn)和反轉(zhuǎn)。
5.一種導(dǎo)航機器人障礙探測系統(tǒng)，其特征在于，采用權(quán)利要求1-2或4任一項所述的導(dǎo)航機器人障礙探測方法，該導(dǎo)航機器人障礙探測系統(tǒng)包括超聲探測模塊、超聲掃描模塊和核心控制模塊；超聲探測模塊與超聲掃描模塊均與核心控制模塊連接；超聲探測模塊包括高壓驅(qū)動信號產(chǎn)生模塊和超聲波信號接收調(diào)整模塊；高壓驅(qū)動信號產(chǎn)生模塊的結(jié)構(gòu)為變壓器的初級線圈接方波信號；變壓器的次級線圈輸出升壓后的信號接超聲波發(fā)射頭；超聲波信號接收調(diào)整模塊的結(jié)構(gòu)為超聲波信號接收電路的輸出信號依次經(jīng)放大器和 A/D轉(zhuǎn)換器與核心控制模塊連接；超聲掃描模塊包括掃描舵機和用于驅(qū)動掃描舵機的PWM驅(qū)動電路。
6.根據(jù)權(quán)利要求5所述的導(dǎo)航機器人障礙探測系統(tǒng)，其特征在于，所述的方波信號的頻率為40kHz。
7.根據(jù)權(quán)利要求5所述的導(dǎo)航機器人障礙探測系統(tǒng)，其特征在于，所述的放大器由兩級運算放大器級聯(lián)而成。
8.根據(jù)權(quán)利要求6-7任一項所述的導(dǎo)航機器人障礙探測系統(tǒng)，其特征在于，還包括紅外探測補償模塊，紅外探測補償模塊包括設(shè)置在導(dǎo)航機器人的前端的5個光電傳感器，5個光電傳感器排成扇形陣列，相鄰的光電傳感器之間的夾角為37. 5°。
全文摘要
本發(fā)明公開了一種導(dǎo)航機器人障礙探測方法及系統(tǒng)，系統(tǒng)主要由超聲探測模塊、超聲掃描模塊、紅外探測補償模塊、機器人核心控制模塊構(gòu)成。其中超聲探測模塊主要由40kHz高壓驅(qū)動與超聲接收信號放大實現(xiàn)。將該模塊架于掃描舵機之上，實現(xiàn)正前方無死角180°掃描探測。并結(jié)合紅外測距實現(xiàn)對導(dǎo)航機器人超聲盲區(qū)的補償。驅(qū)動電路采用場效應(yīng)管搭建H橋?qū)崿F(xiàn)。本發(fā)明的導(dǎo)航機器人利用了一對超聲探頭實現(xiàn)平面多點感測，最遠測距范圍可至5.9m，探測盲區(qū)縮小至2cm。系統(tǒng)具有成本低廉、探測盲區(qū)小、抗衍射能力強，實時性好等特點，產(chǎn)業(yè)化前景看好?？捎糜谖⑿⌒蜋C器人導(dǎo)航、環(huán)境探測、智能車主動安全等領(lǐng)域。
文檔編號G01S15/93GK102445694SQ201110279659
公開日2012年5月9日 申請日期2011年9月20日 優(yōu)先權(quán)日2011年9月20日
發(fā)明者余伶俐, 唐琎, 尤作, 潘一嘯, 蔡自興 申請人:中南大學(xué)