1.添加任务完成后回复

RobotData.py

@@ -186,6 +186,8 @@ class Robot(MqttAsync):
     '''
 
     def Navigatting(self, begId, targetId, autoDirect, wheelbase=0, task_type="None"):
+        if wheelbase < 2.4 or wheelbase > 3.2:
+            return print("wheelbase is out of range!\n")
         print("nav")
 
         # self.ExecPathNodes(autoDirect)

count.json

@@ -1 +1 @@
-{"load_count": 824, "single_count": 2516}
+{"load_count": 863, "single_count": 2575}

map.json

@@ -55,7 +55,7 @@
       -0.32, 1.0, 90
     ],
     "S65": [
-      -16.665, -1.120, 89.15
+      -16.665, -0.980, 89.15
     ],
     "S145": [
       -8.57, -13.48, -89.15

test.py

@@ -132,14 +132,6 @@ class MainWindow(QMainWindow):
 
     def recv_park_request(self, msg):
         print("Recv_park_request------------------\n", msg)
-        # time.sleep(30)
-        # # self.g_rabbitmq.publish("command_ex", "user_pick_command_request_port",
-        # # tf.MessageToString(table, as_utf8=True))
-        # self.g_rabbitmq.publish("command_ex", "agv_park_command_response_port",
-        #                         msg)
-        # print("Publish_park_response------------------\n", msg)
-        # return True
-
         park_table = message.park_table()
         try:
             tf.Parse(msg, park_table)
@@ -151,13 +143,6 @@ class MainWindow(QMainWindow):
     def recv_pick_request(self, msg):
         print("Recv_pick_request------------------\n", msg)
         pick_table = message.pick_table()
-        # time.sleep(30)
-        # self.g_rabbitmq.publish("command_ex", "user_pick_command_request_port",
-        # tf.MessageToString(table, as_utf8=True))
-        # self.g_rabbitmq.publish("command_ex", "agv_pick_command_response_port",
-        #                         msg)
-        # print("Publish_pick_response------------------\n", msg)
-        # return True
 
         try:
             tf.Parse(msg, pick_table)
@@ -359,7 +344,11 @@ class MainWindow(QMainWindow):
 
         threadPool.shutdown(wait=True)
 
-        self.g_rabbitmq.publish()
+        # 反馈
+        self.g_rabbitmq.publish("command_ex", "agv_park_command_response_port",
+                                tf.MessageToString(park_table, as_utf8=True))
+        print("Publish_park_response------------------\n", park_table)
+        return True
 
     def updateMap_pick(self, export_id, type):  # 0:前车轨迹，1：后车轨迹，2：添加整车轨迹
 
@@ -466,6 +455,13 @@ class MainWindow(QMainWindow):
                           export_id, "BInput_R1100", True, wheel_base)
         threadPool.shutdown(wait=True)
 
+        # 反馈
+        self.g_rabbitmq.publish("command_ex", "agv_pick_command_response_port",
+                                tf.MessageToString(pick_table, as_utf8=True))
+        print("Publish_park_response------------------\n", pick_table)
+        return True
+
+
     def ComputeStreetNode(self, s_id, s_x, s_y, s_theta):
         """