一種視覺導航機器人的設計
在系統中,△的計算方法如下:首先計算出每隔五行掃描到的某一行白線的中點的△值,然后將機器人視野范圍內掃描得到的所有行的白線△值累加后求得均值,這個均值就是機器人視野范圍內白線的△值。采取這種算法是為了方便處理機器人視野范圍內存在多段白線時的情況。以圖5為例,機器人視野范圍內有兩段白線。這個時候,系統將兩條白線等效為平均△值對應的白線,這樣在機器人眼里始終只有一條白線,有效降低了機器人所應對的狀況的復雜度。
在計算出△值后,系統根據幾何原理便可計算出L,計算公式如下:本文引用地址:http://www.104case.com/article/188744.htm
L=Xr-[Xc-(Yr-Yc)×△]
Xr為機器人所在點橫坐標;Yr為機器人所在點縱坐標;Xc為白線中點橫坐標的均值;Yc為白線中點縱坐標的均值。
3.3 路徑跟蹤
移動機器人的路徑跟蹤就是通過調節機器人的運動速度和方向,使機器人沿期望的路徑運動。即L=0且△=0。機器人對路徑的跟蹤控制可以采用PID控制器、最優控制器、模糊控制器等方式。由于能力風暴機器人是一個具有延遲的非線性時變系統,難以建立精確的數學模型,故采用模糊控制器有一定的優越性。
根據人的駕駛經驗,當人駕駛汽車跟蹤附近路面上的一條車道線時,他首先要進行觀察,將此直線當作參考路徑,衡量車體與參考路徑段的橫向距離以及它們所處方向的夾角,而這種衡量是以一種模糊的概念給出的,如距離比較大,角度很小等。當發現車體離參考路徑很遠且與期望方向偏角較大時,可以駕駛汽車快速轉彎,向期望位置靠攏;而在離參考路徑很近,汽車朝向已正對前方車道線上某一位置時,就不需轉動方向盤來改變行駛方向,而是一直保持當前行駛狀態,直至離車道線上拐點比較近時,再找下一個參考路徑段。可以根據上述人的駕駛經驗設計模糊控制器,視覺導引的機器人控制系統結構如圖6所示。
3.3.1 模糊化
系統中模糊控制器的輸入量為距離偏差L和角度偏差△,輸出量為機器人小車相對車體軸線的轉向偏轉角β,輸入輸出量的論域、模糊子集以及模糊子集論域如表1所示。
由于在機器人實際運行過程中,偏差的產生具有隨機性,所以輸入輸出量的模糊子集的隸屬函數都采用高斯函數加以描述,即
Ci為隸屬函數的均值;δi為隸屬函數的標準差。
3.3.2 確定模糊規則
根據汽車駕駛的經驗可得出如表2所示的49條模糊控制規則。
3.3.3 模糊推理和解模糊
模糊推理采用間接合成法推理公式,假設現有輸入L*、△*,需求出輸出β*,推理過程如下:
其中合成運算。采用取大一取小(MAX-MIN)法。
采用質心法進行解模糊處理,從而得到精確的輸出值,解模糊計算公式如下:
將上述結果制成模糊控制表存儲起來,在機器人運行過程中只需在線查詢出相應的β值,而不必進行大量的數學運算,這樣可以節省運算時間,提高控制的實時性。
4 綜述
目前此系統已經通過中國科學技術大學教育處驗收,并作為本科生智能機器人教學實驗系統運行。為驗證本文提出的控制方法的有效性,我們按照上述控制策略在實驗場地中對機器人進行路徑跟蹤實驗。實驗場地為-2×2的綠色背景場地,在場地上貼上3 cm寬的白線作為引導線,如圖7所示。在實驗中,機器人能準確地跟蹤指定路徑。實驗表明,在實際應用中,采用模糊控制方法具有較好的穩定性和精度。通過HSL空間內運算有效地提高圖像信號對光照的魯棒性。此設計可作為簡單的算法驗證和策略測試平臺。
pid控制器相關文章:pid控制器原理
評論