fix bugs

SkoltechRobotics · Feb 20, 2019 · 7a91fe7 · 7a91fe7
1 parent 165e50a
commit 7a91fe7
Showing 1 changed file with 2 additions and 2 deletions.
diff --git a/eurobot_stm/scripts/manipulator.py b/eurobot_stm/scripts/manipulator.py
@@ -23,9 +23,9 @@ def response_callback(self, data):
             self.last_response_id = response[0]
             self.last_response_args = response[1]
 
-    def send_command(self, cmd, args):
+    def send_command(self, id, cmd, args):
         while (True):
-            self.publisher.publish(String("manipulator-"+self.id_command+" "+str(cmd) + str(args)))
+            self.publisher.publish(String(str(id) +str(cmd) + str(args)))
             self.id_command += 1
             rospy.sleep(0.1)
             if self.last_response_id == (str(id)):