fixed the pose estimation problem