Moving robot counter to inside RobotList
Cleaning code and removing useless functions
Updating TODO