Added a workaround mode and TF broadcaster to handle issues using the robot_pose_ekf variant on the robot