基于紅外超聲光電編碼器的室內移動(dòng)小車(chē)定位系統

　　引 言

　　目前，使用超聲波技術(shù)進(jìn)行空間測量和定位已相當普遍。有的運用超聲波的反射特性，有的綜合運用紅外和超聲波傳感器采取三邊測距的定位方法，前者因為超聲波傳輸介質(zhì)的影響使測量精度無(wú)法提高，超聲波衰減特性使其傳播的距離有限，再利用反射特性更加縮短了傳播的距離。后者雖然精度有所提高，測量的距離增加了，但是出現了測量盲區的問(wèn)題，待測目標在某些位置不能同時(shí)檢測到3個(gè)以上的超聲波信號時(shí)，使系統無(wú)法定位。本文在第2種方法的基礎上在系統中加入了光電編碼器測距定位原理，消除其定位盲區的問(wèn)題。

　　1 定位原理

　　1.1 紅外超聲三邊測距定位原理

　　首先在室內建立一直角坐標系，規定好原點(diǎn)、X軸、Y軸、和Z軸。在室內上空固定位置設立3個(gè)參考點(diǎn)A、B、C，坐標分別為(x1，y1，z1)、(x2，y2，z2)、(x3，y3，z3)。使用紅外超聲系統測出目標點(diǎn)到3個(gè)參考點(diǎn)的距離L、M、N為：

　　由式(1)～式(3)解出目標點(diǎn)的坐標值(x，y，z)。這就是紅外超聲的定位原理，簡(jiǎn)單且容易編程實(shí)現。下面說(shuō)明目標點(diǎn)與參考點(diǎn)間距離的測量原理。光速與超聲波速度在量級上的極大差值是實(shí)現測距功能的基礎。測距原理見(jiàn)圖1。

　　超聲波和紅外光的傳播速度為常量，其傳播距離與時(shí)間的曲線(xiàn)均為直線(xiàn)，直線(xiàn)斜率即波速，易知曲線(xiàn)①為紅外光曲線(xiàn)，曲線(xiàn)②為超聲波曲線(xiàn)。指定距離D，設紅外光與超聲波在0時(shí)刻同時(shí)從某一參考點(diǎn)出發(fā)，紅外光經(jīng)t1時(shí)間走完指定距離，超聲波經(jīng)t2時(shí)間走完指定距離，則D=vt2，式中v為超聲波速。令t=t2-t1，可得D=v(t+t1)。已知紅外光速為3×108m/s，超聲波在空氣中速度為3.4×102m/s，在室內這樣的距離范圍，近似認為t1=0，得到D=vt。

　　系統在每個(gè)參考點(diǎn)安裝單片機控制的紅外和超聲波發(fā)射管，在目標點(diǎn)安裝紅外和超聲波接收管，同樣連接單片機。某一時(shí)刻參考點(diǎn)發(fā)射紅外和超聲信號，目標點(diǎn)在接收到紅外信號時(shí)啟動(dòng)單片機的內部計數器、在接收到超聲信號時(shí)停止計數器，這樣二者的時(shí)間差t被記錄下來(lái)，將t與超聲波速相乘就得到待測距離D。實(shí)際上，信號處理總是有延時(shí)的，由此帶來(lái)的測量誤差必須補償，最終得到算式為：d=vt+n。式中：d為距離測量值;v為超聲波速;t為單片機記錄的紅外光和超聲披到達目標點(diǎn)的時(shí)間差值;n為系統器件延遲誤差補償項。

　　1.2 光電編碼器測距定位原理

　　光電編碼器是一種通過(guò)光電轉換將輸出軸上的機械幾何位移量轉換成脈沖或數字量的傳感器，這是目前應用最多的傳感器，由光柵盤(pán)和光電檢測裝置組成。

