Fix error and success reporting in examples

Levi-Armstrong · Levi-Armstrong · commit 907fc7d6c652 · 2025-07-12T14:43:08.000-05:00
diff --git a/tesseract_examples/src/basic_cartesian_example.cpp b/tesseract_examples/src/basic_cartesian_example.cpp
@@ -311,7 +311,6 @@ bool BasicCartesianExample::run()
     plotter_->plotTrajectory(trajectory, *state_solver);
   }
 
-  CONSOLE_BRIDGE_logInform("Final trajectory is collision free");
   return future->context->isSuccessful();
 }
 
diff --git a/tesseract_examples/src/basic_cartesian_example_node.cpp b/tesseract_examples/src/basic_cartesian_example_node.cpp
@@ -26,6 +26,7 @@
 
 #include <tesseract_examples/basic_cartesian_example.h>
 #include <filesystem>
+#include <console_bridge/console.h>
 #include <tesseract_environment/environment.h>
 #include <tesseract_common/resource_locator.h>
 
@@ -46,5 +47,10 @@ int main(int /*argc*/, char** /*argv*/)
 
   BasicCartesianExample example(env, nullptr, false, true);
   if (!example.run())
+  {
+    CONSOLE_BRIDGE_logError("BasicCartesianExample failed");
     exit(1);
+  }
+
+  CONSOLE_BRIDGE_logInform("BasicCartesianExample successful");
 }
diff --git a/tesseract_examples/src/car_seat_example_node.cpp b/tesseract_examples/src/car_seat_example_node.cpp
@@ -26,6 +26,7 @@
 
 #include <tesseract_examples/car_seat_example.h>
 #include <filesystem>
+#include <console_bridge/console.h>
 #include <tesseract_environment/environment.h>
 #include <tesseract_common/resource_locator.h>
 
@@ -46,5 +47,10 @@ int main(int /*argc*/, char** /*argv*/)
 
   CarSeatExample example(env, nullptr, false);
   if (!example.run())
+  {
+    CONSOLE_BRIDGE_logError("CarSeatExample failed");
     exit(1);
+  }
+
+  CONSOLE_BRIDGE_logInform("CarSeatExample successful");
 }
diff --git a/tesseract_examples/src/freespace_hybrid_example.cpp b/tesseract_examples/src/freespace_hybrid_example.cpp
@@ -246,7 +246,6 @@ bool FreespaceHybridExample::run()
     plotter_->plotTrajectory(trajectory, *state_solver);
   }
 
-  CONSOLE_BRIDGE_logInform("Final trajectory is collision free");
   return future->context->isSuccessful();
 }
 }  // namespace tesseract_examples
diff --git a/tesseract_examples/src/freespace_hybrid_example_node.cpp b/tesseract_examples/src/freespace_hybrid_example_node.cpp
@@ -26,6 +26,7 @@
 
 #include <tesseract_examples/freespace_hybrid_example.h>
 #include <filesystem>
+#include <console_bridge/console.h>
 #include <tesseract_environment/environment.h>
 #include <tesseract_common/resource_locator.h>
 
@@ -46,5 +47,10 @@ int main(int /*argc*/, char** /*argv*/)
 
   FreespaceHybridExample example(env, nullptr);
   if (!example.run())
+  {
+    CONSOLE_BRIDGE_logError("FreespaceHybridExample failed");
     exit(1);
+  }
+
+  CONSOLE_BRIDGE_logInform("FreespaceHybridExample successful");
 }
diff --git a/tesseract_examples/src/freespace_ompl_example.cpp b/tesseract_examples/src/freespace_ompl_example.cpp
@@ -218,7 +218,6 @@ bool FreespaceOMPLExample::run()
     plotter_->plotTrajectory(trajectory, *state_solver);
   }
 
-  CONSOLE_BRIDGE_logInform("Final trajectory is collision free");
   return future->context->isSuccessful();
 }
 }  // namespace tesseract_examples
diff --git a/tesseract_examples/src/freespace_ompl_example_node.cpp b/tesseract_examples/src/freespace_ompl_example_node.cpp
@@ -26,6 +26,7 @@
 
 #include <tesseract_examples/freespace_ompl_example.h>
 #include <filesystem>
+#include <console_bridge/console.h>
 #include <tesseract_environment/environment.h>
 #include <tesseract_common/resource_locator.h>
 
@@ -46,5 +47,10 @@ int main(int /*argc*/, char** /*argv*/)
 
   FreespaceOMPLExample example(env, nullptr);
   if (!example.run())
+  {
+    CONSOLE_BRIDGE_logError("FreespaceOMPLExample failed");
     exit(1);
+  }
+
+  CONSOLE_BRIDGE_logInform("FreespaceOMPLExample successful");
 }
