Made into robot code

This code should now work on the robot meaning that you can use the grid
puzzle project and exclude the others. Without the collections you can
use the missing ones from leJOS found in the "utils" package I made up
from Nick Hawes code. I also use his SimpleSet instead of the HashSet as
well. I believe that arraylists still work.