[[alternative]]Localization of mobile robots based on omni-directional ultrasonic sensing

碩士[[abstract]]本論文設計實現一個全方位超音波感測器，並且提出一個基於全方位超音波感測(Omni-Directional Ultrasonic Sensing)之定位方法來對室內之移動機器人(Mobile robot)做有效的定位(Localization)。本論文主要有兩部分：(1) 全方位超音波感測器的設計與實現以及(2) 基於全方位超音波感測之定位方法的設計與實現。在全方位超音波感測器的設計與實現上，本論文提出一超音波反射錐(Reflection Cone)的設計實現方式，讓超音波訊號在超音波反射錐上進行反射，因此超音波的感測角度可以擴大為360°之聲波平面，所以本論文所設計實現的超音波反射錐可改善一般超音波感測器在發射與接收之角度限制問題。在基於全方位超音波感測之定位方法的設計與實現上，本論文使用三角函數以及圓方程式兩種推算法對室內之移動機器人做定位。在實驗的系統架構上，本論文之實驗平台主要有一台內建有一個超音波反射錐之移動機器人、數個超音波接收器、以及一台遠端監控平台，每個超音波感測器之間利用Zig-Bee通訊模組來進行指令的下達與資料之傳輸。超音波接收器接收超音波發射器所發射的超音波訊號，並且利用超音波訊號之飛行時間(Time-Of-Flight, TOF)來進行距離值之推算。電腦將根據所收集到各個超音波接收器所計算之距離值進行三角座標推算法(Trigonometry coordinate calculation)與圓方程式座標推算法(Circular coordinate calculation)進行平面座標之計算，如此即可得到移動機器人於平面座標之定位。從實驗的數據結果可知，所提出之二種方法的量測誤差均低於機器人之最小直徑，因此可以有效的應用在移動機器人的定位上。[[abstract]]In this thesis, a localization method based on an omni-directional ultrasonic sensing is proposed for an indoor mobile robot to achieve an effective localization. There are two parts in this thesis: (1) Design and implementation of an omni-directional ultrasonic sensors, and (2) Design and implementation of a localization method based on the omni-directional ultrasonic sensing. In the design and implementation of a localization method based on the omni-directional ultrasonic sensing, two approaches based on trigonometric and circular derivation are considered to determine the localization the mobile robot. To evaluate the performance the proposed system, an experimental platform is established, including a mobile robot with an omni-directional ultrasonic sensor, several ultrasonic receivers, and a remote computer. Each ultrasonic sensor communicates with each other by using the Zig-Bee module to transmit instructions and data. Each ultrasonic receiver receives the ultrasonic signal transmitted by the ultrasonic transmitter. By using the TOF (Time-Of-Flight) of the ultrasonic signal, the distance between the receiver and the robot can be calculated. Based on the distance information collected from all the ultrasonic receivers, trigonometric coordinate calculation and circular coordinate calculation are applied to obtain the position coordinates of the mobile robot. From the experimental results, we know that all the measurement errors of two proposed methods are smaller than the diameter of the mobile robot. Therefore the proposed methods can be used to effectively localize the indoor mobile robots.[[tableofcontents]]目錄 V 圖目錄 VII 表目錄 IX 第一章 序論 1 1.1 研究背景 1 1.2 研究動機 3 1.3 論文架構 4 第二章 超音波量測系統介紹 5 2.1 超音波測距原理 5 2.2 超音波感測器介紹 7 2.3 超音波反射錐介紹 9 2.3.1 超音波角度限制 9 2.3.2 超音波反射錐設計 12 第三章 座標定位推算法 17 3.1 三角座標推算法 17 3.2 圓方程式座標推算法 20 第四章 全方位超音波定位系統介紹 28 4.1 系統架構 28 4.2 硬體架構 30 4.3 軟體架構 32 4.4 超音波工作時序 33 第五章 實驗結果 36 5.1 反射錐測試 36 5.2 定點測試 39 5.3 移動定位測試 50 第六章 結論與未來展望 52 參考文獻 53 圖目錄 圖 2.1、反射式測距法示意圖 5 圖 2.2、對射式測距法示意圖 6 圖 2.3、SRF02超音波感測器 7 圖 2.4、超音波感測器偵測角度db值示意圖 10 圖 2.5、超音波感測器以集中且不同角度擺設[7][19] 11 圖 2.6、空間中大量佈置超音波感測器[20] 11 圖 2.7、超音波反射錐實際配置圖 13 圖 2. 8、超音波反射錐設計示意圖 13 圖 2. 9、超音波訊號反射示意圖 14 圖 2. 10、超音波訊號經反射錐反射後呈現360°超音波平面示意圖 15 圖 2. 11、一般超音波測距與使用超音波反射錐測距之比較圖 16 圖 2. 12、超音波反射錐推論示意圖 16 圖 3.1、三角座標推算示意圖 18 圖 3.2、圓方程式座標推算示意圖 21 圖 3.3、兩圓內離示意圖 24 圖 3.4、兩圓內切示意圖 25 圖 3.5、兩圓相交於兩點示意圖 25 圖 3.6、兩圓外離示意圖 26 圖 3.7、兩圓外切示意圖 26 圖 4.1、全方位超音波定位系統架構示意圖 29 圖 4.2、超音波反射錐與超音波發射器關係圖 30 圖 4.3、硬體架構示意圖 31 圖 4.4、系統流程圖 32 圖 4.5、輪詢式操作時序圖 33 圖 4.6、全方位超音波定位系統操作時序圖 34 圖 5.1、全方位式超音波模組測試點示意圖 37 圖 5.2、全方位超音波定位系統測試點示意圖 39 圖 5.3、測量點1定位結果示意圖 40 圖 5.4、測量點2定位結果示意圖 41 圖 5.5、測量點3定位結果示意圖 42 圖 5.6、測量點4定位結果示意圖 43 圖 5.7、測量點5定位結果示意圖 44 圖 5.8、測量點6定位結果示意圖 45 圖 5.9、測量點7定位結果示意圖 46 圖 5.10、測量點8定位結果示意圖 47 圖 5.11、測量點9定位結果示意圖 48 圖 5.12、裝置全方位式超音波定位系統之履帶式移動平台 50 圖 5.13、全方位式超音波定位系統移動定位實驗結果 51 表目錄 表 2.1、SRF02超音波感測器規格表 8 表 5.1、全方位式超音波模組測試數據表 38 表 5.2、全方位式超音波定位系統定點實驗結果 49 表 5.3、全方位式超音波定位系統移動實驗結果 51[[note]]學號: 698460010, 學年度: 10