修正震动点不动的bug
This commit is contained in:
18
CU/Catch.py
18
CU/Catch.py
@ -65,19 +65,19 @@ class Catch:
|
||||
self.drop_continue.SetReset()
|
||||
|
||||
if self.catch_status == CatchStatus.CShake: # 1500
|
||||
self.shake_Q = not self.shake_Q # 10
|
||||
# self.robotClient.sendIOControl(self.robotClient.con_ios[2], 1 if self.shake_Q else 0)
|
||||
self.shake_Q = not self.shake_Q # 10
|
||||
if not self.shake_continue.Q(True, 600):
|
||||
if self.shake_Q:
|
||||
open(0, 0, 1)
|
||||
else:
|
||||
close(0, 0, 1)
|
||||
# else:
|
||||
# self.shake_continue.SetReset()
|
||||
# self.catch_status = CatchStatus.COk
|
||||
# #if Constant.Debug or self.robotClient.check_outputQ(self.robotClient.con_ios[2]):
|
||||
# # self.robotClient.sendIOControl(self.robotClient.con_ios[2], 0)
|
||||
# close(0, 0, 1)
|
||||
# print("震动结束")
|
||||
else:
|
||||
self.shake_continue.SetReset()
|
||||
self.catch_status = CatchStatus.COk
|
||||
#if Constant.Debug or self.robotClient.check_outputQ(self.robotClient.con_ios[2]):
|
||||
# self.robotClient.sendIOControl(self.robotClient.con_ios[2], 0)
|
||||
close(0, 0, 1)
|
||||
print("震动结束")
|
||||
|
||||
if self.catch_status == CatchStatus.COk :
|
||||
# self.robotClient.sendIOControl(self.robotClient.con_ios[1], 0,emptyList='1')
|
||||
|
||||
Reference in New Issue
Block a user