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():