fix pose estimation 2