refining output

marinagmoreira · Apr 27, 2024 · 640685c · 640685c
1 parent 0d8b237
commit 640685c
Show file tree

Hide file tree

Showing 2 changed files with 4 additions and 4 deletions.
diff --git a/behaviors/dock/src/dock_nodelet.cc b/behaviors/dock/src/dock_nodelet.cc
@@ -734,7 +734,7 @@ class DockNodelet : public ff_util::FreeFlyerNodelet {
     case ff_util::FreeFlyerActionState::SUCCESS:
       return fsm_.Update(SWITCH_SUCCESS);
     default:
-      err_msg_ = "Result code " + result->fsm_result;
+      err_msg_ = "Switch Code " + std::to_string(result->response) + ": (" + result->fsm_result + ")";
       return fsm_.Update(SWITCH_FAILED);
     }
   }
@@ -855,7 +855,7 @@ class DockNodelet : public ff_util::FreeFlyerNodelet {
     case ff_util::FreeFlyerActionState::SUCCESS:
       return fsm_.Update(MOTION_SUCCESS);
     default:
-      err_msg_ = "Result code " + result->fsm_result;
+      err_msg_ = "Move Code " + std::to_string(result->response) + ": (" + result->fsm_result + ")";
       return fsm_.Update(MOTION_FAILED);
     }
   }

diff --git a/behaviors/perch/src/perch_nodelet.cc b/behaviors/perch/src/perch_nodelet.cc
@@ -750,7 +750,7 @@ class PerchNodelet : public ff_util::FreeFlyerNodelet {
     case ff_util::FreeFlyerActionState::SUCCESS:
       return fsm_.Update(ARM_SUCCESS);
     default:
-      err_msg_ = "Result code " + result->fsm_result;
+      err_msg_ = "Arm Code " + std::to_string(result->response) + ": (" + result->fsm_result + ")";
       return fsm_.Update(ARM_FAILED);
     }
   }
@@ -915,7 +915,7 @@ class PerchNodelet : public ff_util::FreeFlyerNodelet {
     case ff_util::FreeFlyerActionState::SUCCESS:
       return fsm_.Update(MOTION_SUCCESS);
     default:
-      err_msg_ = "Result code " + result->fsm_result;
+      err_msg_ = "Move Code " + std::to_string(result->response) + ": (" + result->fsm_result + ")";
       return fsm_.Update(MOTION_FAILED);
     }
   }