A STABLE DIRECT SOLUTION OF PERSPECTIVE-THREE-POINT PROBLEM
EPnP: An Accurate O(n) Solution to the PnP Problem