RSS 2020 | 在目標、動力學(xué)和意圖不確定下的隱含信念空間運動規(guī)劃
二、問題規(guī)范化
該論文考慮的是如下圖所示的POMDP 問題:系統(tǒng)處于連續(xù)的狀態(tài)-動作-觀測空間中,而系統(tǒng)的狀態(tài)轉(zhuǎn)移除了受到上一時刻的狀態(tài)和動作影響,還由一個離散的隱變量z 決定,而每一時刻的觀測量則由當(dāng)前時刻的系統(tǒng)狀態(tài)以及隱變量共同決定。其中隱變量z 可用于表示系統(tǒng)中不確定性的不同模態(tài),如旁側(cè)車輛駕駛者的性格、不同行進路線的路況、路面的物理狀況等。
對隱變量z 的不同可能性的置信度b(z),我們可以通過如下定義進行更新。
問題的最終目標是對行為策略π 進行優(yōu)化,從而使得累計損失函數(shù)值 J 達到最低。
其中l(wèi) 和lf分別為根據(jù)置信度b 加權(quán)平均得到的過程損失函數(shù)和最終損失函數(shù)。由該公式取最優(yōu)行為策略π* 后得出的值函數(shù)V 可以表示成貝爾曼方程形式,進行遞歸處理。
三、方 法
論文提出了一種新的微分動態(tài)規(guī)劃(DDP)算法,Partially Observable Differential Dynamic Programming (PODDP),可用于解決連續(xù)空間下的POMDP 問題。與一般的iLQG/DDP 算法相似,PODDP 也把流程分為了前向過程(Forward Pass)和后向過程(Backward Pass),并對動作序列進行迭代優(yōu)化。
1. 前向過程在前向過程進行前,動作序列U = { u0, u1, …, uT-1 } 需要預(yù)先給定。在初始化的前向過程中,一般使用隨機生成的動作序列,或者通過某些前導(dǎo)知識有規(guī)律地生成動作序列。在此后的過程中,將使用前一次優(yōu)化得到的動作序列,進行迭代優(yōu)化。
在確定性系統(tǒng)中,由于狀態(tài)轉(zhuǎn)移過程是確定的,故給定的動作序列將衍生出一條鏈式的狀態(tài)序列。但在我們考慮的系統(tǒng)中,由于多模態(tài)不確定性的存在,類比于離散空間下的POMDP 問題,每一個節(jié)點都可以根據(jù)隱變量z 的不同取值可能性,延伸出多個分支,最終形成一個樹狀的軌跡推演,即軌跡樹(trajectory tree),如上圖所示。
為了更直觀地理解,我們可以考慮一個公路上的變道場景。如下圖,我們的汽車(紅色)希望變道到左側(cè)車道,可是左側(cè)車道上已經(jīng)有一輛車了。我們在進行軌跡優(yōu)化的時候,將未來可能獲得的關(guān)于旁側(cè)車輛駕駛者性格的觀測納入考慮當(dāng)中,對方可能是合作性格的,也可能是激進性格的,這兩種性格分別對應(yīng)兩個不同的模態(tài)。在向前推演的時候,根據(jù)這兩種不同模態(tài)的最大似然值進行分支,獲得軌跡推演樹。每一條從根節(jié)點到葉節(jié)點的完整支路對應(yīng)一條可能發(fā)生的軌跡。
2. 后向過程為了對軌跡樹進行優(yōu)化,我們首先定義值函數(shù)擾動方程Qt以描述在某一時刻t 下系統(tǒng)狀態(tài)和動作的擾動對值函數(shù)的影響。

最新活動更多
-
7月8日立即報名>> 【在線會議】英飛凌新一代智能照明方案賦能綠色建筑與工業(yè)互聯(lián)
-
7月22-29日立即報名>> 【線下論壇】第三屆安富利汽車生態(tài)圈峰會
-
7.30-8.1火熱報名中>> 全數(shù)會2025(第六屆)機器人及智能工廠展
-
7月31日免費預(yù)約>> OFweek 2025具身智能機器人產(chǎn)業(yè)技術(shù)創(chuàng)新應(yīng)用論壇
-
免費參會立即報名>> 7月30日- 8月1日 2025全數(shù)會工業(yè)芯片與傳感儀表展
-
即日-2025.8.1立即下載>> 《2024智能制造產(chǎn)業(yè)高端化、智能化、綠色化發(fā)展藍皮書》
推薦專題