Główne pojęcia
本文提出了一種基於解耦移動水平估計 (MHE) 的同步定位與地圖構建 (SLAM) 方法,該方法在有限的地標可見性下,通過分別更新機器人狀態和地標位置估計,保證了機器人狀態估計的穩健穩定性和地標位置估計的有界誤差。
Streszczenie
基於移動水平估計的同步定位與地圖構建:具備穩健估計誤差邊界
本研究探討了移動水平估計 (MHE) 應用於同步定位與地圖構建 (SLAM) 的估計誤差特性,特別關注由於地標可見性有限而導致的時變系統可偵測性問題。通過利用現有關於 MHE 穩健性的理論保證,並針對 SLAM 帶來的挑戰進行調整,本文提出了一種解耦的 MHE-SLAM 方案,並證明了機器人狀態估計的穩健穩定性以及地標估計的穩健誤差邊界。
SLAM 問題的背景
同步定位與地圖構建 (SLAM) 是指機器人利用自身和環境狀態的測量結果,在未知環境中定位自身並同時構建地圖的任務。傳統的 SLAM 方法包括基於濾波的方法(如擴展卡爾曼濾波器 (EKF) 和粒子濾波器 (PF))和基於優化的技術。近年來,基於優化的 SLAM 方法因其優越性而備受關注,並將 SLAM 公式化為約束非線性最小二乘問題。
移動水平估計 (MHE)
MHE 是一種常用於處理涉及噪聲和系統約束的非線性估計任務的技術,當滿足某些可偵測性條件時,它可以提供穩健的穩定性保證。然而,在 SLAM 中,由於地標的可見性是間歇性的,因此很難滿足持續激勵 (PE) 條件,這對基於 MHE 的 SLAM 方法的應用構成挑戰。
解耦 MHE-SLAM 方案
本文提出了一種解耦的 MHE-SLAM 方案,其中機器人狀態僅基於系統測量值進行估計,而地標位置僅基於環境測量值進行估計,同時保持機器人狀態固定。只有當滿足確保測量信息充分的條件時,才會執行後一種估計。
穩健性分析
本文證明了該方案可以得到機器人狀態的 RGES 估計和地標位置的有界估計誤差。此外,還證明了地標估計誤差邊界隨著滿足信息充分性條件的次數而減小。
應用於常見 SLAM 配置
本文討論了該方案與常見 SLAM 配置(如基於視覺慣性、激光雷達和立體相機的 SLAM)的相容性,並提出了一種適用於距離測量模型的簡化方案。