Adding obstacles when finding the best path

So far, the best solution is not considering the obstacles (except the
border and the walls, I guess). It was supposed to do that, but it's not
working somehow.

Also, figuring out how to test is turning out to be harder than I
thought.