　　光柵盤(pán)是在一定直徑的圓板上等分地開(kāi)通若干個(gè)長(cháng)方形孔。由于光電碼盤(pán)(稱(chēng)為譯碼輪，見(jiàn)圖2)與電動(dòng)機同軸，電動(dòng)機旋轉時(shí)，光柵盤(pán)與電動(dòng)機同速旋轉，經(jīng)發(fā)光二極管等電子元件組成的檢測裝置檢測輸出若干脈沖信號。發(fā)光二極管和光敏傳感器組成光電耦合器。光敏傳感器內部沿垂直方向排列有2個(gè)光敏晶體管A和B。由于譯碼輪有間隙，故當譯碼輪轉動(dòng)時(shí)，紅外發(fā)光二極管發(fā)出的紅外線(xiàn)時(shí)而照在光敏傳感器上，時(shí)而被阻斷，從而使光敏傳感器輸出脈沖信號。光敏晶體管A和B被安放的位置使得其光照和阻斷的時(shí)間有差異，從而產(chǎn)生的脈沖A和脈沖B有一定的相位差。利用這種方法，就能測出碼盤(pán)滾軸滾動(dòng)方向。滾軸每轉動(dòng)一個(gè)小角度，車(chē)輪位置計數器加1，每隔一定時(shí)間，單片機把車(chē)輪位置計數器的值讀出，通過(guò)計算得出車(chē)輪移動(dòng)的位移(當小車(chē)轉彎時(shí)為弧線(xiàn)長(cháng)度和弧線(xiàn)切線(xiàn)方向)，再把位移信息發(fā)送給上位機。

　　基于以上原理，在同軸二輪驅動(dòng)小車(chē)(同軸二輪驅動(dòng)小車(chē)的2個(gè)輪子的運行軌跡總是平行的)的2個(gè)驅動(dòng)輪子的正上方一定高度的a、b這2點(diǎn)安裝紅外超聲定位單元，絕對定位每個(gè)點(diǎn)的坐標。在2個(gè)輪子各自軸上安裝光電編碼器測距單元，用來(lái)測量2個(gè)定位時(shí)刻點(diǎn)間輪子移動(dòng)的距離和前進(jìn)倒退情況。

　　對移動(dòng)小車(chē)的定位分為3種情況：

　　a) 在某一定位時(shí)刻a、b這2點(diǎn)能夠同時(shí)檢測到3個(gè)參考點(diǎn)的信號(地面是平的，進(jìn)行平面二維定位時(shí)只需2個(gè)信號)，就用紅外超聲絕對定位方法計算移動(dòng)小車(chē)的位置，計算出它們中點(diǎn)的位置(即移動(dòng)小車(chē)的位置)，并根據前一時(shí)刻a、b這2點(diǎn)的坐標、2個(gè)輪子間的固定距離判斷出輪子相對于所建坐標系的運行方向。

　　b) a、b中只有1點(diǎn)能夠同時(shí)檢測到3個(gè)參考點(diǎn)的信號，則根據前一時(shí)刻a、b這2點(diǎn)的坐標、光電編碼器測得2個(gè)輪子的移動(dòng)距離長(cháng)短比較、2個(gè)輪子間的同定距離計算出移動(dòng)小車(chē)的位置和運行方向。

　　c) a、b這2點(diǎn)都不能同時(shí)檢測到3個(gè)參考點(diǎn)的信號，則根據前一時(shí)刻a、b這2點(diǎn)的坐標、2個(gè)輪子的固定距離、光電編碼器測得2個(gè)輪子的移動(dòng)距離計算出小車(chē)的坐標和運行方向。

　　下面給出第2種情況的求解方法，見(jiàn)圖3。通過(guò)比較光電編碼器所測2個(gè)輪子的移動(dòng)距離，可得出小車(chē)向移動(dòng)距離短的輪子一側轉彎，已知紅外超聲測得的a′、b′、b點(diǎn)的坐標，2個(gè)輪子的間距d，線(xiàn)段aa′和bb′平行，ab和小車(chē)的運動(dòng)方向垂直，根據幾何知識可以求出a點(diǎn)的坐標和小車(chē)的移動(dòng)方向，其他情況亦然。

　　2 系統的硬件結構

