vigir_footstep_planning_default_plugins package instances