Fix #259 - ParameterAlreadyDeclaredException for parameter `positio…

…n_proportional_gain` (#261) (cherry picked from commit 2526653)
ros-controls · Mar 28, 2024 · 69e338a · 69e338a
1 parent cec39b6
commit 69e338a
Showing 1 changed file with 7 additions and 2 deletions.
diff --git a/ign_ros2_control/src/ign_system.cpp b/ign_ros2_control/src/ign_system.cpp
@@ -182,8 +182,13 @@ bool IgnitionSystem::initSim(
 
   constexpr double default_gain = 0.1;
 
-  this->dataPtr->position_proportional_gain_ = this->nh_->declare_parameter<double>(
-    "position_proportional_gain", default_gain);
+  try {
+    this->dataPtr->position_proportional_gain_ = this->nh_->declare_parameter<double>(
+      "position_proportional_gain", default_gain);
+  }  catch (rclcpp::exceptions::ParameterAlreadyDeclaredException & ex) {
+    this->nh_->get_parameter(
+      "position_proportional_gain", this->dataPtr->position_proportional_gain_);
+  }
 
   RCLCPP_INFO_STREAM(
     this->nh_->get_logger(),