Solution to the P5P Problem with Un-calibrated Camera Based on Vector Difference: Solution to the P5P Problem with Un-calibrated Camera Based on Vector Difference