xiongyi/AutoControlSystem-git
1
0
Fork 0
Code Issues Pull Requests Actions Packages Projects Releases Wiki Activity

修改钢针到达抓料点位后再收缩和在震动点不走的问题

Browse Source
This commit is contained in:
cdeyw
2025-02-26 12:29:23 +08:00
parent 0e69647b11
commit ef50aed6bb
7 changed files with 9567 additions and 3801 deletions
Download Patch File Download Diff File Expand all files Collapse all files

19
CU/Catch.py
View File

@ -36,7 +36,7 @@ class Catch:
# 本身IO
##self.robotClient.sendIOControl(self.robotClient.con_ios[0],1)
# 网络继电器
open(1, 0, 0)
close(1, 0, 0)
self.is_send_take_command = True
if self.catch_status == CatchStatus.CDrop:
@ -45,15 +45,16 @@ class Catch:
# self.robotClient.sendIOControl(self.robotClient.con_ios[0], 0)
# 网络继电器
close(1, 0, 0)
time.sleep(1)
for _ in range(self.drop_count):
# self.robotClient.sendIOControl(self.robotClient.con_ios[1], 1, delay=self.robotClient.time_delay_put)
open(0, 1, 0)
open(0, 0, 1)
time.sleep(self.robotClient.time_delay_put) # 会造成这个时间点 其他命令插入不进去 需要另开线程
close(0, 1, 0)
close(0, 0, 1)
# self.robotClient.sendIOControl(self.robotClient.con_ios[1], 0)
# self.robotClient.sendIOControl(self.robotClient.con_ios[1], 1)
open(0, 1, 0)
close(0, 0, 1)
self.is_send_command = True
if self.drop_continue.Q(True,self.robotClient.time_delay_put*1000*self.drop_count):
# if Constant.Debug or self.robotClient.check_outputQ(self.robotClient.con_ios[1]) and not self.robotClient.check_outputQ(self.robotClient.con_ios[0]):
@ -63,23 +64,25 @@ class Catch:
if self.catch_status == CatchStatus.CShake: # 1500
self.shake_Q = not self.shake_Q # 10
if not self.shake_continue.Q(True, 600):
if not self.shake_continue.Q(True, 4000):
if self.shake_Q:
open(0, 0, 1)
open(0, 1, 0)
else:
close(0, 0, 1)
close(0, 1, 0)
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)
close(0, 1, 0)
print("震动结束")
if self.catch_status == CatchStatus.COk :
# self.robotClient.sendIOControl(self.robotClient.con_ios[1], 0,emptyList='1')
open(1,0,0)
close(0, 1, 0)
close(0, 0, 1)
self.is_send_take_command = False
pass