Updated test file to recalcualte path after chaning a block
#14 Fixed bug where pathfinding sometime took the incorrect direction.