Planner follows LOS too closely and ends up at goal position, but with insufficient orientation. Find way to more heavily weigh incoming trajectory rather than reducing distance to goal?

[rwbot]