Moving Horizon Estimation for Simultaneous Localization and Mapping with Robust Estimation Error Bounds
Fuente:
arXiv
Salvato in:
| Autori principali: | , , , |
|---|---|
| Natura: | Preprint |
| Pubblicazione: |
2024
|
| Soggetti: | |
| Accesso online: | |
| Tags: |
Aggiungi Tag
Nessun Tag, puoi essere il primo ad aggiungerne!!
|
| _version_ | 1866912127859556352 |
|---|---|
| author | Trisovic, Jelena Didier, Alexandre Muntwiler, Simon Zeilinger, Melanie N. |
| author_facet | Trisovic, Jelena Didier, Alexandre Muntwiler, Simon Zeilinger, Melanie N. |
| contents | This paper presents a robust moving horizon estimation (MHE) approach with provable estimation error bounds for solving the simultaneous localization and mapping (SLAM) problem. We derive sufficient conditions to guarantee robust stability in ego-state estimates and bounded errors in landmark position estimates, even under limited landmark visibility which directly affects overall system detectability. This is achieved by decoupling the MHE updates for the ego-state and landmark positions, enabling individual landmark updates only when the required detectability conditions are met. The decoupled MHE structure also allows for parallelization of landmark updates, improving computational efficiency. We discuss the key assumptions, including ego-state detectability and Lipschitz continuity of the landmark measurement model, with respect to typical SLAM sensor configurations, and introduce a streamlined method for the range measurement model. Simulation results validate the considered method, highlighting its efficacy and robustness to noise. |
| format | Preprint |
| id |
arxiv_https___arxiv_org_abs_2411_13310 |
| institution | arXiv |
| publishDate | 2024 |
| record_format | arxiv |
| spellingShingle | Moving Horizon Estimation for Simultaneous Localization and Mapping with Robust Estimation Error Bounds Trisovic, Jelena Didier, Alexandre Muntwiler, Simon Zeilinger, Melanie N. Systems and Control Robotics This paper presents a robust moving horizon estimation (MHE) approach with provable estimation error bounds for solving the simultaneous localization and mapping (SLAM) problem. We derive sufficient conditions to guarantee robust stability in ego-state estimates and bounded errors in landmark position estimates, even under limited landmark visibility which directly affects overall system detectability. This is achieved by decoupling the MHE updates for the ego-state and landmark positions, enabling individual landmark updates only when the required detectability conditions are met. The decoupled MHE structure also allows for parallelization of landmark updates, improving computational efficiency. We discuss the key assumptions, including ego-state detectability and Lipschitz continuity of the landmark measurement model, with respect to typical SLAM sensor configurations, and introduce a streamlined method for the range measurement model. Simulation results validate the considered method, highlighting its efficacy and robustness to noise. |
| title | Moving Horizon Estimation for Simultaneous Localization and Mapping with Robust Estimation Error Bounds |
| topic | Systems and Control Robotics |
| url | https://arxiv.org/abs/2411.13310 |