Distributed observers for pose estimation in the presence of inertial sensory soft faults |
| |
Authors: | Nargess Sadeghzadeh-Nokhodberiz Javad Poshtan Achim Wagner Eugen Nordheimer Essameddin Badreddin |
| |
Affiliation: | 1. Department of Electrical Engineering, Iran University of Science and Technology, 1684613114 Tehran, Iran;2. Automation Laboratory, University of Heidelberg, 68131 Mannheim, Germany |
| |
Abstract: | Distributed Particle-Kalman Filter based observers are designed in this paper for inertial sensors (gyroscope and accelerometer) soft faults (biases and drifts) and rigid body pose estimation. The observers fuse inertial sensors with Photogrammetric camera. Linear and angular accelerations as unknown inputs of velocity and attitude rate dynamics, respectively, along with sensory biases and drifts are modeled and augmented to the moving body state parameters. To reduce the complexity of the high dimensional and nonlinear model, the graph theoretic tearing technique (structural decomposition) is employed to decompose the system to smaller observable subsystems. Separate interacting observers are designed for the subsystems which are interacted through well-defined interfaces. Kalman Filters are employed for linear ones and a Modified Particle Filter for a nonlinear non-Gaussian subsystem which includes imperfect attitude rate dynamics is proposed. The main idea behind the proposed Modified Particle Filtering approach is to engage both system and measurement models in the particle generation process. Experimental results based on data from a 3D MEMS IMU and a 3D camera system are used to demonstrate the efficiency of the method. |
| |
Keywords: | Sensor fault diagnosis Pose Estimation Particle Filtering Kalman Filtering System decomposition Large Scale Systems MEMS IMU Sensor fusion Photogrammetry Vision based navigation |
本文献已被 ScienceDirect 等数据库收录! |