Axel Barrau Silvère Bonnabel An EKF-SLAM algorithm with consistency properties. 2015 abs/1510.06263 CoRR http://arxiv.org/abs/1510.06263 db/journals/corr/corr1510.html#BarrauB15