changed robot_state_publisher to 400Hz