pose_estimator: Fixed reversing bug