信任度表示
機器人必須有一個在地圖上有關它位置信任度的方法。機器人是否辨識一個單獨的特定位置作為它的當前位置,或它是否根據(jù)一組可能的位置描述它的位置情臭?如果以單個信任度完全表達多個可能位置点晴,那如何將這多個位置排序?這就是信任度表示方法的設計問題
信任度
一般來說機器人并不能直接測量它的真實狀態(tài),只能根據(jù)傳感器數(shù)據(jù),最佳估計它的狀態(tài)匾荆。所以機器人擁有的關于它狀態(tài)的知識只能由數(shù)據(jù)推測拌蜘。有關機器人狀態(tài)的最好猜測,叫信任度
單假設信任度和多假設信任度
單假設信任度
單假設信任度表示是移動機器人位置最直接可能的假設牙丽。給定某個環(huán)境地圖简卧,機器人關于位置的信任度表示為地圖上單個獨特的點。主要優(yōu)點來自以下事實烤芦,給定唯一的信任度举娩,位置沒有任意性。這個表示方法的非任意性本質加速了機器人在認知水平上(例如构罗,路徑規(guī)劃)的決策铜涉。機器人可以簡單地假定,它的信任度是正確的遂唧,然后可以根據(jù)它唯一的位置芙代,選擇其未來的動作。
機器人的位置更新一般分為兩步
1盖彭、在預測(或動作)更新期間纹烹,機器人利用本體感受式傳感器估計它的方位,例如召边,利用編碼器機器人估計它的運動铺呵。在這階段,量程器誤差隨時間積分掌实,有關機器人方位的不確定性增加
2陪蜻、在感知(或測量)更新期間,機器人利用外感式傳感器的信息贱鼻,校正預測階段所估計的位置宴卖。例如滋将,用一個測距儀測量它離墻的距離,并相應地校正在預測階段所估計的位置症昏。在感知階段随闽,機器人的方位不確定性縮小
基于概率地圖定位的兩種不同方法:馬爾可夫定位和卡爾曼濾波器定位
為了解決機器人定位問題,需要以下信息:
1肝谭、初始概率分布 在不知道機器人初始位置的情況下掘宪,初始信任度對整個姿態(tài)是均勻分布的
2、環(huán)境地圖
3攘烛、數(shù)據(jù) 為了定位魏滚,機器人顯然需要使用來自它本體感受式傳感器和外感受式傳感器數(shù)據(jù)。一般來講坟漱,我們用z表示從外感受式傳感器來的當前讀數(shù)鼠次,稱為觀測值。u表示從本體感受式傳感器來的讀數(shù)或控制輸入芋齿,對差分驅動機器人腥寇,u表示來自左輪右輪編碼器讀數(shù)
4、概率運動模型 從機器人運動學推導而來觅捆,x_t = f(x_t-1,u_t) 當前位置由前一個位置和編碼器讀數(shù)組成的函數(shù)f計算出
5赦役、概率測量模型 從外感受式傳感器模型推導出來
定位問題分類
位置跟蹤 機器人的當前位置是根據(jù)對它以前位置的知識而更新的
全局定位 全局定位假定機器人的初始位置是不知道的
綁架機器人問題 機器人被綁架,并且被移動到其他地方的情況栅炒,類似漂移
在說定位問題之前掂摔,搞清楚移動機器人中的先驗和后驗,先驗是在考慮任何傳感器測量之前职辅,對全空間的機器人位置的概率分布棒呛,后驗概率p(x|y) 是在納入數(shù)據(jù)之后計算的
馬爾可夫定位
馬爾可夫定位利用一個任意概率密度函數(shù)表示機器人的位置,跟蹤機器人的信任度狀態(tài)域携。
在兩種定位方法中,預測更新都是基于全概率定理鱼喉,也就是這個
感知更新 基于貝葉斯定理秀鞭,也就是這個
下面是關于公式對應機器人的解釋:
在讀取傳感器數(shù)據(jù)A之后,我們想要知道機器人占有指定位置B的概率P(B|A)扛禽。如果機器人早先在那個位置上锋边,我們只要將觀察這些測量的條件概率P(A|B),乘上在讀取傳感器數(shù)據(jù)之前编曼,機器人就在那里的概率P(B)豆巨。結果除以某個規(guī)格化因子P(A)。
重要的是掐场,P(A)不依賴于B往扔,P(A)_-1可以寫成為規(guī)格化因子η
馬爾可夫假設意味著它們的輸出x_t只是機器人以前位置x_t-1和它的最近動作(量程儀贩猎,通常是里程計)u_t和感知z_t的函數(shù)。然而在一般情況下萍膛,非馬爾可夫情況中吭服,系統(tǒng)狀態(tài)依賴于所有它的經歷
卡爾曼濾波定位
對卡爾曼濾波來講,狀態(tài)概率密度函數(shù)和觀測模型都是高斯分布蝗罗。
前面所說到的馬爾可夫定位在機器人位置方面可以表示任何概率密度函數(shù)艇棕,該方法是一般的,但是由于它的通用性所以效能很差串塑。
現(xiàn)在沼琉,我們換個角度考慮一下,對機器人定位來講桩匪,關鍵需求不是概率密度曲線的精確賦值刺桃,而是對魯棒定位至關重要的傳感器融合問題。機器人通常包含大量的異質的傳感器吸祟,各提供關于機器人定位線索瑟慈。關鍵是,各傳感器都經受它自己的失誤模式
下面圖中屋匕,系統(tǒng)有一個控制信號和作為輸入的系統(tǒng)誤差源葛碧。測量裝置能夠測量帶有誤差的某些系統(tǒng)狀態(tài)。
卡爾曼濾波器是基于系統(tǒng)的知識和測量裝置过吻,產生系統(tǒng)狀態(tài)最優(yōu)估計的一個數(shù)學機制进泼,是對系統(tǒng)噪聲,測量誤差和動態(tài)模型不確定性的描述
其中纤虽,系統(tǒng)被假定為是線性并具有高斯白噪聲乳绕。然而對于大多數(shù)移動機器人,系統(tǒng)并不是線性的逼纸⊙蟠耄卡爾曼濾波擴展到非線性系統(tǒng),稱為擴展卡爾曼濾波
卡爾曼濾波器定位不使用任何密度函數(shù)杰刽,而是用高斯代表機器人信任度菠发,運動模型和測量模型。
因為高斯簡單地由它的均值和協(xié)方差來定義贺嫂,在預測和測量(還記得嗎滓鸠?前面的馬爾可夫定位也是這兩個階段)階段這兩個參數(shù)被更新。很顯然第喳,由此帶來的問題就是卡爾曼濾波器定位這樣的假設限制了初始信任度以及高斯的選擇糜俗。這意味著,必須以一定的近似知道機器人的初始位置