Created new youbot_controller_manager for debugging and controller set up