Feature/5 pathfind matrix

New pathfinding algorithm - using graph structure for map data and an adjacency matrix to find the paths