even more flexibility and better finish condition, gave getToGoal_Obstacles its own directory
removed unnecessary stuff: pathfinding is now in getToGoal