From a8cefa9a4dddc8bc42b1a99a596928fbd16c9420 Mon Sep 17 00:00:00 2001 From: matlabbe Date: Tue, 4 Jun 2024 11:32:27 -0700 Subject: [PATCH] yaml_to_camera_info: support yaml format writen by opencv --- rtabmap_util/scripts/yaml_to_camera_info.py | 3 +++ 1 file changed, 3 insertions(+) diff --git a/rtabmap_util/scripts/yaml_to_camera_info.py b/rtabmap_util/scripts/yaml_to_camera_info.py index ab8a8b25..ace42253 100755 --- a/rtabmap_util/scripts/yaml_to_camera_info.py +++ b/rtabmap_util/scripts/yaml_to_camera_info.py @@ -7,6 +7,9 @@ from sensor_msgs.msg import Image def yaml_to_CameraInfo(yaml_fname): with open(yaml_fname, "r") as file_handle: + first_line = file_handle.readline() + if "%YAML:" not in first_line: + file_handle.seek(0) calib_data = yaml.load(file_handle, Loader=yaml.FullLoader) camera_info_msg = CameraInfo()