Cleaning up

Added/fixed/extended comments
changed CommandBasedRobot to Team422Robot and split into two files