Sensor Data Fusion for Body State Estimation in a Hexapod Robot with Dynamical Gaits

Abstract

We report on a hybrid 12-dimensional full body state estimator for a hexapod robot executing a jogging gait in steady state on level terrain with regularly alternating ground contact and aerial phases of motion. We use a repeating sequence of continuous time dynamical models that are switched in and out of an extended Kalman filter to fuse measurements from a novel leg pose sensor and inertial sensors. Our inertial measurement unit supplements the traditionally paired three-axis rate gyro and three-axis accelerometer with a set of three additional three-axis accelerometer suites, thereby providing additional angular acceleration measurement, avoiding the need for localization of the accelerometer at the center of mass on the robot's body, and simplifying installation and calibration. We implement this estimation procedure offline, using data extracted from numerous repeated runs of the hexapod robot RHex (bearing the appropriate sensor suite) and evaluate its performance with reference to a visual ground-truth measurement system, comparing as well the relative performance of different fusion approaches implemented via different model sequences. This material is posted here with permission of the IEEE. Such permission of the IEEE does not in any way imply IEEE endorsement of any of the University of Pennsylvania's products or services. Internal or personal use of this material is permitted. However, permission to reprint/republish this material for advertising or promotional purposes or for creating new collective works for resale or redistribution must be obtained from the IEEE by writing to pubs-permissions@ieee.org. By choosing to view this document, you agree to all provisions of the copyright laws protecting it. Abstract-We report on a hybrid 12-dimensional full body state estimator for a hexapod robot executing a jogging gait in steady state on level terrain with regularly alternating ground contact and aerial phases of motion. We use a repeating sequence of continuous time dynamical models that are switched in and out of an extended Kalman filter to fuse measurements from a novel leg pose sensor and inertial sensors. Our inertial measurement unit supplements the traditionally paired three-axis rate gyro and three-axis accelerometer with a set of three additional three-axis accelerometer suites, thereby providing additional angular acceleration measurement, avoiding the need for localization of the accelerometer at the center of mass on the robot's body, and simplifying installation and calibration. We implement this estimation procedure offline, using data extracted from numerous repeated runs of the hexapod robot RHex (bearing the appropriate sensor suite) and evaluate its performance with reference to a visual ground-truth measurement system, comparing as well the relative performance of different fusion approaches implemented via different model sequences. Index Terms-Extended