merged master->ros2

2026-10-03 16:27:46 +08:00 · 2024-06-12 22:51:30 -07:00
parent 911e4e8941 ae44e1a215
commit d3d874c862
35 changed files with 857 additions and 771 deletions
@@ -8,6 +8,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)
 
    msg = CameraInfo()