修改跟随法向量方向移动问题

CU/EMV.py

@@ -36,7 +36,7 @@ def send_command(command):
             print(f"收到响应: {binascii.hexlify(response)}")
             # 校验响应
             if response == byte_data:
-                print("命令成功下发，继电器已执行操作。")
+                # print("命令成功下发，继电器已执行操作。")
                 return True
             else:
                 print("命令下发失败，响应与请求不符。")
@@ -67,7 +67,7 @@ def close(grasp, shake, throw):
         if send_command(valve_commands[1]['close']):
             time.sleep(1)
     if shake:
-        print("关闭电磁阀 2")
+        # print("关闭电磁阀 2")
         if send_command(valve_commands[2]['close']):
             time.sleep(0.05)
     if throw: