follow_planner: fix publishing of the plan

Also, fix node prefix for the follow_goal topic