pose_2d_estimator: fist attempt at a proper yaw estimation.