vigir_footstep_planning_lib package instances