vigir_footstep_planning_plugins package instances