Robust improvement solution to perspective-n-point problem. (19th November 2019)