diff --git a/tesseract_examples/src/glass_upright_example.cpp b/tesseract_examples/src/glass_upright_example.cpp
@@ -298,7 +298,6 @@ bool GlassUprightExample::run()
     plotter_->plotTrajectory(trajectory, *state_solver);
   }
 
-  CONSOLE_BRIDGE_logInform("Final trajectory is collision free");
   return future->context->isSuccessful();
 }
 }  // namespace tesseract_examples
diff --git a/tesseract_examples/src/glass_upright_example_node.cpp b/tesseract_examples/src/glass_upright_example_node.cpp
@@ -26,6 +26,7 @@
 
 #include <tesseract_examples/glass_upright_example.h>
 #include <filesystem>
+#include <console_bridge/console.h>
 #include <tesseract_environment/environment.h>
 #include <tesseract_common/resource_locator.h>
 
@@ -46,5 +47,10 @@ int main(int /*argc*/, char** /*argv*/)
 
   GlassUprightExample example(env, nullptr);
   if (!example.run())
+  {
+    CONSOLE_BRIDGE_logError("GlassUprightExample failed");
     exit(1);
+  }
+
+  CONSOLE_BRIDGE_logInform("GlassUprightExample successful");
 }
diff --git a/tesseract_examples/src/glass_upright_ompl_example_node.cpp b/tesseract_examples/src/glass_upright_ompl_example_node.cpp
@@ -26,6 +26,7 @@
 
 #include <tesseract_examples/glass_upright_ompl_example.h>
 #include <filesystem>
+#include <console_bridge/console.h>
 #include <tesseract_environment/environment.h>
 #include <tesseract_common/resource_locator.h>
 
@@ -46,5 +47,10 @@ int main(int argc, char** argv)
 
   GlassUprightOMPLExample example(env, nullptr);
   if (!example.run())
+  {
+    CONSOLE_BRIDGE_logError("GlassUprightOMPLExample failed");
     exit(1);
+  }
+
+  CONSOLE_BRIDGE_logInform("GlassUprightOMPLExample successful");
 }
diff --git a/tesseract_examples/src/online_planning_example_node.cpp b/tesseract_examples/src/online_planning_example_node.cpp
@@ -31,6 +31,7 @@
 
 #include <tesseract_examples/online_planning_example.h>
 #include <filesystem>
+#include <console_bridge/console.h>
 #include <tesseract_environment/environment.h>
 #include <tesseract_common/resource_locator.h>
 
@@ -51,5 +52,10 @@ int main(int /*argc*/, char** /*argv*/)
 
   OnlinePlanningExample example(env, nullptr);
   if (!example.run())
+  {
+    CONSOLE_BRIDGE_logError("OnlinePlanningExample failed");
     exit(1);
+  }
+
+  CONSOLE_BRIDGE_logInform("OnlinePlanningExample successful");
 }
diff --git a/tesseract_examples/src/pick_and_place_example_node.cpp b/tesseract_examples/src/pick_and_place_example_node.cpp
@@ -26,6 +26,7 @@
 
 #include <tesseract_examples/pick_and_place_example.h>
 #include <filesystem>
+#include <console_bridge/console.h>
 #include <tesseract_environment/environment.h>
 #include <tesseract_common/resource_locator.h>
 
@@ -46,5 +47,10 @@ int main(int /*argc*/, char** /*argv*/)
 
   PickAndPlaceExample example(env, nullptr);
   if (!example.run())
+  {
+    CONSOLE_BRIDGE_logError("PickAndPlaceExample failed");
     exit(1);
+  }
+
+  CONSOLE_BRIDGE_logInform("PickAndPlaceExample successful");
 }
diff --git a/tesseract_examples/src/puzzle_piece_auxillary_axes_example.cpp b/tesseract_examples/src/puzzle_piece_auxillary_axes_example.cpp
@@ -323,7 +323,6 @@ bool PuzzlePieceAuxillaryAxesExample::run()
     plotter_->plotTrajectory(trajectory, *state_solver);
   }
 
-  CONSOLE_BRIDGE_logInform("Final trajectory is collision free");
   return future->context->isSuccessful();
 }
 }  // namespace tesseract_examples
diff --git a/tesseract_examples/src/puzzle_piece_auxillary_axes_example_node.cpp b/tesseract_examples/src/puzzle_piece_auxillary_axes_example_node.cpp
@@ -26,6 +26,7 @@
 
 #include <tesseract_examples/puzzle_piece_auxillary_axes_example.h>
 #include <filesystem>
