Pose estimation and triangulation