added obstacle to test
fixed weird ass bug in path generation from re-trace
adjusted heuristic to take into account that we don't travel in diagonals