Updating the state_machine mobile_base_pub