Error State Extended Kalman Filter Localization for Underground Mining Environments
Open Access
Abstract
The article addresses the issue of mobile robotic platform positioning in GNSS-denied environments in real-time. The proposed system relies on fusing data from an Inertial Measurement Unit (IMU), magnetometer, and encoders. To get symmetrical error gauss distribution for the measurement model and achieve better performance, the Error-state Extended Kalman Filter (ES EKF) is chosen. There are two stages of vector state determination: vector state propagation based on accelerometer and gyroscope data and correction by measurements from additional sensors. The error state vector is composed of the velocities along the x and y axes generated by combining encoder data and the orientation of the magnetometer around the axis z. The orientation angle is obtained from the magnetometer directly. The key feature of the algorithm is the IMU measurements’ isolation from additional sensor data, with its further summation in the correction step. Validation is performed by a simulation in the ROS (Robot Operating System) and the Gazebo environment on the grounds of the developed mathematical model. Trajectories for the ES EKF, Extended Kalman Filter (EKF), and Unscented Kalman Filter (UKF) algorithms are obtained. Absolute position errors for all trajectories are calculated with an EVO package. It is shown that using the simplified version of IMU’s error equations allows for the achievement of comparable position errors for the proposed algorithm, EKF and UKF.Keywords
This publication has 40 references indexed in Scilit:
- Development of a Neural Network for Earth Surface Deformation PredictionGeotechnical and Geological Engineering, 2017
- Dead reckoning using an attitude and heading reference system based on a free gyro with equatorial orientationGyroscopy and Navigation, 2017
- Comparison of Unscented and Extended Kalman Filters with Application in Vehicle NavigationJournal of Navigation, 2016
- A Robust Approach for Improving the Accuracy of IMU based Indoor Mobile Robot Localization2016
- Mobile robot localization via EKF and UKF: A comparison based on real dataRobotics and Autonomous Systems, 2015
- A Generalized Extended Kalman Filter Implementation for the Robot Operating System2015
- Unmanned Rotorcraft Systems2011
- Indirect Kalman Filter in Mobile Robot ApplicationJournal of Mathematics and Statistics, 2010
- Strapdown Inertial Navigation Technology2004
- Circumventing dynamic modeling: evaluation of the error-state Kalman filter applied to mobile robot localization2003