diff --git a/calibrators/intrinsic_camera_calibrator/intrinsic_camera_calibrator/intrinsic_camera_calibrator/board_detectors/dotboard_detector.py b/calibrators/intrinsic_camera_calibrator/intrinsic_camera_calibrator/intrinsic_camera_calibrator/board_detectors/dotboard_detector.py
index 1acbcc85..3b50fc0d 100644
--- a/calibrators/intrinsic_camera_calibrator/intrinsic_camera_calibrator/intrinsic_camera_calibrator/board_detectors/dotboard_detector.py
+++ b/calibrators/intrinsic_camera_calibrator/intrinsic_camera_calibrator/intrinsic_camera_calibrator/board_detectors/dotboard_detector.py
@@ -120,6 +120,10 @@ def detect(detection_image, detector):
if not resized_detection or max(h, w) <= resized_max_resolution:
(ok, corners) = detect(grayscale, full_res_detector)
+ if not ok:
+ self.detection_results_signal.emit(img, None, stamp)
+ return
+
else:
# Resize
resized = cv2.resize(img, (resized_w, resized_h), interpolation=cv2.INTER_NEAREST)
diff --git a/calibrators/tag_based_pnp_calibrator/launch/calibrator.launch.xml b/calibrators/tag_based_pnp_calibrator/launch/calibrator.launch.xml
index 4cec786a..4af18237 100644
--- a/calibrators/tag_based_pnp_calibrator/launch/calibrator.launch.xml
+++ b/calibrators/tag_based_pnp_calibrator/launch/calibrator.launch.xml
@@ -3,16 +3,34 @@
-
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
-
+
+
diff --git a/calibrators/tag_based_sfm_calibrator/launch/lidartag_detector.launch.xml b/calibrators/tag_based_sfm_calibrator/launch/lidartag_detector.launch.xml
index 02c0f144..7abd999e 100644
--- a/calibrators/tag_based_sfm_calibrator/launch/lidartag_detector.launch.xml
+++ b/calibrators/tag_based_sfm_calibrator/launch/lidartag_detector.launch.xml
@@ -3,12 +3,29 @@
-
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
-
+
+
diff --git a/sensor_calibration_manager/launch/default_project/tag_based_pnp_calibrator.launch.xml b/sensor_calibration_manager/launch/default_project/tag_based_pnp_calibrator.launch.xml
index d01343c5..05c47a05 100644
--- a/sensor_calibration_manager/launch/default_project/tag_based_pnp_calibrator.launch.xml
+++ b/sensor_calibration_manager/launch/default_project/tag_based_pnp_calibrator.launch.xml
@@ -5,10 +5,26 @@
-
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
diff --git a/sensor_calibration_manager/launch/default_project/tag_based_sfm_base_lidar_calibrator.launch.xml b/sensor_calibration_manager/launch/default_project/tag_based_sfm_base_lidar_calibrator.launch.xml
index 06ceaae5..86db6e70 100644
--- a/sensor_calibration_manager/launch/default_project/tag_based_sfm_base_lidar_calibrator.launch.xml
+++ b/sensor_calibration_manager/launch/default_project/tag_based_sfm_base_lidar_calibrator.launch.xml
@@ -12,7 +12,7 @@
-
+
diff --git a/sensor_calibration_manager/launch/edge_auto/tag_based_pnp_calibrator.launch.xml b/sensor_calibration_manager/launch/edge_auto/tag_based_pnp_calibrator.launch.xml
index 39adc691..24452b4f 100644
--- a/sensor_calibration_manager/launch/edge_auto/tag_based_pnp_calibrator.launch.xml
+++ b/sensor_calibration_manager/launch/edge_auto/tag_based_pnp_calibrator.launch.xml
@@ -9,12 +9,19 @@
-
+
+
+
+
+
+
+
+
-
+
@@ -50,6 +57,7 @@
+
diff --git a/sensor_calibration_manager/launch/rdv/tag_based_pnp_calibrator.launch.xml b/sensor_calibration_manager/launch/rdv/tag_based_pnp_calibrator.launch.xml
index 963e3db5..0e8f128d 100644
--- a/sensor_calibration_manager/launch/rdv/tag_based_pnp_calibrator.launch.xml
+++ b/sensor_calibration_manager/launch/rdv/tag_based_pnp_calibrator.launch.xml
@@ -23,7 +23,7 @@
-
+
diff --git a/sensor_calibration_manager/launch/rdv/tag_based_sfm_base_lidar_calibrator.launch.xml b/sensor_calibration_manager/launch/rdv/tag_based_sfm_base_lidar_calibrator.launch.xml
index bbc67b99..da8a82c7 100644
--- a/sensor_calibration_manager/launch/rdv/tag_based_sfm_base_lidar_calibrator.launch.xml
+++ b/sensor_calibration_manager/launch/rdv/tag_based_sfm_base_lidar_calibrator.launch.xml
@@ -12,7 +12,7 @@
-
+
diff --git a/sensor_calibration_manager/sensor_calibration_manager/sensor_calibration_manager.py b/sensor_calibration_manager/sensor_calibration_manager/sensor_calibration_manager.py
index d4dbb24b..6f6ae7b4 100644
--- a/sensor_calibration_manager/sensor_calibration_manager/sensor_calibration_manager.py
+++ b/sensor_calibration_manager/sensor_calibration_manager/sensor_calibration_manager.py
@@ -286,7 +286,10 @@ def tfs_graph_callback(self, tfs_dict):
self.tfs_graph_signal.emit(copy.deepcopy(tfs_dict))
def tf_graph_callback2(self, tfs_dict):
- if self.calibrator.state != CalibratorState.WAITING_TFS:
+ if (
+ self.calibrator.state != CalibratorState.WAITING_SERVICES
+ and self.calibrator.state != CalibratorState.WAITING_TFS
+ ):
return
for parent, children_and_tf_dict in tfs_dict.items():