自主移動機器人的一個基本功能是可以自我確定自身在環(huán)境中的位置定位,。這就使得無論是在結(jié)構(gòu)化或非結(jié)構(gòu)化環(huán)境中,,機器人都可以確定自身與周圍環(huán)境的位置關(guān)系,,得以根據(jù)任務(wù)作出正確決策和路徑選擇,。因此定位技術(shù)對機器人實現(xiàn)自主功能是必不可少的。
目前,,應(yīng)用于機器人的定位方法有很多,,如借助里程計、方向計等內(nèi)部傳感器定位,;借助超聲,、激光測距儀等主動傳感器定位;以及通過攝像機等視覺傳感器實現(xiàn)定位等,。在結(jié)構(gòu)化環(huán)境中,,一般是在環(huán)境中預(yù)先建立電磁,可視路標或特殊地貌等已知信標,。機器人通過檢測信標的位置關(guān)系來確定自身位置,,而與具體的外部環(huán)境無關(guān)。
激光全局定位傳感器原理
傳感系統(tǒng)由旋轉(zhuǎn)機構(gòu),、反射鏡,、激光器、光電接收和數(shù)據(jù)采集與傳輸?shù)炔糠纸M成,。工作時,,激光經(jīng)旋轉(zhuǎn)鏡面機構(gòu)向外發(fā)射,當掃描到由后向反射器構(gòu)成的合作路標時,,反射光經(jīng)光電接收器件處理作為檢測信號,,啟動數(shù)據(jù)采集程序讀取旋轉(zhuǎn)機構(gòu)的碼盤數(shù)據(jù)(目標的測量角度值)。通過通訊傳遞到上位機進行數(shù)據(jù)處理,,根據(jù)已知參考路標的位置和檢測信息,,就可以計算出傳感器當前在路標坐標系下的位置和方向。
當傳感器檢測到合作路標時,反射激光束使光電轉(zhuǎn)換器工作,,產(chǎn)生接收調(diào)制脈沖信號,,此信號經(jīng)過濾波整形后作為捕捉信號,鎖存碼盤讀數(shù),,同時向CPU申請中斷,,讀取碼盤計數(shù)值并計算出當前路標的方位角。濾波整形電路的另一個作用是:當由于自然光或燈光的直射而使光電轉(zhuǎn)換器工作時,,它可以根據(jù)信號頻率的不同將其濾除而不產(chǎn)生中斷,以提高系統(tǒng)的抗干擾能力,。為提高角度分辨率,,轉(zhuǎn)角編碼器的數(shù)值經(jīng)倍頻計數(shù)器轉(zhuǎn)換為16位計數(shù)值,每度計數(shù)值為84,,這樣定位系統(tǒng)的最小角度分辨率可達到0.012°,。旋轉(zhuǎn)鏡面機構(gòu)每轉(zhuǎn)一周o由傳動機構(gòu)發(fā)出一回零信號使計數(shù)器清零o以保證碼盤計數(shù)器只記錄掃描一周內(nèi)的路標角度位置讀數(shù),同時告訴CPU獲取數(shù)據(jù)的起點,,旋轉(zhuǎn)鏡面機構(gòu)由電機驅(qū)動,,旋轉(zhuǎn)可達每秒10周,以滿足機器人行走時的位置采樣速率,。
單片機與上位機之間采用串行通訊,。上位機為車載數(shù)據(jù)處理機,以發(fā)送命令方式控制定位傳感器的啟動和接收單片機傳輸?shù)穆窐私嵌葦?shù)據(jù),,并根據(jù)這些信息和已知路標地圖,,計算傳感器的當前位置和方向,單片機利用回零中斷通過中斷方式將一周采集數(shù)據(jù)傳送給上位機,。