Abstract:To maintain stability while executing the walking paths, robots have to know its own pose. However, the visual sensor of the visual/inertial navigation odometer (VIO) system is easily affected by the environmental and lighting conditions, and the measurement data of the Inertial Measurement Units (IMU) have a drift problem caused by accumulated errors, which makes the VIO system transmit the robot rotation uncertainty inaccurately. Aiming at the defects of vision sensor and IMU in robot positioning, to effectively improve the accuracy and stability of rigid body pose estimation while eliminating system internalization errors, a matrix Lie group representation based Cubature Kalman filter (CKF) VIO framework is proposed in this paper. By utilizing the high-dimensional matrix Lie group, which is composed of IMU's position, orientation, velocity and spatial three-dimensional (3D) feature points, to represent the system state variables, the accurate estimation of the robot's pose is achieved under the CKF framework. This paper derives the motion model of the IMU and the camera observation, and describes the process of constructing the Cubature point of the exponential map when the state vector dimension is high, and also transfers the state uncertainty and observation update. Finally, pose estimation accuracy verification experiments are carried out. Results show that the proposed algorithm not only inherits the advantages of the invariant extended Kalman filter (In-EKF) in terms of convergence and consistency, but also avoids the complexity of matrix solution process, improving the accuracy of robot pose estimation effectively.

Gaussian Particle Filter Based Pose and Motion Estimation

Gaussian-Sum Filter for Range-based 3D Relative Pose Estimation in the Presence of Ambiguities

Error Sensitive Gaussian Particle Filter and Its Evaluation for Contour Tracking

Fast Gaussian particle filtering algorithm

Contour tracking using Gaussian particle filter

Nonlinear filtering approaches based pose, motion and variable focal length estimation in monocular active vision

Pose And Motion Estimation From Vision Based On The First-Order Interpolation Filter

Vision-based Pose and Motion Estimation of Non-cooperative Target for Space Robotic Manipulators

Pose State Estimate of Mobile Robots Based on Nonlinear Filters

Pose Estimation Based on a Dual Quaternion Feedback Particle Filter

A Cubature Kalman Filtering Algorithm for Robot Pose Estimation

An Improved Gaussian Mixture Particle Filter Based Targets Tracking Algorithm for Bearing-Only Tracking System

Gaussian Sum Particle Filter for Passive Tracking

An Application Of Unscented Kalman Filter For Pose And Motion Estimation Based On Monocular Vision

Grid Particle Filter Based Monocular 3D Head-Shoulder Pose Estimation

Multi-Robot Cooperative Localization Based on the Gauss-Hermite Particle Filter

Pose and motion estimation from monocular vision based on IEKF, DD1 and DD2 filters

Whole-Body Joint Angle Estimation for Real-Time Humanoid Robot Imitation Based on Gaussian Process Dynamical Model and Particle Filter

Monocular-Based Pose Estimation of Non-Cooperative Space Targets Using EKF and EKPF

Spacecraft Attitude Estimation from Vector Measurements Using Particle Filter Integrated with Unscented Kalman Filter

Gaussian particle filter for tracking hip angle in gait cycles