dwa_planner: fixed bug where robot failed to turn at start of plan.
The logic in question was lost in the groovy refactor.