so, i just want to point out that there are ways of building maps and then planning in those maps and then you're goal to goal behavior, for instance, wouldn't aim at the goal point but aim at following planned path based on these obstacle maps.