even more flexibility and better finish condition, gave getToGoal_Obstacles its own directory