Create grind and path finding class

[DanielHayward]

Create a grid class the can interpret the current map as movable, not movable. Setup A* path finding on it that can broken up between multiple updates and uses make_heap.