updated to use solvePNP this seems like the correct function to use