Now GlasSi acts exactly like sbpl_lattice_planner except with ExeAndReplan and PlanLOD functions.