[dynamixel_general_hw] Reset joint limit interfaces in special states to prevent runaway when going back to normal state

Author: pazeshun

dynamixel_general_hw/src/dynamixel_general_hw.cpp

@@ -1174,6 +1174,12 @@ void DynamixelGeneralHw::write(const ros::Time& time, const ros::Duration& perio
       normal_modes_.clear();
     }
   }
+  if (isJntCmdIgnored())
+  {
+    // Reset joint limit interfaces to prevent runaway when going back to normal state
+    pos_jnt_sat_interface_.reset();
+    pos_jnt_soft_interface_.reset();
+  }
   prev_is_servo_ = is_servo_;
   prev_is_hold_pos_ = is_hold_pos_;
 }