Improved pose estimation