Nonlinear Pose Filters on the Special Euclidean Group SE(3) with Guaranteed Transient and Steady-state Performance

Abstract

Two novel nonlinear pose (i.e, attitude and position) filters developed directly on the Special Euclidean Group SE(3)able to guarantee prescribed characteristics of transient and steady-state performance are proposed. The position error and normalized Euclidean distance of attitude error are trapped to arbitrarily start within a given large set and converge systematically and asymptotically to the origin from almost any initial condition. The transient error is guaranteed not to exceed a prescribed value while the steady-state error is bounded by a predefined small value. The first pose filter operates based on a set of vectorial measurements coupled with a group of velocity vectors and requires preliminary pose reconstruction. The second filter, on the contrary, is able to perform its function using a set of vectorial measurements and a group of velocity vectors directly. Both proposed filters provide reasonable pose estimates with superior convergence properties while being able to use measurements obtained from low-cost inertial measurement, landmark measurement, and velocity measurement units. Simulation results demonstrate effectiveness and robustness of the proposed filters considering large error in initialization and high level of uncertainties in velocity vectors as well as in the set of vector measurements. Attitude, position, pose estimation, nonlinear observer, estimate, special orthogonal group, special Euclidean group, SO(3), SE(3), prescribed performance function, transient, steady-state error, transformed error, Landmark, feature measurement, PPF, IMU, Lie algebra, Lie group, projection, Gyroscope, Inertial measurement units, rigid body, micro electromechanical systems, sensor, IMUs, MEMS, Roll, Pitch, Yaw, UAVs, QUAV, SVD, Fixed, Moving, Vehicles, Robot, Robotic System, Spacecraft, submarine, Underwater vehicle.

arXiv commentIEEE Transactions on Systems, Man, and Cybernetics: Systems

References in corpus (6)

• Neuro-adaptive Cooperative Tracking Control with Prescribed Performance of Unknown Higher-order Nonlinear Multi-agent Systems
• Nonlinear Stochastic Attitude Filters on the Special Orthogonal Group 3: Ito and Stratonovich
• Adaptive synchronisation of unknown nonlinear networked systems with prescribed performance
• Nonlinear Stochastic Position and Attitude Filter on the Special Euclidean Group 3
• Guaranteed Performance of Nonlinear Attitude Filters on the Special Orthogonal Group SO(3)
• Guaranteed Performance of Nonlinear Pose Filter on SE(3)

Cited by in corpus (10)

• Geometric Stochastic Filter with Guaranteed Performance for Autonomous Navigation based on IMU and Feature Sensor Fusion
• A Geometric Nonlinear Stochastic Filter for Simultaneous Localization and Mapping
• Landmark and IMU Data Fusion: Systematic Convergence Geometric Nonlinear Observer for SLAM and Velocity Bias
• Nonlinear Stochastic Estimators on the Special Euclidean Group SE(3) using Uncertain IMU and Vision Measurements
• Minimization of GNSS-Denied Inertial Navigation Errors for Fixed Wing Autonomous Unmanned Air Vehicles
• Equivariant Filter Design for Inertial Navigation Systems with Input Measurement Biases
• Guaranteed Performance Nonlinear Observer for Simultaneous Localization and Mapping
• Nonlinear Filter for Simultaneous Localization and Mapping on a Matrix Lie Group using IMU and Feature Measurements
• Special Orthogonal Group SO(3), Euler Angles, Angle-axis, Rodriguez Vector and Unit-Quaternion: Overview, Mapping and Challenges
• Long Distance GNSS-Denied Visual Inertial Navigation for Autonomous Fixed Wing Unmanned Air Vehicles: SO(3) Manifold Filter based on Virtual Vision Sensor