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

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

State Estimation for a Humanoid Robot

This paper introduces a framework for state estimation on a humanoid robot platform using only common proprioceptive sensors and knowledge of leg kinematics. The presented approach extends that detailed in [1] on a quadruped platform by incorporating the rotational constraints imposed by the humanoid's flat feet. As in previous work, the proposed Extended Kalman Filter (EKF) accommodates contact switching and makes no assumptions about gait or terrain, making it applicable on any humanoid platform for use in any task. The filter employs a sensor-based prediction model which uses inertial data from an IMU and corrects for integrated error using a kinematics-based measurement model which relies on joint encoders and a kinematic model to determine the relative position and orientation of the feet. A nonlinear observability analysis is performed on both the original and updated filters and it is concluded that the new filter significantly simplifies singular cases and improves the observability characteristics of the system. Results on simulated walking and squatting datasets demonstrate the performance gain of the flat-foot filter as well as confirm the results of the presented observability analysis.Comment: IROS 2014 Submission, IEEE/RSJ International Conference on Intelligent Robots and Systems (2014) 952-95

Angular Rate Estimation Using a Distributed Set of Accelerometers

A distributed set of accelerometers based on the minimum number of 12 accelerometers allows for computation of the magnitude of angular rate without using the integration operation. However, it is not easy to extract the magnitude of angular rate in the presence of the accelerometer noises, and even worse, it is difficult to determine the direction of a rotation because the angular rate is present in its quadratic form within the inertial measurement system equations. In this paper, an extended Kalman filter scheme to correctly estimate both the direction and magnitude of the angular rate through fusion of the angular acceleration and quadratic form of the angular rate is proposed. We also provide observability analysis for the general distributed accelerometers-based inertial measurement unit, and show that the angular rate can be correctly estimated by general nonlinear state estimators such as an extended Kalman filter, except under certain extreme conditions

Real-Time Decision Fusion for Multimodal Neural Prosthetic Devices

The field of neural prosthetics aims to develop prosthetic limbs with a brain-computer interface (BCI) through which neural activity is decoded into movements. A natural extension of current research is the incorporation of neural activity from multiple modalities to more accurately estimate the user's intent. The challenge remains how to appropriately combine this information in real-time for a neural prosthetic device., i.e., fusing predictions from several single-modality decoders to produce a more accurate device state estimate. We examine two algorithms for continuous variable decision fusion: the Kalman filter and artificial neural networks (ANNs). Using simulated cortical neural spike signals, we implemented several successful individual neural decoding algorithms, and tested the capabilities of each fusion method in the context of decoding 2-dimensional endpoint trajectories of a neural prosthetic arm. Extensively testing these methods on random trajectories, we find that on average both the Kalman filter and ANNs successfully fuse the individual decoder estimates to produce more accurate predictions.Our results reveal that a fusion-based approach has the potential to improve prediction accuracy over individual decoders of varying quality, and we hope that this work will encourage multimodal neural prosthetics experiments in the future

IMU integration for ATRIAS

An Inertial Measurement Unit (IMU) is an important part of a freestanding bipedal robot's state estimation system. IMUs return translational accelerations and rotational velocities, which must be numerically integrated to obtain a robot's orientation. This thesis documents the implementation of the IMU alignment and integration systems for the ATRIAS robot. As a result of this work, ATRIAS has responsive and reliable orientation estimation, which allowed it to achieve freestanding walking. Key Words: IMU, bipedal locomotio

State Derivation of a 12-Axis Gyroscope-Free Inertial Measurement Unit

The derivation of linear acceleration, angular acceleration, and angular velocity states from a 12-axis gyroscope-free inertial measurement unit that utilizes four 3-axis accelerometer measurements at four distinct locations is reported. Particularly, a new algorithm which derives the angular velocity from its quadratic form and derivative form based on the context-based interacting multiple model is demonstrated. The performance of the system was evaluated under arbitrary 3-dimensional motion

State Estimation for Legged Robots - Consistent Fusion of Leg Kinematics and IMU

This paper introduces a state estimation framework for legged robots that allows estimating the full pose of the robot without making any assumptions about the geometrical structure of its environment. This is achieved by means of an Observability Constrained Extended Kalman Filter that fuses kinematic encoder data with on-board IMU measurements. By including the absolute position of all footholds into the filter state, simple model equations can be formulated which accurately capture the uncertainties associated with the intermittent ground contacts. The resulting filter simultaneously estimates the position of all footholds and the pose of the main body. In the algorithmic formulation, special attention is paid to the consistency of the linearized filter: it maintains the same observability properties as the nonlinear system, which is a prerequisite for accurate state estimation. The presented approach is implemented in simulation and validated experimentally on an actual quadrupedal robot

DESIGN AND IMPLEMENTATION OF HOME USE PORTABLE SMART ELECTRONICS

The widespread of low cost embedded electronics makes it easier to implement the smart devices that can understand either the environment or the user behaviors. The main object of this project is to design and implement home use portable smart electronics, including the portable monitoring device for home and office security and the portable 3D mouse for convenient use. Both devices in this project use the MPU6050 which contains a 3 axis accelerometer and a 3 axis gyroscope to sense the inertial motion of the door or the human hands movement. For the portable monitoring device for home and office security, MPU6050 is used to sense the door (either home front door or cabinet door) movement through the gyroscope, and Raspberry Pi is then used to process the data it receives from MPU6050, if the data value exceeds the preset threshold, Raspberry Pi would control the USB Webcam to take a picture and then send out an alert email with the picture to the user. The advantage of this device is that it is a small size portable stand-alone device with its own power source, it is easy to implement, really cheap for residential use, and energy efficient with instantaneous alert. For the 3D mouse, the MPU6050 would use both the accelerometer and gyroscope to sense user hands movement, the data are processed by MSP430G2553 through a digital smooth filter and a complementary filter, and then the filtered data will pass to the personal computer through the serial COM port. By applying the cursor movement equation in the PC driver, this device can work great as a mouse with acceptable accuracy. Compared to the normal optical mouse we are using, this mouse does not need any working surface, with the use of the smooth and complementary filter, it has certain accuracy for normal use, and it is easy to be extended to a portable mouse as small as a finger ring