added pathfinding library
added test grid reset function
made map global for debugging
pathfinding test