Re-writing pathfinder
Fixing map
Working BFS and UCS