Once you have the entire path being output properly, you'll need to tune whichever BaseLocalPlanner you are using (dwa_local_planner, base_local_planner, etc) to prefer following the path over heading directly towards the goal. See Tuning Guide for more info (specifically look for the path_distance_bias and goal_distance_bias parameters)