Merge pull request #248 from 321Aurora/imagetransmission

Add the function of change position

Author: YoujianWu

rm_common/include/rm_common/decision/command_sender.h

@@ -652,6 +652,12 @@ class JointPositionBinaryCommandSender : public CommandSenderBase<std_msgs::Floa
     msg_.data = off_pos_;
     state = false;
   }
+  void changePosition(double scale)
+  {
+    current_position_ = msg_.data;
+    change_position_ = current_position_ + scale * per_change_position_;
+    msg_.data = change_position_;
+  }
   bool getState() const
   {
     return state;
@@ -664,7 +670,7 @@ class JointPositionBinaryCommandSender : public CommandSenderBase<std_msgs::Floa
 
 private:
   bool state{};
-  double on_pos_{}, off_pos_{};
+  double on_pos_{}, off_pos_{}, current_position_{}, change_position_{}, per_change_position_{ 0.05 };
 };
 
 class CardCommandSender : public CommandSenderBase<std_msgs::Float64>