fix pose estimation 2 (complete)