8 October 2007 in IEEE Transactions on Robotics
This paper investigates the convergence properties and consistency of extended Kalman filter (EKF) based simultaneous localization and mapping (SLAM) algorithms. Proofs of convergence are provided for the nonlinear two-dimensional SLAM problem with point landmarks observed using a range-and-bearing sensor. It is shown that the robot orientation uncertainty at the instant when landmarks are first observed has a significant effect on the limit and/or the lower bound of the uncertainties of the landmark position estimates. This paper also provides some insights to the inconsistencies of EKF based SLAM that have been recently observed. The fundamental cause of EKF SLAM inconsistency for two basic scenarios are clearly stated and associated theoretical proofs are provided.
10 January 2017 in IEEE Robotics and Automation Letters
In this letter, we investigate the convergence and consistency properties of an invariant-extended Kalman filter (RI-EKF) based simultaneous localization and mapping (SLAM) algorithm. Basic convergence properties of this algorithm are proven. These proofs do not require the restrictive assumption that the Jacobians of the motion and observation models need to be evaluated at the ground truth. It is also shown that the output of RI-EKF is invariant under any stochastic rigid body transformation in contrast to SO (3) based EKF SLAM algorithm (SO(3)-EKF) that is only invariant under deterministic rigid body transformation. Implications of these invariance properties on the consistency of the estimator are also discussed. Monte Carlo simulation results demonstrate that RI-EKF outperforms SO(3)-EKF, Robocentric-EKF and the “First Estimates Jacobian” EKF, for three-dimensional point feature-based SLAM.
1 July 2013 in European Journal of Operational Research
16 July 2018 in IEEE Robotics and Automation Letters
Real-time simultaneous localization and dense mapping is very helpful for providing virtual reality and augmented reality for surgeons or even surgical robots. In this letter, we propose MIS-SLAM: A complete real-time large-scale dense deformable SLAM system with stereoscope in minimal invasive surgery (MIS) based on heterogeneous computing by making full use of CPU and GPU. Idled CPU is used to perform ORB-SLAM for providing robust global pose. Strategies are taken to integrate modules from CPU and GPU. We solved the key problem raised in the previous work, that is, fast movement of scope and blurry images make the scope tracking fail. Benefiting from improved localization, MIS-SLAM can achieve large-scale scope localizing and dense mapping in real time. It transforms and deforms current model and incrementally fuses new observation while keeping vivid texture. In-vivo experiments conducted on publicly available datasets presented in the form of videos demonstrate the feasibility and practicality of MIS-SLAM for potential clinical purpose.
1 January 2020 in IEEE/ASME Transactions on Mechatronics
We present an active simultaneous localization and mapping~(SLAM) framework for a mobile robot to obtain a collision-free trajectory with good performance in SLAM uncertainty reduction and in an area coverage task. Based on a model predictive control~(MPC) framework, these two tasks are solved by the introduction of a control switching mechanism. For SLAM uncertainty reduction, graph topology is used to approximate the original problem as a constrained non-linear least-squares problem. A convex half-space representation is applied to relax non-convex spatial constraints that represent obstacle avoidance. Using convex relaxation, the problem is solved by a convex optimization method and a rounding procedure based on singular value decomposition (SVD). The area coverage task is addressed with a sequential quadratic programming (SQP) method. A submap joining approach, called Linear SLAM, is used to address the associated challenges of avoiding local minima, minimizing control switching, and potentially high computational cost. Finally, various simulations and experiments using an aerial robot are presented that verify the effectiveness of the proposed method, showing that our method produces a more accurate SLAM result and is more computationally efficient compared with multiple existing methods.
10 June 2019 in IEEE Transactions on Intelligent Transportation Systems
Global localization in 3D point clouds is a challenging task for mobile vehicles in outdoor scenarios, which requires the vehicle to localize itself correctly in a given map without prior knowledge of its pose. This is a critical component of autonomous vehicles or robots on the road for handling localization failures. In this paper, based on reduced dimension scan representations learned from neural networks, a solution to global localization is proposed by achieving place recognition first and then metric pose estimation in the global prior map. Specifically, we present a semi-handcrafted feature learning method for 3D Light detection and ranging (LiDAR) point clouds using artificial statistics and siamese network, which transforms the place recognition problem into a similarity modeling problem. Additionally, the sensor data using dimension reduced representations require less storage space and make the searching easier. With the learned representations by networks and the global poses, a prior map is built and used in the localization framework. In the localization step, position only observations obtained by place recognition are used in a particle filter algorithm to achieve precise pose estimation. To demonstrate the effectiveness of our place recognition and localization approach, KITTI benchmark and our multi-session datasets are employed for comparison with other geometric-based algorithms. The results show that our system can achieve both high accuracy and efficiency for long-term autonomy.