　　系統主要由超聲波信標節點(diǎn)(參考點(diǎn))、一個(gè)紅外發(fā)射管、一個(gè)超聲波發(fā)射頭及各自的驅動(dòng)電路和微控制器SST89E564RD(以下簡(jiǎn)稱(chēng)564RD)8位單片機組成。普通節點(diǎn)(目標點(diǎn))由8個(gè)紅外接收管、8個(gè)超聲波接收頭及各自的驅動(dòng)電路和8個(gè)564RD組成紅外超聲接收單元，每一個(gè)紅外接收和超聲波接收為一對，用一個(gè)564RD控制，分成2組，每組4對，在每個(gè)輪子的上方一定高度間隔90°與水平面成45°夾角向上分布。因為測量的目標點(diǎn)是移動(dòng)物體，所以采用多通道同時(shí)接收的方法縮短每次測量所用的時(shí)間，提高定位精度。光電編碼器測距單元由譯碼輪、光電偶合器和一片564RD組成。用1片564RD作為主控芯片，與8個(gè)超聲波接收單元、2個(gè)光電編碼器測距單元使用串口進(jìn)行通信，主控制器瀆取各個(gè)單元的測量數據，完成定位運算，同時(shí)起到同步各個(gè)單元工作的作用。564RD的晶振都為40 MHz。圖4給出單個(gè)紅外管和超聲波發(fā)射電路，圖5給出單個(gè)紅外管超聲波接收電路。超盧波的發(fā)射管為T(mén)40-16(對應接收管為R40-16)，中心頻率為40 kHz。紅外發(fā)射管為SE303A(對應接收管為PH302)，564RD用2個(gè)I/O口分別輸出載頻為40 kHz、調頻為5 kHz的方波信號驅動(dòng)紅外發(fā)射管，以及載頻為40 kHz、調頻2 kHz的方波信號驅動(dòng)超聲波發(fā)射管。

　　3 系統的軟件設計

　　系統上電后各單元進(jìn)行初始化，各部分工作如下：

　　a) 超聲波信標節點(diǎn)不斷向外發(fā)射紅外和超聲波信號，每個(gè)節點(diǎn)的紅外與超聲波信號編碼相對應，并且與其他節點(diǎn)的信號編碼不同。

　　b) 普通節點(diǎn)每隔1 s(可以改變，但不能太長(cháng)，否則小車(chē)出現拐彎時(shí)運行軌跡可能不平行)進(jìn)行一次定位，主控制器通過(guò)串口向各個(gè)單元發(fā)出定位信號并啟動(dòng)內部定時(shí)器，延時(shí)100 ms后依次讀取8個(gè)超聲測距單元所測得的a、b這2點(diǎn)到參考點(diǎn)的距離信息和2個(gè)光電編碼器測距單元記錄的位移信息，計算出移動(dòng)小車(chē)的位置和運行方向。定時(shí)器定時(shí)到1 s后重復此過(guò)程。主控制器的軟件流程如圖6所示。

　　c) 2個(gè)光電編碼器測距單元初始化后立刻開(kāi)始記錄輪子的位移，串口收到定位信號后，將記錄的位移信息存到指定位置，等待主控制器讀取，并從0開(kāi)始繼續記錄位移情況。

　　d) 普通節點(diǎn)檢測到定位信號后，接收紅外和超聲波信號，記錄一組相對應的紅外超聲信號的超聲波傳輸時(shí)間，存到指定的位置，等待主控制器讀取。在串口接收到定位信號的開(kāi)始100 ms時(shí)間內有這樣的信號，則把第1次接收到對應的時(shí)間存人指定的位置就不再檢測接收了，如果100 ms時(shí)間內沒(méi)有檢測到相應的信號，就送數據0到指定的位置。

　　4 系統誤差分析及實(shí)驗測距結果

　　定位誤差主要有以下5方面：超聲波器件的形狀和安裝位置造成坐標系參考點(diǎn)和待測目標點(diǎn)的位置偏差;系統電路器件延遲產(chǎn)生的誤差;小車(chē)是不斷運動(dòng)的，由于超聲波傳輸速度比較慢，請求定位時(shí)刻到定位完成，小車(chē)已經(jīng)移動(dòng)了一定的距離;在不能連續檢測到足夠參考點(diǎn)信號時(shí)，位置的確定依靠前一時(shí)刻的測量，會(huì )造成累計誤差;溫度條件對超聲波的影響。

　　圖7給出了在室溫20℃、超聲波速度為340m/s、小車(chē)2個(gè)輪子間距離為0.2 m、移動(dòng)速度為0.2 m/s、平面二維定位實(shí)驗測量的一段軌跡，實(shí)驗通過(guò)對前3個(gè)方面誤差補償計算，使定位精度達到3 cm。

　　5 結束語(yǔ)

　　因為光電編碼器測距定位依靠前一測量點(diǎn)的信息，必然導致定位誤差的累積;而紅外超聲三邊測距法是一種只依靠當前測量點(diǎn)信息的絕對位置定位方法。此系統綜合了這2種方法，消除了累積誤差，并解決了定位盲區的問(wèn)題，對移動(dòng)小車(chē)有一個(gè)較準確的定位。