handle cases when the value_ptr_ is invalid

pal-robotics-forks · Nov 29, 2024 · c312a9b · c312a9b
1 parent 52310fd
commit c312a9b
Showing 1 changed file with 4 additions and 2 deletions.
diff --git a/hardware_interface/include/hardware_interface/handle.hpp b/hardware_interface/include/hardware_interface/handle.hpp
@@ -212,7 +212,8 @@ class StateInterface : public Handle
   {
     if (std::holds_alternative<double>(value_))
     {
-      std::function<double()> f = [this]() { return *value_ptr_; };
+      std::function<double()> f = [this]()
+      { return value_ptr_ ? *value_ptr_ : std::numeric_limits<double>::quiet_NaN(); };
       REGISTER_ENTITY(DEFAULT_REGISTRY_KEY, "state_interface." + get_name(), f);
     }
   }
@@ -258,7 +259,8 @@ class CommandInterface : public Handle
     {
       RCLCPP_INFO_STREAM(
         rclcpp::get_logger("command_interface"), "Registering handle: " << get_name());
-      std::function<double()> f = [this]() { return *value_ptr_; };
+      std::function<double()> f = [this]()
+      { return value_ptr_ ? *value_ptr_ : std::numeric_limits<double>::quiet_NaN(); };
       REGISTER_ENTITY(DEFAULT_REGISTRY_KEY, "command_interface." + get_name(), f);
     }
   }