Add robust version of the five point algorithm.
Ceres compilation fixes for Mac.