SolvePnP transformation fix