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.

Advanced Quaternion Unscented Kalman Filter Based on SLAM of Mobile Robot Pose Estimation

AN APPROACH ON ADVANCED UNSCENTED KALMAN FILTER FROM MOBILE ROBOT-SLAM

Square Root Unscented Kalman Filter Based SLAM

Square-root unscented Kalman filter based simultaneous localization and mapping

SLAM Based on Double Layer Unscented Kalman Filter

A Cubature Kalman Filtering Algorithm for Robot Pose Estimation

Square Root Unscented Kalman Filter Based Ceiling Vision SLAM

Square-Root Cubature Kalman Filter and Its Application to SLAM of an Mobile Robot

Quaternion-based Kalman Filtering on INS/GPS

Modified Unscented Kalman Filter for Satellite Attitude Estimation

Unscented Kalman Filtering For Sins Attitude Estimation

Bearings-only cooperative localization algorithm of multi-mobile robots based on square-root unscented Kalman filter

Square-Root Unscented Kalman Filter for Vehicle Integrated Navigation

Unscented SLAM with Conditional Iterations

The Square Root Unscented Kalman Filter In Spacecrafts Autonomous Navigation

Enhanced Unscented Kalman Filter-Based SLAM in Dynamic Environments: Euclidean Approach

Augmenting Inertial Motion Capture with SLAM Using EKF and SRUKF Data Fusion Algorithms

A Quaternion Unscented Kalman Filter for Road Grade Estimation.

Novel Quaternion Kalman Filter for Gyro-less Attitude Determination

Learning based square root unscented kalman filter for indoor vehicle positioning

Algorithm of CUKF and Its Application to Mobile Robot Integrated Navigation