mirror of
https://github.com/moveit/moveit_task_constructor.git
synced 2025-11-04 14:49:57 +08:00
PropagatingEitherWayPrivate: count failures in both directions
This commit is contained in:
parent
2ea463fff4
commit
1f4264c8c8
@ -308,17 +308,17 @@ bool PropagatingEitherWayPrivate::compute()
|
|||||||
const InterfaceState& state = fetchStartState();
|
const InterfaceState& state = fetchStartState();
|
||||||
// enforce property initialization from INTERFACE
|
// enforce property initialization from INTERFACE
|
||||||
properties_.performInitFrom(Stage::INTERFACE, state.properties(), true);
|
properties_.performInitFrom(Stage::INTERFACE, state.properties(), true);
|
||||||
if (me->computeForward(state))
|
if (countFailures(me->computeForward(state)))
|
||||||
result |= true;
|
result |= true;
|
||||||
}
|
}
|
||||||
if ((dir & PropagatingEitherWay::BACKWARD) && hasEndState()) {
|
if ((dir & PropagatingEitherWay::BACKWARD) && hasEndState()) {
|
||||||
const InterfaceState& state = fetchEndState();
|
const InterfaceState& state = fetchEndState();
|
||||||
// enforce property initialization from INTERFACE
|
// enforce property initialization from INTERFACE
|
||||||
properties_.performInitFrom(Stage::INTERFACE, state.properties(), true);
|
properties_.performInitFrom(Stage::INTERFACE, state.properties(), true);
|
||||||
if (me->computeBackward(state))
|
if (countFailures(me->computeBackward(state)))
|
||||||
result |= true;
|
result |= true;
|
||||||
}
|
}
|
||||||
return countFailures(result);
|
return result;
|
||||||
}
|
}
|
||||||
|
|
||||||
|
|
||||||
|
|||||||
Loading…
Reference in New Issue
Block a user