A Novel Orientation Determination Approach of Mobile Robot Using Inertial and Magnetic Sensors

摘要

The orientation information is critical for the mobile robot. However, the robot’s constrained locomotion, complicated magnetic field environment, and the coupled orientation estimation present challenges for using the microelectromechanical magnetometer in real-time robot orientation determination. This article focuses on calibrating the magnetometer in constrained robot locomotion and achieving the robot’s decoupled roll, pitch, and yaw estimates. A magnitude-free and reference-free calibration approach is proposed to calibrate the magnetometer using the measurements collected from the principal plane of the robot locomotion. Moreover, a decoupled orientation estimator is created under the framework of the extended Kalman filter using the calibrated triaxial magnetic, angular rate, and gravity sensor readings. Two independent experiments validate the effectiveness of magnetometer calibration and orientation decoupling, respectively. A case study of estimating the mobile robot’s orientation shows that the proposed methods can achieve accurate heading estimation and decouple the roll and pitch from the magnetic field data.