publish footstep for visualization from planner