Merge pull request #17 from IOES-Lab/fix/dvl-water-mass-bounds-20261009

fix: keep DVL water-mass layers within sensor ranges

Author: woensug-choi

models/posim_sensor_models/CMakeLists.txt

@@ -11,4 +11,10 @@ install(
 ament_environment_hooks(
   "${CMAKE_CURRENT_SOURCE_DIR}/hooks/${PROJECT_NAME}.dsv.in")
 
+if(BUILD_TESTING)
+  find_package(ament_cmake_pytest REQUIRED)
+  ament_add_pytest_test(test_dvl_tracking_bounds
+    test/test_dvl_tracking_bounds.py)
+endif()
+
 ament_package()

models/posim_sensor_models/description/nortek_dvl1000_300/model.sdf

@@ -60,7 +60,7 @@
               </water_velocity>
               <boundaries>
                 <near>10.</near>
-                <far>100.</far>
+                <far>75.</far>
               </boundaries>
               <bins>10</bins>
               <noise type="gaussian">

models/posim_sensor_models/description/teledyne_explorer1000/model.sdf

@@ -59,7 +59,7 @@
               </water_velocity>
               <boundaries>
                 <near>10.</near>
-                <far>100.</far>
+                <far>81.</far>
               </boundaries>
               <bins>10</bins>
               <noise type="gaussian">

models/posim_sensor_models/description/teledyne_explorer4000/model.sdf

@@ -60,7 +60,7 @@
               </water_velocity>
               <boundaries>
                 <near>10.</near>
-                <far>100.</far>
+                <far>66.</far>
               </boundaries>
               <bins>10</bins>
               <noise type="gaussian">

models/posim_sensor_models/description/teledyne_whn/model.sdf

@@ -61,7 +61,7 @@
               </water_velocity>
               <boundaries>
                 <near>10.</near>
-                <far>100.</far>
+                <far>90.</far>
               </boundaries>
               <bins>10</bins>
               <noise type="gaussian">

models/posim_sensor_models/package.xml

@@ -8,6 +8,7 @@
   <maintainer email="kys50728@g.kmou.ac.kr">Ye-Seol Kwon</maintainer>
   <license>Apache 2.0</license>
   <buildtool_depend>ament_cmake</buildtool_depend>
+  <test_depend>ament_cmake_pytest</test_depend>
   <export>
     <build_type>ament_cmake</build_type>
     <!-- This doesn't work yet https://github.com/gazebosim/ros_gz/pull/492 -->

models/posim_sensor_models/test/test_dvl_tracking_bounds.py

@@ -0,0 +1,34 @@
+"""Catch DVL configurations rejected by Gazebo before publication starts."""
+
+from pathlib import Path
+import re
+import xml.etree.ElementTree as ET
+
+import pytest
+
+DESCRIPTION = Path(__file__).resolve().parents[1] / "description"
+DVL_MODELS = [p for p in sorted(DESCRIPTION.glob("*/model.sdf")) if "<gz:dvl>" in p.read_text()]
+
+
+def test_dvl_catalog_is_present():
+    assert DVL_MODELS, "No DVL descriptors found; check the test resource path"
+
+
+@pytest.mark.parametrize("path", DVL_MODELS, ids=lambda p: p.parent.name)
+def test_water_mass_layer_fits_sensor_range(path):
+    # SDF accepts the gz extension without an XML namespace declaration.
+    text = re.sub(r"<sdf\b", '<sdf xmlns:gz="urn:gz"', path.read_text(), count=1)
+    root = ET.fromstring(text)
+    for dvl in root.iter("{urn:gz}dvl"):
+        minimum = float(dvl.findtext("minimum_range"))
+        maximum = float(dvl.findtext("maximum_range"))
+        assert 0 <= minimum < maximum
+        mode = dvl.find("tracking/water_mass_mode")
+        if mode is None or mode.findtext("when") == "never":
+            continue
+        near = float(mode.findtext("boundaries/near", str(0.2 * maximum)))
+        far = float(mode.findtext("boundaries/far", str(0.8 * maximum)))
+        assert minimum <= near < far <= maximum, (
+            f"{path.parent.name}: water-mass [{near}, {far}] exceeds "
+            f"sensor range [{minimum}, {maximum}]"
+        )