OdometryLocalPosition distanceGround() method

Auterion · Sep 11, 2024 · b488dd3 · b488dd3
1 parent 73f222d
commit b488dd3
Showing 1 changed file with 6 additions and 0 deletions.
diff --git a/px4_ros2_cpp/include/px4_ros2/odometry/local_position.hpp b/px4_ros2_cpp/include/px4_ros2/odometry/local_position.hpp
@@ -71,6 +71,12 @@ class OdometryLocalPosition : public Subscription<px4_msgs::msg::VehicleLocalPos
     const px4_msgs::msg::VehicleLocalPosition & pos = last();
     return pos.heading;
   }
+
+  float distanceGround() const
+  {
+    const px4_msgs::msg::VehicleLocalPosition& pos = last();
+    return pos.dist_bottom;
+  }
 };
 
 /** @}*/