pose_2d_estimator_node: Working on the pose yaw angle, not finished