Global attitude estimation and dead reckoning of a mobile spherical robot using extended Kalman filter

This paper explores a quaternion based extended Kalman Filter (EKF) for estimating the attitude of a nonholonomic spherical robot using a 3-axis gyroscope, accelerometer and magnetometer. A low cost inertial measurement Unit (IMU) and magnetometer are mounted on the spherical robot and the measured data are fused with EKF to determine the attitude of the robot. The attitude of a spherical robot is a time-parameterized curve in SO(3) and hence is ideal for validating its attitude globally. An indoor experiment was carried by dead-reckoning on circular and trifolium trajectory. The ground truth was established by integrating the robot kinematics using the estimated attitude and then comparing it with the reference trajectory. A high cross correlation between the experimental data and true trajectory was obtained suggesting a strong match.

[1]  Gerhard P. Hancke,et al.  Pose Estimation of a Mobile Robot Based on Fusion of IMU Data and Vision Data Using an Extended Kalman Filter , 2017, Sensors.

[2]  F. Markley Attitude Error Representations for Kalman Filtering , 2003 .

[3]  Ravi N. Banavar,et al.  The Euler-Poincaré equations for a spherical robot actuated by a pendulum , 2012 .

[4]  D. Simon Optimal State Estimation: Kalman, H Infinity, and Nonlinear Approaches , 2006 .

[5]  Marie-José Aldon,et al.  Mobile robot attitude estimation by fusion of inertial data , 1993, [1993] Proceedings IEEE International Conference on Robotics and Automation.

[6]  Sheng Liu,et al.  Quaternion-Based Unscented Kalman Filter for Accurate Indoor Heading Estimation Using Wearable Multi-Sensor System , 2015, Sensors.

[8]  G. Chang Loosely Coupled INS/GPS Integration with Constant Lever Arm using Marginal Unscented Kalman Filter , 2013, Journal of Navigation.

[9]  Zheyao Wang,et al.  Motion Measurement Using Inertial Sensors, Ultrasonic Sensors, and Magnetometers With Extended Kalman Filter for Data Fusion , 2012, IEEE Sensors Journal.

[10]  Andrew G. Dempster,et al.  Performance analysis of Fast Unscented Kalman Filters for Attitude Determination , 2018 .

[11]  Angelo M. Sabatini,et al.  Extended Kalman Filter-Based Methods for Pose Estimation Using Visual, Inertial and Magnetic Sensors: Comparative Analysis and Performance Evaluation , 2013, Sensors.

[12]  Matthew Leccadito,et al.  A Kalman Filter Based Attitude Heading Reference System Using a Low Cost Inertial Measurement Unit , 2015 .

[13]  James Diebel,et al.  Representing Attitude : Euler Angles , Unit Quaternions , and Rotation Vectors , 2006 .

[14]  Arun D. Mahindrakar,et al.  Geometric Controllability and Stabilization of Spherical Robot Dynamics , 2015, IEEE Transactions on Automatic Control.

[15]  E. J. Lefferts,et al.  Kalman Filtering for Spacecraft Attitude Estimation , 1982 .

[16]  Richard M. Murray,et al.  A Mathematical Introduction to Robotic Manipulation , 1994 .

[17]  Anthony M. Bloch,et al.  Controllability and motion planning of a multibody Chaplygin's sphere and Chaplygin's top , 2008 .

[18]  Angelo M. Sabatini,et al.  Quaternion-based extended Kalman filter for determining orientation by inertial and magnetic sensing , 2006, IEEE Transactions on Biomedical Engineering.

[19]  J. Crassidis,et al.  Particle Filtering for Sequential Spacecraft Attitude Estimation , 2004 .