機器人的定位問題

信任度表示
機器人必須有一個在地圖上有關它位置信任度的方法。機器人是否辨識一個單獨的特定位置作為它的當前位置,或它是否根據(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),稱為擴展卡爾曼濾波

典型卡爾曼濾波應用.jpg


卡爾曼濾波器定位不使用任何密度函數(shù)杰刽,而是用高斯代表機器人信任度菠发,運動模型和測量模型。
因為高斯簡單地由它的均值和協(xié)方差來定義贺嫂,在預測測量(還記得嗎滓鸠?前面的馬爾可夫定位也是這兩個階段)階段這兩個參數(shù)被更新。很顯然第喳,由此帶來的問題就是卡爾曼濾波器定位這樣的假設限制了初始信任度以及高斯的選擇糜俗。這意味著,必須以一定的近似知道機器人的初始位置

最后編輯于
?著作權歸作者所有,轉載或內容合作請聯(lián)系作者
  • 序言:七十年代末,一起剝皮案震驚了整個濱河市悠抹,隨后出現(xiàn)的幾起案子珠月,更是在濱河造成了極大的恐慌,老刑警劉巖锌钮,帶你破解...
    沈念sama閱讀 206,839評論 6 482
  • 序言:濱河連續(xù)發(fā)生了三起死亡事件桥温,死亡現(xiàn)場離奇詭異,居然都是意外死亡梁丘,警方通過查閱死者的電腦和手機侵浸,發(fā)現(xiàn)死者居然都...
    沈念sama閱讀 88,543評論 2 382
  • 文/潘曉璐 我一進店門,熙熙樓的掌柜王于貴愁眉苦臉地迎上來氛谜,“玉大人掏觉,你說我怎么就攤上這事≈德” “怎么了澳腹?”我有些...
    開封第一講書人閱讀 153,116評論 0 344
  • 文/不壞的土叔 我叫張陵,是天一觀的道長杨何。 經常有香客問我酱塔,道長,這世上最難降的妖魔是什么危虱? 我笑而不...
    開封第一講書人閱讀 55,371評論 1 279
  • 正文 為了忘掉前任羊娃,我火速辦了婚禮,結果婚禮上埃跷,老公的妹妹穿的比我還像新娘蕊玷。我一直安慰自己,他們只是感情好弥雹,可當我...
    茶點故事閱讀 64,384評論 5 374
  • 文/花漫 我一把揭開白布垃帅。 她就那樣靜靜地躺著,像睡著了一般剪勿。 火紅的嫁衣襯著肌膚如雪贸诚。 梳的紋絲不亂的頭發(fā)上,一...
    開封第一講書人閱讀 49,111評論 1 285
  • 那天窗宦,我揣著相機與錄音赦颇,去河邊找鬼。 笑死赴涵,一個胖子當著我的面吹牛,可吹牛的內容都是我干的订讼。 我是一名探鬼主播髓窜,決...
    沈念sama閱讀 38,416評論 3 400
  • 文/蒼蘭香墨 我猛地睜開眼,長吁一口氣:“原來是場噩夢啊……” “哼!你這毒婦竟也來了寄纵?” 一聲冷哼從身側響起鳖敷,我...
    開封第一講書人閱讀 37,053評論 0 259
  • 序言:老撾萬榮一對情侶失蹤,失蹤者是張志新(化名)和其女友劉穎程拭,沒想到半個月后定踱,有當?shù)厝嗽跇淞掷锇l(fā)現(xiàn)了一具尸體,經...
    沈念sama閱讀 43,558評論 1 300
  • 正文 獨居荒郊野嶺守林人離奇死亡恃鞋,尸身上長有42處帶血的膿包…… 初始之章·張勛 以下內容為張勛視角 年9月15日...
    茶點故事閱讀 36,007評論 2 325
  • 正文 我和宋清朗相戀三年崖媚,在試婚紗的時候發(fā)現(xiàn)自己被綠了。 大學時的朋友給我發(fā)了我未婚夫和他白月光在一起吃飯的照片恤浪。...
    茶點故事閱讀 38,117評論 1 334
  • 序言:一個原本活蹦亂跳的男人離奇死亡畅哑,死狀恐怖,靈堂內的尸體忽然破棺而出水由,到底是詐尸還是另有隱情荠呐,我是刑警寧澤,帶...
    沈念sama閱讀 33,756評論 4 324
  • 正文 年R本政府宣布砂客,位于F島的核電站泥张,受9級特大地震影響,放射性物質發(fā)生泄漏鞠值。R本人自食惡果不足惜媚创,卻給世界環(huán)境...
    茶點故事閱讀 39,324評論 3 307
  • 文/蒙蒙 一、第九天 我趴在偏房一處隱蔽的房頂上張望齿诉。 院中可真熱鬧筝野,春花似錦、人聲如沸粤剧。這莊子的主人今日做“春日...
    開封第一講書人閱讀 30,315評論 0 19
  • 文/蒼蘭香墨 我抬頭看了看天上的太陽抵恋。三九已至焕议,卻和暖如春,著一層夾襖步出監(jiān)牢的瞬間弧关,已是汗流浹背盅安。 一陣腳步聲響...
    開封第一講書人閱讀 31,539評論 1 262
  • 我被黑心中介騙來泰國打工, 沒想到剛下飛機就差點兒被人妖公主榨干…… 1. 我叫王不留世囊,地道東北人别瞭。 一個月前我還...
    沈念sama閱讀 45,578評論 2 355
  • 正文 我出身青樓,卻偏偏與公主長得像株憾,于是被迫代替她去往敵國和親蝙寨。 傳聞我的和親對象是個殘疾皇子晒衩,可洞房花燭夜當晚...
    茶點故事閱讀 42,877評論 2 345

推薦閱讀更多精彩內容