Very Fast Solution to the PnP Problem with Algebraic Outlier Rejection