Invariant EKF Design for Scan Matching-Aided Localization

  title={Invariant EKF Design for Scan Matching-Aided Localization},
  author={Martin Barczyk and Silv{\'e}re Bonnabel and Jean-Emmanuel Deschaud and François Goulette},
  journal={IEEE Transactions on Control Systems Technology},
Localization in indoor environments is a technique that estimates the robot's pose by fusing data from onboard motion sensors with readings of the environment, in our case obtained by scan matching point clouds captured by a low-cost Kinect depth camera. We develop both an invariant extended Kalman filter (IEKF)-based and a multiplicative extended Kalman filter-based solution to this problem. The two designs are successfully validated in experiments and demonstrate the advantage of the IEKF… 

Figures from this paper

Invariant filtering for Pose EKF-SLAM aided by an IMU

This paper presents a new method to combine measurements from motion sensors (wheel encoders or inertial measurements) with relative pose estimates inferred from scan matching of dense depth images

Invariant observer design for scan matching-aided localization: A tutorial

This paper provides a tutorial presentation of the required background, design steps and calculations of a scan matching-aided localization observer using the novel invariant (symmetry-preserving) observer design methodology.

An EKF-SLAM algorithm with consistency properties

In this paper we address the inconsistency of the EKF-based SLAM algorithm that stems from non-observability of the origin and orientation of the global reference frame. We prove on the non-linear

Towards realistic covariance estimation of ICP-based Kinect V1 scan matching: The 1D case

This paper presents a novel approach to estimating the covariance of pose estimates obtained from ICP-based scan matching of point clouds from this sensor, and derives a closed-form formula which can be computed in real time onboard the robot's hardware.

On the covariance of ICP-based scan-matching techniques

This paper provides a formal mathematical proof why the approach to estimating the covariance of roto-translations computed by the Iterative Closest Point algorithm is valid in the point-to-plane version of ICP, which validates the intuition and experimental results of practitioners.

An Improved Hector SLAM Algorithm based on Information Fusion for Mobile Robot

  • Naigong YuBo Zhang
  • Computer Science
    2018 5th IEEE International Conference on Cloud Computing and Intelligence Systems (CCIS)
  • 2018
An improved Hector SLAM algorithm based on information fusion for mobile robot based on extending Kalman Filtering fusing the information of odometry, IMU and laser scanning to provide precise input information for scan matching process is proposed.

A New Approach to 3D ICP Covariance Estimation

A novel approach to 3D uncertainty of ICP that accounts for all the sources of error as listed in Censi's pioneering work, namely wrong convergence, underconstrained situations, and sensor noise is proposed.

Application of fusion filtering algorithm in AGV localization

A fusion filter is proposed in this paper, and it is applied to the AGV localization, and the experiment result shows that the fusion filter algorithm eliminates the error caused by the initial error compared with the simple extended Kalman filter algorithm.

Towards Realistic Covariance Estimation of ICP-based Kinect V 1 Scan Matching : the 1 D Case Martin Barczyk and Silvère Bonnabel

The Iterative Closest Point (ICP) algorithm is a classical approach to obtaining relative pose estimates of a robot by scan matching successive point clouds captured by an onboard depth camera such

Robust Localization of the Mobile Robot Driven by Lidar Measurement and Matching for Ongoing Scene

A hybrid localization algorithm that based on adaptive weights can realize a good robustness for tasks such as autonomous navigation and path planning in construction scenes.



Experimental implementation of an Invariant Extended Kalman Filter-based scan matching SLAM

The theoretical foundations of the IEKF and its practical interest of guaranteeing robustness to poor state estimates are reviewed, then the filter is implemented on a wheeled robot hardware platform.

On the covariance of scan-matching techniques for localization

This paper justifies that the method is applicable to point-to-plane ICP as already known to practitioners, by proposing a geometric mathematical proof bounding the errors made, and proves this approach is on shaky ground because the rematching step of the ICP is not explicitly accounted for.

2D LIDAR Aided INS for vehicle positioning in urban environments

  • Sheng ZhaoJ. Farrell
  • Environmental Science
    2013 IEEE International Conference on Control Applications (CCA)
  • 2013
A closed-form formula is derived to predict the line measurement in the LIDAR's frame, which makes the feature association, residual formation and GUI display possible and the effectiveness of the LidAR aiding in reducing the state estimation uncertainty along certain directions, when GNSS signals are shadowed.

Robot Pose Estimation in Unknown Environments by Matching 2D Range Scans

  • F. LuE. Milios
  • Computer Science
    1994 Proceedings of IEEE Conference on Computer Vision and Pattern Recognition
  • 1994
Two new iterative algorithms to register a range scan to a previous scan so as to compute relative robot positions in an unknown environment, that avoid the above problems.

Accurate 3D maps from depth images and motion sensors via nonlinear Kalman filtering

Experiments with a Kinect sensor and a three-axis gyroscope prove clear improvement in the accuracy of the localization, and thus in the accuracies of the built 3D map.

Robot localization based on scan-matching - estimating the covariance matrix for the IDC algorithm

Generalized Multiplicative Extended Kalman Filter for Aided Attitude and Heading Reference System

In this paper, we propose a “Generalized Multiplicative Extended Kalman Filter” (GMEKF) to estimate the position and velocity vectors and the orientation of a flying rigid body, using measurements

Robust Nonlinear Fusion of Inertial and Visual Data for position, velocity and attitude estimation of UAV

A coupled observer is presented that uses accelerometer, gyrometer and vision sensors to provide estimates of pose and linear velocity for an aerial robotic vehicle and incorporates adaptive estimates of measurement bias in gyrometers and accelerometers commonly encountered in low-cost inertial measurement systems.

A nonlinear observer approach for concurrent estimation of pose, IMU bias and camera-to-IMU rotation

The main contribution of this work is the design of new observers to estimate pose, IMU bias and camera-to-IMU rotation in an inertial-visual sensor.

Comparison of surface normal estimation methods for range sensing applications

A detailed analysis and comparison of existing methods for surface normal estimation with a special emphasis on the trade-off between quality and speed is presented and guidelines on choosing the ‘right’ algorithm for the robotics practitioner are provided.