// This method is used when a composite step may threaten a causal link.
protected void DecomposeThreat(CausalLink <IPlanStep> causalLink, ICompositePlanStep ThisIsAThreat)
{
//if (CacheMaps.IsThreat(causalLink.Predicate, ThisIsAThreat))
//{
// Flaws.Add(new ThreatenedLinkFlaw(causalLink, ThisIsAThreat.GoalStep));
// return;
//}
foreach (var substep in ThisIsAThreat.SubSteps)
{
if (substep.Height > 0)
{
//var compositeSubStep = substep as ICompositePlanStep;
DecomposeThreat(causalLink, substep as ICompositePlanStep);
}
else
{
if (substep.Equals(causalLink.Head) || substep.Equals(causalLink.Tail))
{
continue;
}
if (!CacheMaps.IsThreat(causalLink.Predicate, substep))
{
continue;
}
Flaws.Add(new ThreatenedLinkFlaw(causalLink, substep));
}
}
}
public CompositePlanStep(ICompositePlanStep comp, List <IPredicate> openconditions, IPlanStep init, IPlanStep goal, int ID) : base(comp as IPlanStep, openconditions, ID)
{
compositeAction = comp.Action as IComposite;
initialStep = init;
goalStep = goal;
subSteps = comp.SubSteps;
subOrderings = comp.SubOrderings;
subLinks = comp.SubLinks;
}
public CompositePlanStep(ICompositePlanStep comp) : base(comp as IPlanStep)
{
compositeAction = comp.Action as IComposite;
initialStep = new PlanStep(comp.InitialStep);
goalStep = new PlanStep(comp.GoalStep);
// Do not bother changing the PlanStep skin of these, as this has to happen during insertion
subSteps = comp.SubSteps;
subLinks = comp.SubLinks;
subOrderings = comp.SubOrderings;
}
public void Insert(ICompositePlanStep csps, IPlanStep substep)
{
ParentMap[substep.ID] = csps.ID;
if (!SubStepMap.ContainsKey(csps.ID))
{
SubStepMap[csps.ID] = new List <int>();
}
SubStepMap[csps.ID].Add(substep.ID);
if (!ParentMap.ContainsKey(csps.ID))
{
ParentMap[csps.ID] = -1;
}
}
// This method is used when a composite step may threaten a causal link.
private void DecomposeThreat(CausalLink <IPlanStep> causalLink, ICompositePlanStep ThisIsAThreat)
{
foreach (var substep in ThisIsAThreat.SubSteps)
{
if (!CacheMaps.IsThreat(causalLink.Predicate, substep))
{
continue;
}
if (substep.Height > 0)
{
DecomposeThreat(causalLink, substep as ICompositePlanStep);
}
else
{
Flaws.Add(new ThreatenedLinkFlaw(causalLink, substep));
}
}
}
public void InsertDecomp(ICompositePlanStep newStep)
{
decomps += 1;
var IDMap = new Dictionary <int, IPlanStep>();
// Clone, Add, and Order Initial step
var dummyInit = newStep.InitialStep.Clone() as IPlanStep;
dummyInit.Depth = newStep.Depth;
IDMap[newStep.InitialStep.ID] = dummyInit;
steps.Add(dummyInit);
orderings.Insert(InitialStep, dummyInit);
orderings.Insert(dummyInit, GoalStep);
//foreach (var oc in newStep.OpenConditions)
//{
// Flaws.Add(this, new OpenCondition(oc, dummyInit));
//}
// Clone, Add, and order Goal step
var dummyGoal = newStep.GoalStep.Clone() as IPlanStep;
dummyGoal.Depth = newStep.Depth;
dummyGoal.InitCndt = dummyInit;
InsertPrimitiveSubstep(dummyGoal, dummyInit.Effects, true);
IDMap[newStep.GoalStep.ID] = dummyGoal;
orderings.Insert(dummyInit, dummyGoal);
// Dont need these here because its added when inserted as primitive
//orderings.Insert(InitialStep, dummyGoal);
//orderings.Insert(dummyGoal, GoalStep);
// This code block is used for debugging and may possibly be ommitted.
// guarantee that newStepCopy cannot be used for re-use by changing ID (by casting as new step)
var newStepCopy = new PlanStep(new Operator(newStep.Action.Predicate as Predicate, new List <IPredicate>(), new List <IPredicate>()));
steps.Add(newStepCopy);
// orderings.Insert(dummyInit, newStepCopy);
// orderings.Insert(newStepCopy, dummyGoal);
newStepCopy.Height = newStep.Height;
var newSubSteps = new List <IPlanStep>();
foreach (var substep in newStep.SubSteps)
{
// substep is either a IPlanStep or ICompositePlanStep
if (substep.Height > 0)
{
var compositeSubStep = new CompositePlanStep(substep.Clone() as IPlanStep)
{
Depth = newStep.Depth + 1
};
Orderings.Insert(compositeSubStep.GoalStep, dummyGoal);
Orderings.Insert(dummyInit, compositeSubStep.InitialStep);
IDMap[substep.ID] = compositeSubStep;
compositeSubStep.InitialStep.InitCndt = dummyInit;
newSubSteps.Add(compositeSubStep);
Insert(compositeSubStep);
// Don't bother updating hdepth yet because we will check on recursion
}
else
{
var newsubstep = new PlanStep(substep.Clone() as IPlanStep)
{
Depth = newStep.Depth + 1
};
Orderings.Insert(newsubstep, dummyGoal);
Orderings.Insert(dummyInit, newsubstep);
IDMap[substep.ID] = newsubstep;
newSubSteps.Add(newsubstep);
newsubstep.InitCndt = dummyInit;
InsertPrimitiveSubstep(newsubstep, dummyInit.Effects, false);
if (newsubstep.Depth > Hdepth)
{
Hdepth = newsubstep.Depth;
}
}
}
foreach (var tupleOrdering in newStep.SubOrderings)
{
// Don't bother adding orderings to dummies
if (tupleOrdering.First.Equals(newStep.InitialStep))
{
continue;
}
if (tupleOrdering.Second.Equals(newStep.GoalStep))
{
continue;
}
var head = IDMap[tupleOrdering.First.ID];
var tail = IDMap[tupleOrdering.Second.ID];
if (head.Height > 0)
{
// can you pass it back?
var temp = head as ICompositePlanStep;
head = temp.GoalStep as IPlanStep;
}
if (tail.Height > 0)
{
var temp = tail as ICompositePlanStep;
tail = temp.InitialStep as IPlanStep;
}
Orderings.Insert(head, tail);
}
foreach (var clink in newStep.SubLinks)
{
var head = IDMap[clink.Head.ID];
var tail = IDMap[clink.Tail.ID];
if (head.Height > 0)
{
var temp = head as CompositePlanStep;
head = temp.GoalStep as IPlanStep;
}
if (tail.Height > 0)
{
var temp = tail as CompositePlanStep;
tail = temp.InitialStep as IPlanStep;
}
var newclink = new CausalLink <IPlanStep>(clink.Predicate, head, tail);
if (tail.OpenConditions.Contains(clink.Predicate))
{
tail.OpenConditions.Remove(clink.Predicate);
}
CausalLinks.Add(newclink);
Orderings.Insert(head, tail);
// check if this causal links is threatened by a step in subplan
foreach (var step in newSubSteps)
{
// Prerequisite criteria 1
if (step.ID == head.ID || step.ID == tail.ID)
{
continue;
}
// Prerequisite criteria 2
if (!CacheMaps.IsThreat(clink.Predicate, step))
{
continue;
}
// If the step has height, need to evaluate differently
if (step.Height > 0)
{
var temp = step as ICompositePlanStep;
if (Orderings.IsPath(head, temp.InitialStep))
{
continue;
}
if (Orderings.IsPath(temp.GoalStep, tail))
{
continue;
}
}
else
{
if (Orderings.IsPath(head, step))
{
continue;
}
if (Orderings.IsPath(step, tail))
{
continue;
}
}
if (step.Height > 0)
{
// Then we need to dig deeper to find the step that threatens
DecomposeThreat(clink, step as ICompositePlanStep);
}
else
{
Flaws.Add(new ThreatenedLinkFlaw(newclink, step));
}
}
}
// This is needed because we'll check if these substeps are threatening links
newStep.SubSteps = newSubSteps;
newStep.InitialStep = dummyInit;
newStep.GoalStep = dummyGoal;
foreach (var pre in newStep.OpenConditions)
{
Flaws.Add(this, new OpenCondition(pre, dummyInit as IPlanStep));
}
}
public void InsertDecomp(ICompositePlanStep newStep)
{
this.hdepth += newStep.SubSteps.Count;
decomps += 1;
var IDMap = new Dictionary <int, IPlanStep>();
// Clone, Add, and Order Initial step
var dummyInit = new PlanStep(newStep.InitialStep) as IPlanStep;
dummyInit.InitCndt = newStep.InitialStep.InitCndt;
dummyInit.Depth = newStep.Depth;
IDMap[newStep.InitialStep.ID] = dummyInit;
steps.Add(dummyInit);
orderings.Insert(InitialStep, dummyInit);
orderings.Insert(dummyInit, GoalStep);
// Clone, Add, and order Goal step
var dummyGoal = new PlanStep(newStep.GoalStep) as IPlanStep;
dummyGoal.Depth = newStep.Depth;
dummyGoal.InitCndt = dummyInit;
dummyGoal.GoalCndt = newStep.GoalStep.GoalCndt;
InsertPrimitiveSubstep(dummyGoal, dummyInit.Effects, true);
IDMap[newStep.GoalStep.ID] = dummyGoal;
orderings.Insert(dummyInit, dummyGoal);
dummyInit.GoalCndt = dummyGoal;
// Officially add this step to the list of steps (DO NOT INSERT which would insert its flaws)
steps.Add(newStep);
// Create new list of substeps
var newSubSteps = new List <IPlanStep>();
// Blank out this step's preconditions and effects so that it cannot be used?
newStep.Preconditions = new List <IPredicate>();
newStep.Effects = new List <IPredicate>();
// Assign new step's dummy initial and goal steps
newStep.InitialStep = dummyInit;
newStep.GoalStep = dummyGoal;
// Insert decomp links for the dummy initial and goal steps
decomplinks.Insert(newStep, dummyGoal);
decomplinks.Insert(newStep, dummyInit);
// For each substep, assign depth and insert into plan.
foreach (var substep in newStep.SubSteps)
{
if (substep.Height > 0)
{
// Don't just clone, create a new step so that it has a unique ID
var compositeSubStep = new CompositePlanStep(substep.Clone() as CompositePlanStep)
{
Depth = newStep.Depth + 1
};
newSubSteps.Add(compositeSubStep);
decomplinks.Insert(newStep, compositeSubStep);
Insert(compositeSubStep);
Orderings.Insert(compositeSubStep.GoalStep, dummyGoal);
Orderings.Insert(dummyInit, compositeSubStep.InitialStep);
IDMap[substep.ID] = compositeSubStep;
compositeSubStep.InitialStep.InitCndt = dummyInit;
compositeSubStep.GoalStep.GoalCndt = dummyGoal;
}
else
{
var newsubstep = new PlanStep(substep.Clone() as IPlanStep)
{
Depth = newStep.Depth + 1
};
Orderings.Insert(newsubstep, dummyGoal);
Orderings.Insert(dummyInit, newsubstep);
IDMap[substep.ID] = newsubstep;
newSubSteps.Add(newsubstep);
newsubstep.InitCndt = dummyInit;
newsubstep.GoalCndt = dummyGoal;
decomplinks.Insert(newStep, newsubstep);
InsertPrimitiveSubstep(newsubstep, dummyInit.Effects, false);
//if (newsubstep.Depth > Hdepth)
//{
// Hdepth = newsubstep.Depth;
//}
}
}
foreach (var tupleOrdering in newStep.SubOrderings)
{
// Don't bother adding orderings to dummies
if (tupleOrdering.First.Equals(newStep.InitialStep))
{
continue;
}
if (tupleOrdering.Second.Equals(newStep.GoalStep))
{
continue;
}
var head = IDMap[tupleOrdering.First.ID];
var tail = IDMap[tupleOrdering.Second.ID];
if (head.Height > 0)
{
// can you pass it back?
var temp = head as ICompositePlanStep;
head = temp.GoalStep as IPlanStep;
}
if (tail.Height > 0)
{
var temp = tail as ICompositePlanStep;
tail = temp.InitialStep as IPlanStep;
}
Orderings.Insert(head, tail);
}
foreach (var clink in newStep.SubLinks)
{
var head = IDMap[clink.Head.ID];
var tail = IDMap[clink.Tail.ID];
if (head.Height > 0)
{
var temp = head as CompositePlanStep;
head = temp.GoalStep as IPlanStep;
}
if (tail.Height > 0)
{
var temp = tail as CompositePlanStep;
tail = temp.InitialStep as IPlanStep;
}
var newclink = new CausalLink <IPlanStep>(clink.Predicate, head, tail);
if (tail.OpenConditions.Contains(clink.Predicate))
{
tail.OpenConditions.Remove(clink.Predicate);
}
CausalLinks.Add(newclink);
Orderings.Insert(head, tail);
// check if this causal links is threatened by a step in subplan
foreach (var step in newSubSteps)
{
// Prerequisite criteria 1
if (step.ID == head.ID || step.ID == tail.ID)
{
continue;
}
// Prerequisite criteria 2
if (!CacheMaps.IsThreat(clink.Predicate, step))
{
continue;
}
// If the step has height, need to evaluate differently
if (step.Height > 0)
{
var temp = step as ICompositePlanStep;
if (Orderings.IsPath(head, temp.InitialStep))
{
continue;
}
if (Orderings.IsPath(temp.GoalStep, tail))
{
continue;
}
}
else
{
if (Orderings.IsPath(head, step))
{
continue;
}
if (Orderings.IsPath(step, tail))
{
continue;
}
}
Flaws.Add(new ThreatenedLinkFlaw(newclink, step));
}
}
// This is needed because we'll check if these substeps are threatening links
newStep.SubSteps = newSubSteps;
newStep.InitialStep = dummyInit;
newStep.GoalStep = dummyGoal;
foreach (var pre in newStep.OpenConditions)
{
Flaws.Add(this, new OpenCondition(pre, dummyInit as IPlanStep));
}
}
