mirror of
https://github.com/moveit/moveit_task_constructor.git
synced 2025-11-04 14:49:57 +08:00
Connecting: add another ROS_DEBUG hint
These can facilitate debugging a lot for little overhead.
This commit is contained in:
parent
40b00c61d2
commit
1e10aaccfd
@ -123,10 +123,15 @@ void ContainerBasePrivate::onNewFailure(const Stage& child, const InterfaceState
|
||||
case CONNECT:
|
||||
if (const Connecting* conn = dynamic_cast<const Connecting*>(&child)) {
|
||||
auto cimpl = conn->pimpl();
|
||||
if (!cimpl->hasPendingOpposites<Interface::FORWARD>(from))
|
||||
ROS_DEBUG_STREAM_NAMED("Connecting", "'" << child.name() << "' generated a failure");
|
||||
if (!cimpl->hasPendingOpposites<Interface::FORWARD>(from)) {
|
||||
ROS_DEBUG_STREAM_NAMED("Connecting", "prune backward branch");
|
||||
setStatus<Interface::BACKWARD>(from, InterfaceState::Status::FAILED);
|
||||
if (!cimpl->hasPendingOpposites<Interface::BACKWARD>(to))
|
||||
}
|
||||
if (!cimpl->hasPendingOpposites<Interface::BACKWARD>(to)) {
|
||||
ROS_DEBUG_STREAM_NAMED("Connecting", "prune forward branch");
|
||||
setStatus<Interface::FORWARD>(to, InterfaceState::Status::FAILED);
|
||||
}
|
||||
}
|
||||
break;
|
||||
}
|
||||
|
||||
Loading…
Reference in New Issue
Block a user