mirror of
https://github.com/moveit/moveit_task_constructor.git
synced 2025-11-04 14:49:57 +08:00
split assert
so that it becomes obvious which condition triggered it.
This commit is contained in:
parent
fa8d21741c
commit
06b3df9c30
@ -106,8 +106,10 @@ void Interface::add(InterfaceState& state) {
|
|||||||
it->priority_ = InterfaceState::Priority(1, state.incomingTrajectories().front()->cost());
|
it->priority_ = InterfaceState::Priority(1, state.incomingTrajectories().front()->cost());
|
||||||
else if (!state.outgoingTrajectories().empty())
|
else if (!state.outgoingTrajectories().empty())
|
||||||
it->priority_ = InterfaceState::Priority(1, state.outgoingTrajectories().front()->cost());
|
it->priority_ = InterfaceState::Priority(1, state.outgoingTrajectories().front()->cost());
|
||||||
else // otherwise, assume priority was well defined before
|
else { // otherwise, assume priority was well defined before
|
||||||
assert(it->priority_.enabled() && it->priority_.depth() >= 1u);
|
assert(it->priority_.enabled());
|
||||||
|
assert(it->priority_.depth() >= 1u);
|
||||||
|
}
|
||||||
|
|
||||||
// move list node into interface's state list (sorted by priority)
|
// move list node into interface's state list (sorted by priority)
|
||||||
moveFrom(it, container);
|
moveFrom(it, container);
|
||||||
|
|||||||
Loading…
Reference in New Issue
Block a user