UGA-Innovation-Factory/UR10-Sentry
3
0
Fork 0
mirror of https://github.com/UGA-Innovation-Factory/UR10-Sentry.git synced 2025-12-19 08:56:11 +00:00
Code Issues Packages Projects Releases Wiki Activity

Fixed delay error on queue

Browse Source
This commit is contained in:
Tomás L
2024-07-23 12:33:20 -04:00
parent 0445a7354e
commit 91493bba22
4 changed files with 20 additions and 16 deletions
Download Patch File Download Diff File Expand all files Collapse all files

11
Robot/UR/URModbusServer.py
View File

@@ -42,7 +42,7 @@ class URModbusServer:
if packet is None:
time.sleep(0.5)
print("Modbus Error: retrying")
print("[TCP] Modbus Error: retrying")
return self.get_tcp_position()
else:
x = self._format(packet[9:11]) / 10
@@ -59,15 +59,16 @@ class URModbusServer:
:return: Readable angle values of each joint in radials
"""
if tries>10:
print("Modbus Error: Failed")
print("[Angles] Modbus Error: Failed")
return 0, 0, 0, 0, 0, 0
packet = self.modbusTCP.read_holding_registers(270, quantity=6)
time.sleep(0.001)
packet_signs = self.modbusTCP.read_holding_registers(320, quantity=6)
if (packet is None) or (packet_signs is None):
time.sleep(0.01)
print(f"Modbus Error #{tries}: retrying")
print(f"[Angles] Modbus Error #{tries}: retrying")
return self.get_joint_angles(tries+1)
else:
base = self._format_sign(packet[9:11], packet_signs[9:11])
@@ -89,14 +90,14 @@ class URModbusServer:
:return: Readable angle speeds of each joint in radians per second
"""
if tries>10:
print("Modbus Error: Failed")
print("[Speeds] Modbus Error: Failed")
return 0, 0, 0, 0, 0, 0
packet = self.modbusTCP.read_holding_registers(280, quantity=6)
if (packet is None):
time.sleep(0.01)
print(f"Modbus Error #{tries}: retrying")
print(f"[Speeds] Modbus Error #{tries}: retrying")
return self.get_joint_speeds(tries+1)
else:
base = self._format(packet[9:11]) / 1000