pose_2d_estimator: Working on the pose orientation, not finished