hector_pose_estimation_core/poseupdate: also rotate covariance and velocity vector in case of yaw angle jumps