Got Movement working by fixing a bug in LineSensors

Also moved GridMap to the Working directory and included Routing for
pathfinding