Changes allowing the code to run on the robot to navigate the grid.
Needs to be neatened, documented and the A* algorithm checked for
correctness. 
Create demo classes to be put onto the robot.
Restructuring package
Merge pull request #5 from DaveM214/master

Restructuring