vigir_footstep_planning package instances