Motion Measurement Using Inertial Sensors, Ultrasonic Sensors, and Magnetometers With Extended Kalman Filter for Data Fusion
An improved quaternion-based Kalman filter for real-time tracking of rigid body orientation