+#include <console_bridge/console.h>
 #include <tesseract_environment/environment.h>
 #include <tesseract_common/resource_locator.h>
 
@@ -46,5 +47,10 @@ int main(int /*argc*/, char** /*argv*/)
 
   PuzzlePieceAuxillaryAxesExample example(env, nullptr);
   if (!example.run())
+  {
+    CONSOLE_BRIDGE_logError("PuzzlePieceAuxillaryAxesExample failed");
     exit(1);
+  }
+
+  CONSOLE_BRIDGE_logInform("PuzzlePieceAuxillaryAxesExample successful");
 }
diff --git a/tesseract_examples/src/puzzle_piece_example.cpp b/tesseract_examples/src/puzzle_piece_example.cpp
@@ -312,7 +312,6 @@ bool PuzzlePieceExample::run()
     plotter_->plotTrajectory(trajectory, *state_solver);
   }
 
-  CONSOLE_BRIDGE_logInform("Final trajectory is collision free");
   return future->context->isSuccessful();
 }
 }  // namespace tesseract_examples
diff --git a/tesseract_examples/src/puzzle_piece_example_node.cpp b/tesseract_examples/src/puzzle_piece_example_node.cpp
@@ -26,6 +26,7 @@
 
 #include <tesseract_examples/puzzle_piece_example.h>
 #include <filesystem>
+#include <console_bridge/console.h>
 #include <tesseract_environment/environment.h>
 #include <tesseract_common/resource_locator.h>
 
@@ -46,5 +47,10 @@ int main(int /*argc*/, char** /*argv*/)
 
   PuzzlePieceExample example(env, nullptr);
   if (!example.run())
+  {
+    CONSOLE_BRIDGE_logError("PuzzlePieceExample failed");
     exit(1);
+  }
+
+  CONSOLE_BRIDGE_logInform("PuzzlePieceExample successful");
 }
diff --git a/tesseract_examples/src/scene_graph_example_node.cpp b/tesseract_examples/src/scene_graph_example_node.cpp
@@ -26,6 +26,7 @@
 
 #include <tesseract_examples/scene_graph_example.h>
 #include <filesystem>
+#include <console_bridge/console.h>
 #include <tesseract_environment/environment.h>
 #include <tesseract_common/resource_locator.h>
 
@@ -46,5 +47,10 @@ int main(int /*argc*/, char** /*argv*/)
 
   SceneGraphExample example(env, nullptr);
   if (!example.run())
+  {
+    CONSOLE_BRIDGE_logError("SceneGraphExample failed");
     exit(1);
+  }
+
+  CONSOLE_BRIDGE_logInform("SceneGraphExample successful");
 }

Original file line number	Diff line number	Diff line change
`@@ -311,7 +311,6 @@ bool BasicCartesianExample::run()`
`311`	`311`	`plotter_->plotTrajectory(trajectory, *state_solver);`
`312`	`312`	`}`
`313`	`313`
`314`		`- CONSOLE_BRIDGE_logInform("Final trajectory is collision free");`
`315`	`314`	`return future->context->isSuccessful();`
`316`	`315`	`}`
`317`	`316`
Original file line number	Diff line number	Diff line change
`@@ -246,7 +246,6 @@ bool FreespaceHybridExample::run()`
`246`	`246`	`plotter_->plotTrajectory(trajectory, *state_solver);`
`247`	`247`	`}`
`248`	`248`
`249`		`- CONSOLE_BRIDGE_logInform("Final trajectory is collision free");`
`250`	`249`	`return future->context->isSuccessful();`
`251`	`250`	`}`
`252`	`251`	`} // namespace tesseract_examples`
Original file line number	Diff line number	Diff line change
`@@ -218,7 +218,6 @@ bool FreespaceOMPLExample::run()`
`218`	`218`	`plotter_->plotTrajectory(trajectory, *state_solver);`
`219`	`219`	`}`
`220`	`220`
`221`		`- CONSOLE_BRIDGE_logInform("Final trajectory is collision free");`
`222`	`221`	`return future->context->isSuccessful();`
`223`	`222`	`}`
`224`	`223`	`} // namespace tesseract_examples`
Original file line number	Diff line number	Diff line change
`@@ -298,7 +298,6 @@ bool GlassUprightExample::run()`
`298`	`298`	`plotter_->plotTrajectory(trajectory, *state_solver);`
`299`	`299`	`}`
`300`	`300`
`301`		`- CONSOLE_BRIDGE_logInform("Final trajectory is collision free");`
`302`	`301`	`return future->context->isSuccessful();`
`303`	`302`	`}`
`304`	`303`	`} // namespace tesseract_examples`