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.