Outlier Rejection for Absolute Pose Estimation with Known Orientation.
Revisiting the PnP Problem: A Fast, General and Optimal Solution