Some tweaks to youbot_controller