i/rtabmap_ros
1
0
Fork 0
mirror of https://github.com/introlab/rtabmap_ros.git synced 2026-10-03 16:27:46 +08:00
Code Issues Packages Projects Releases Wiki Activity

yaml_to_camera_info: support yaml format writen by opencv

Browse Source
This commit is contained in:
matlabbe
2024-06-04 11:32:27 -07:00
parent 86f91f3cec
commit a8cefa9a4d
1 changed files with 3 additions and 0 deletions
Download Patch File Download Diff File Expand all files Collapse all files
rtabmap_util/scripts/yaml_to_camera_info.py
+3
View File
@@ -7,6 +7,9 @@ from sensor_msgs.msg import Image
def yaml_to_CameraInfo(yaml_fname): def yaml_to_CameraInfo(yaml_fname):
with open(yaml_fname, "r") as file_handle: 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) calib_data = yaml.load(file_handle, Loader=yaml.FullLoader)
camera_info_msg = CameraInfo() camera_info_msg = CameraInfo()