Add pybindings for VolumetricGridLookupField

src/python_pybind11/CMakeLists.txt

@@ -39,6 +39,7 @@ pybind11_add_module(${BINDINGS_MODULE_NAME} MODULE
   src/Frustum.cc
   src/GaussMarkovProcess.cc
   src/Helpers.cc
+  src/InterpolationPoint.cc
   src/Interval.cc
   src/Kmeans.cc
   src/Line2.cc
@@ -70,6 +71,7 @@ pybind11_add_module(${BINDINGS_MODULE_NAME} MODULE
   src/Vector3.cc
   src/Vector4.cc
   src/Vector3Stats.cc
+  src/VolumetricGridLookupField.cc
 )
 
 target_link_libraries(${BINDINGS_MODULE_NAME} PRIVATE

src/python_pybind11/src/InterpolationPoint.cc

@@ -0,0 +1,32 @@
+/*
+ * Copyright (C) 2025 Open Source Robotics Foundation
+ *
+ * Licensed under the Apache License, Version 2.0 (the "License");
+ * you may not use this file except in compliance with the License.
+ * You may obtain a copy of the License at
+ *
+ *     http://www.apache.org/licenses/LICENSE-2.0
+ *
+ * Unless required by applicable law or agreed to in writing, software
+ * distributed under the License is distributed on an "AS IS" BASIS,
+ * WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied.
+ * See the License for the specific language governing permissions and
+ * limitations under the License.
+ *
+ */
+
+#include "InterpolationPoint.hh"
+#include <string>
+
+namespace gz {
+namespace math {
+namespace python {
+
+void defineMathInterpolationPoint3D(py::module &m, const std::string &typestr) {
+  helpDefineMathInterpolationPoint3D<double>(m, typestr + "d");
+  helpDefineMathInterpolationPoint3D<float>(m, typestr + "f");
+}
+
+}  // namespace python
+}  // namespace math
+}  // namespace gz

src/python_pybind11/src/InterpolationPoint.hh

@@ -0,0 +1,80 @@
+/*
+ * Copyright (C) 2025 Open Source Robotics Foundation
+ *
+ * Licensed under the Apache License, Version 2.0 (the "License");
+ * you may not use this file except in compliance with the License.
+ * You may obtain a copy of the License at
+ *
+ *     http://www.apache.org/licenses/LICENSE-2.0
+ *
+ * Unless required by applicable law or agreed to in writing, software
+ * distributed under the License is distributed on an "AS IS" BASIS,
+ * WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied.
+ * See the License for the specific language governing permissions and
+ * limitations under the License.
+ *
+ */
+
+#ifndef GZ_MATH_PYTHON__INTERPOLATION_POINT_HH_
+#define GZ_MATH_PYTHON__INTERPOLATION_POINT_HH_
+
+#include <sstream>
+#include <string>
+
+#include <pybind11/operators.h>
+#include <pybind11/pybind11.h>
+#include <pybind11/stl.h>
+
+#include <gz/math/Vector3.hh>
+#include <gz/math/detail/InterpolationPoint.hh>
+
+namespace py = pybind11;
+using namespace pybind11::literals;
+
+namespace gz {
+namespace math {
+namespace python {
+/// define a pybind11 wrapper for gz::math::InterpolationPoint3D
+/**
+ * \param[in] module a pybind11 module to add the definition to
+ */
+template <typename T>
+void helpDefineMathInterpolationPoint3D(py::module &m,
+                                        const std::string &typestr) {
+  using Class = gz::math::InterpolationPoint3D<T>;
+  using Vector3Type = gz::math::Vector3<T>;
+
+  auto toString = [](const Class &si) {
+    std::stringstream stream;
+    stream << "InterpolationPoint3D(position=" << si.position;
+    if (si.index.has_value()) {
+      stream << ", index=" << si.index.value();
+    } else {
+      stream << ", index=None";
+    }
+    stream << ")";
+    return stream.str();
+  };
+
+  std::string pyclass_name = typestr;
+  py::class_<Class>(m, pyclass_name.c_str(), py::dynamic_attr())
+      .def(py::init<>())
+      .def(py::init<Vector3Type, std::optional<std::size_t>>(),
+           py::arg("position"), py::arg("index") = std::nullopt)
+      .def_readwrite("position", &Class::position)
+      .def_readwrite("index", &Class::index)
+      .def("__str__", toString)
+      .def("__repr__", toString);
+}
+
+/// define a pybind11 wrapper for gz::math::InterpolationPoint3D
+/**
+ * \param[in] module a pybind11 module to add the definition to
+ */
+void defineMathInterpolationPoint3D(py::module &m, const std::string &typestr);
+
+}  // namespace python
+}  // namespace math
+}  // namespace gz
+
+#endif  // GZ_MATH_PYTHON__INTERPOLATION_POINT_HH_

src/python_pybind11/src/VolumetricGridLookupField.cc

@@ -0,0 +1,35 @@
+/*
+ * Copyright (C) 2025 Open Source Robotics Foundation
+ *
+ * Licensed under the Apache License, Version 2.0 (the "License");
+ * you may not use this file except in compliance with the License.
+ * You may obtain a copy of the License at
+ *
+ *     http://www.apache.org/licenses/LICENSE-2.0
+ *
+ * Unless required by applicable law or agreed to in writing, software
+ * distributed under the License is distributed on an "AS IS" BASIS,
+ * WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied.
+ * See the License for the specific language governing permissions and
+ * limitations under the License.
+ *
+ */
+
+#include "VolumetricGridLookupField.hh"
+#include <string>
+
+namespace gz {
+namespace math {
+namespace python {
+
+void defineMathVolumetricGridLookupField(py::module &m,
+                                         const std::string &typestr) {
+  // Define for double type
+  helpDefineMathVolumetricGridLookupField<double>(m, typestr + "d");
+  // Define for float type
+  helpDefineMathVolumetricGridLookupField<float>(m, typestr + "f");
+}
+
+}  // namespace python
+}  // namespace math
+}  // namespace gz

src/python_pybind11/src/VolumetricGridLookupField.hh

@@ -0,0 +1,93 @@
+/*
+ * Copyright (C) 2025 Open Source Robotics Foundation
+ *
+ * Licensed under the Apache License, Version 2.0 (the "License");
+ * you may not use this file except in compliance with the License.
+ * You may obtain a copy of the License at
+ *
+ *     http://www.apache.org/licenses/LICENSE-2.0
+ *
+ * Unless required by applicable law or agreed to in writing, software
+ * distributed under the License is distributed on an "AS IS" BASIS,
+ * WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied.
+ * See the License for the specific language governing permissions and
+ * limitations under the License.
+ *
+ */
+
+#ifndef GZ_MATH_PYTHON__VOLUMETRIC_GRID_LOOKUP_FIELD_HH_
+#define GZ_MATH_PYTHON__VOLUMETRIC_GRID_LOOKUP_FIELD_HH_
+
+#include <sstream>
+#include <string>
+#include <vector>
+
+#include <pybind11/operators.h>
+#include <pybind11/pybind11.h>
+#include <pybind11/stl.h>
+
+#include <gz/math/Vector3.hh>
+#include <gz/math/VolumetricGridLookupField.hh>
+#include <gz/math/detail/InterpolationPoint.hh>
+
+namespace py = pybind11;
+using namespace pybind11::literals;
+
+namespace gz {
+namespace math {
+namespace python {
+/// define a pybind11 wrapper for a gz::math::VolumetricGridLookupField
+/**
+ * \param[in] module a pybind11 module to add the definition to
+ */
+template <typename T, typename I = std::size_t>
+void helpDefineMathVolumetricGridLookupField(py::module &m,
+                                             const std::string &typestr) {
+  using Class = gz::math::VolumetricGridLookupField<T, I>;
+  using Vector3Type = gz::math::Vector3<T>;
+
+  auto toString = [](const Class &si) {
+    std::stringstream stream;
+    stream << "VolumetricGridLookupField";
+    return stream.str();
+  };
+
+  std::string pyclass_name = typestr;
+  py::class_<Class>(m, pyclass_name.c_str(), py::buffer_protocol(),
+                    py::dynamic_attr())
+      .def(py::init<const std::vector<Vector3Type> &>())
+      .def(py::init<const std::vector<Vector3Type> &, const std::vector<I> &>())
+      .def(
+          "get_interpolators",
+          [](const Class &self, const Vector3Type &pt, double xTol, double yTol,
+             double zTol) {
+            return self.GetInterpolators(pt, xTol, yTol, zTol);
+          },
+          "Get interpolators for a given point", py::arg("point"),
+          py::arg("x_tol") = 1e-6, py::arg("y_tol") = 1e-6,
+          py::arg("z_tol") = 1e-6)
+      .def(
+          "estimate_value_using_trilinear",
+          [](const Class &self, const Vector3Type &pt,
+             const std::vector<double> &values, double defaultVal = 0.0) {
+            return self.EstimateValueUsingTrilinear(pt, values, defaultVal);
+          },
+          "Estimate value using trilinear interpolation", py::arg("point"),
+          py::arg("values"), py::arg("default") = 0.0)
+      .def("bounds", &Class::Bounds, "Get the bounds of the grid field")
+      .def("__str__", toString)
+      .def("__repr__", toString);
+}
+
+/// Define a pybind11 wrapper for a gz::math::VolumetricGridLookupField
+/**
+ * \param[in] module a pybind11 module to add the definition to
+ */
+void defineMathVolumetricGridLookupField(py::module &m,
+                                         const std::string &typestr);
+
+}  // namespace python
+}  // namespace math
+}  // namespace gz
+
+#endif  // GZ_MATH_PYTHON__VOLUMETRIC_GRID_LOOKUP_FIELD_HH_

src/python_pybind11/src/_gz_math_pybind11.cc

@@ -64,10 +64,11 @@
 #include "Vector3Stats.hh"
 #include "Vector4.hh"
 
+#include "InterpolationPoint.hh"
+#include "VolumetricGridLookupField.hh"
 namespace py = pybind11;
 
-PYBIND11_MODULE(BINDINGS_MODULE_NAME, m)
-{
+PYBIND11_MODULE(BINDINGS_MODULE_NAME, m) {
   m.doc() = "Gazebo Math Python Library.";
 
   gz::math::python::defineMathAngle(m, "Angle");
@@ -78,14 +79,11 @@ PYBIND11_MODULE(BINDINGS_MODULE_NAME, m)
 
   gz::math::python::defineMathColor(m, "Color");
 
-  gz::math::python::defineMathDiffDriveOdometry(
-    m, "DiffDriveOdometry");
+  gz::math::python::defineMathDiffDriveOdometry(m, "DiffDriveOdometry");
 
-  gz::math::python::defineMathEllipsoid(
-    m, "Ellipsoid");
+  gz::math::python::defineMathEllipsoid(m, "Ellipsoid");
 
-  gz::math::python::defineMathGaussMarkovProcess(
-    m, "GaussMarkovProcess");
+  gz::math::python::defineMathGaussMarkovProcess(m, "GaussMarkovProcess");
 
   gz::math::python::defineMathHelpers(m);
 
@@ -106,10 +104,9 @@ PYBIND11_MODULE(BINDINGS_MODULE_NAME, m)
   gz::math::python::defineMathSignalVariance(m, "SignalVariance");
   gz::math::python::defineMathSignalMaximum(m, "SignalMaximum");
   gz::math::python::defineMathSignalMinimum(m, "SignalMinimum");
-  gz::math::python::defineMathSignalMaxAbsoluteValue(
-    m, "SignalMaxAbsoluteValue");
-  gz::math::python::defineMathSignalRootMeanSquare(
-    m, "SignalRootMeanSquare");
+  gz::math::python::defineMathSignalMaxAbsoluteValue(m,
+                                                     "SignalMaxAbsoluteValue");
+  gz::math::python::defineMathSignalRootMeanSquare(m, "SignalRootMeanSquare");
   gz::math::python::defineMathSignalMean(m, "SignalMean");
 
   gz::math::python::defineMathRotationSpline(m, "RotationSpline");
@@ -118,8 +115,7 @@ PYBIND11_MODULE(BINDINGS_MODULE_NAME, m)
 
   gz::math::python::defineMathSemanticVersion(m, "SemanticVersion");
 
-  gz::math::python::defineMathSphericalCoordinates(
-    m, "SphericalCoordinates");
+  gz::math::python::defineMathSphericalCoordinates(m, "SphericalCoordinates");
 
   gz::math::python::defineMathSpline(m, "Spline");
 
@@ -182,15 +178,16 @@ PYBIND11_MODULE(BINDINGS_MODULE_NAME, m)
 
   gz::math::python::defineMathBiQuad(m, "BiQuad");
 
-  gz::math::python::defineMathBiQuadVector3(
-    m, "BiQuadVector3");
+  gz::math::python::defineMathBiQuadVector3(m, "BiQuadVector3");
 
   gz::math::python::defineMathOnePole(m, "OnePole");
 
-  gz::math::python::defineMathOnePoleQuaternion(
-    m, "OnePoleQuaternion");
-  gz::math::python::defineMathOnePoleVector3(
-    m, "OnePoleVector3");
+  gz::math::python::defineMathOnePoleQuaternion(m, "OnePoleQuaternion");
+  gz::math::python::defineMathOnePoleVector3(m, "OnePoleVector3");
 
   gz::math::python::defineMathCoordinateVector3(m, "CoordinateVector3");
+
+  gz::math::python::defineMathVolumetricGridLookupField(
+      m, "VolumetricGridLookupField");
+  gz::math::python::defineMathInterpolationPoint3D(m, "InterpolationPoint3D");
 }