示例#1
0
GraspPlanningState *SimAnn::stateNeighbor(GraspPlanningState *s, double T, GraspPlanningState *t)
{
  GraspPlanningState *sn = new GraspPlanningState(s);
  if (t) {
    variableNeighbor(sn->getPosition(), T, t->getPosition());
    variableNeighbor(sn->getPosture(), T, t->getPosture());
  } else {
    variableNeighbor(sn->getPosition(), T, NULL);
    variableNeighbor(sn->getPosture(), T, NULL);
  }
  return sn;
}