US Patent 8203487 Tightly coupled UWB/IMU pose estimation system and method

A six-degree-of-freedom (6DOF) tracking system adapts aspects of Ultra-Wideband (UWB) measurement and microelectromechanical systems (MEMS) inertial measurements within a unique tightly coupled fusion algorithm to accurately and efficiently measure an object's position as well as orientation. The principle of operation of the system protects against the negative effects of multipath phenomenon and non-line-of-sight (NLOS) conditions, allowing a more robust position and orientation tracking system.