Added debug info for robot, and be activated from Main class. Cleaned up in application