[Beetle] change some detail of switch script

sugihara-16 · Feb 19, 2024 · 4729474 · 4729474
1 parent 3911bbb
commit 4729474
Showing 1 changed file with 4 additions and 2 deletions.
diff --git a/robots/beetle/script/switch_cmd_pub.py b/robots/beetle/script/switch_cmd_pub.py
@@ -59,11 +59,13 @@
                     female_servo_handlers[index].sendTargetAngle(unlock_servo_angle_female)
             else:
                 if switch_type:
-                    male_servo_handlers[index].sendTargetAngle(lock_servo_angle_male)
                     female_servo_handlers[index].sendTargetAngle(lock_servo_angle_female)
+                    time.sleep(1.0)
+                    male_servo_handlers[index].sendTargetAngle(lock_servo_angle_male)
                 else:
-                    male_servo_handlers[index].sendTargetAngle(unlock_servo_angle_male)
                     female_servo_handlers[index].sendTargetAngle(unlock_servo_angle_female)
+                    time.sleep(1.0)
+                    male_servo_handlers[index].sendTargetAngle(unlock_servo_angle_male)
         else:
             if switch_type:
                 docking_msg.data = True