Kinematics of Spatial Parallel Manipulators With Tetrahedron Coordinates
EPnP: An Accurate O(n) Solution to the PnP Problem