2021/10/14 by Shumon Koga, Koga, Shumon, Arash Asgharivaskasi +3
Computer Science · Engineering · #FOS: Computer and information sciences #FOS: Electrical engineering #FOS: Mathematics #Modular Robots and Swarm Intelligence #Optimization and Control (math.OC) #Optimization and Search Problems #Robotics (cs.RO) #Robotics and Sensor-Based Localization #Systems and Control (eess.SY) #electronic engineering #information engineering
paper · pdf · doi:10.48550/arxiv.2110.07546
openalex publication_date 2021/10/14 · openalex created_date 2022/10/09 · openalex updated_date 2026/07/28
This paper proposes a novel active Simultaneous Localization and Mapping (SLAM) method with continuous trajectory optimization over a stochastic robot dynamics model. The problem is formalized as a stochastic optimal control over the continuous robot kinematic model to minimize a cost function that involves the covariance matrix of the landmark states. We tackle the problem by separately obtaining an open-loop control sequence subject to deterministic dynamics by iterative Covariance Regulation (iCR) and a closed-loop feedback control under stochastic robot and covariance dynamics by Linear Quadratic Regulator (LQR). The proposed optimization method captures the coupling between localization and mapping in predicting uncertainty evolution and synthesizes highly informative sensing trajectories. We demonstrate its performance in active landmark-based SLAM using relative-position measurements with a limited field of view.