@@ -107,29 +107,31 @@ void ContainerBasePrivate::compute() {
107107}
108108
109109void ContainerBasePrivate::onNewFailure (const Stage& child, const InterfaceState* from, const InterfaceState* to) {
110+ ROS_DEBUG_STREAM_NAMED (" Pruning" , " '" << child.name () << " ' generated a failure" );
110111 switch (child.pimpl ()->interfaceFlags ()) {
111112 case GENERATE:
112113 // just ignore: the pair of (new) states isn't known to us anyway
113114 // TODO: If child is a container, from and to might have associated solutions already!
114115 break ;
115116
116117 case PROPAGATE_FORWARDS: // mark from as failed (backwards)
118+ ROS_DEBUG_STREAM_NAMED (" Pruning" , " prune backward branch" );
117119 setStatus<Interface::BACKWARD>(from, InterfaceState::Status::FAILED);
118120 break ;
119121 case PROPAGATE_BACKWARDS: // mark to as failed (forwards)
122+ ROS_DEBUG_STREAM_NAMED (" Pruning" , " prune backward branch" );
120123 setStatus<Interface::FORWARD>(to, InterfaceState::Status::FAILED);
121124 break ;
122125
123126 case CONNECT:
124127 if (const Connecting* conn = dynamic_cast <const Connecting*>(&child)) {
125128 auto cimpl = conn->pimpl ();
126- ROS_DEBUG_STREAM_NAMED (" Connecting" , " '" << child.name () << " ' generated a failure" );
127129 if (!cimpl->hasPendingOpposites <Interface::FORWARD>(from)) {
128- ROS_DEBUG_STREAM_NAMED (" Connecting " , " prune backward branch" );
130+ ROS_DEBUG_STREAM_NAMED (" Pruning " , " prune backward branch" );
129131 setStatus<Interface::BACKWARD>(from, InterfaceState::Status::FAILED);
130132 }
131133 if (!cimpl->hasPendingOpposites <Interface::BACKWARD>(to)) {
132- ROS_DEBUG_STREAM_NAMED (" Connecting " , " prune forward branch" );
134+ ROS_DEBUG_STREAM_NAMED (" Pruning " , " prune forward branch" );
133135 setStatus<Interface::FORWARD>(to, InterfaceState::Status::FAILED);
134136 }
135137 }
@@ -444,6 +446,9 @@ inline void updateStatePrios(const SolutionSequence::container_type& partial_sol
444446}
445447
446448void SerialContainer::onNewSolution (const SolutionBase& current) {
449+ ROS_DEBUG_STREAM_NAMED (" SerialContainer" , " '" << this ->name () << " ' received solution of child stage '"
450+ << current.creator ()->name () << " '" );
451+
447452 // failures should never trigger this callback
448453 assert (!current.isFailure ());
449454
0 commit comments