OBJECT POSE MEASUREMENT SYSTEM BASED ON MEMS IMU AND METHOD THEREOF

摘要

An object pose measurement system based on MEMS IMU is disclosed, comprising: an accelerometer, a magnetometer, a gyroscope, an object vector information calculation unit, and a rotation compensation unit; wherein the object vector information calculation unit connected respectively to the accelerometer, magnetometer, gyroscope to receive respective measurement data and calculating at least an object vector information; the rotation compensation unit connected to the object vector information calculation unit to receive the at least an object vector information, compute and output a rotated compensated object vector information; wherein the rotation compensation unit performing a quaternion rotation compensation computation and outputting the rotated compensated quaternion as a rotated compensated object vector information.