Fix TB3 adapter initPosition result (#6)

inorbit-ai · Nov 11, 2022 · a86b98f · a86b98f
1 parent 9970876
commit a86b98f
Showing 1 changed file with 8 additions and 0 deletions.
diff --git a/vda5050_tb3_adapter/vda5050_tb3_adapter/tb3_adapter.py b/vda5050_tb3_adapter/vda5050_tb3_adapter/tb3_adapter.py
@@ -215,6 +215,14 @@ def process_vda_action_callback(self, goal_handle):
 
             self._init_pose_pub.publish(pose_with_cov_stamped)
 
+            self.logger.info(f"Instant action '{action.action_id}' finished")
+
+            result.result = VDACurrentAction(
+                action_id=action.action_id,
+                action_description=action.action_description,
+                action_status=VDACurrentAction.FINISHED,
+            )
+
         else:
             self.logger.info(
                 f"Received unsupported action: '{action.action_type}'. "