welterde/shittyrobot
1
0
Fork 0
Code Issues Pull requests Projects Releases Packages Wiki Activity Actions

debug print statements optional

Browse source
This commit is contained in:
Tassilo Schweyer 2025-12-29 01:20:21 +01:00
parent e6daa24561
commit a7c3d5f84d
1 changed files with 17 additions and 9 deletions
Download patch file Download diff file Expand all files Collapse all files

24
shittyrobot.py
View file

@ -61,21 +61,28 @@ do_ap()
s = setup_listener()
c = []
debug = False
def controlloop(last_start, next_action):
now = time.ticks_us()
print('CTRL: ', last_start, next_action)
if debug:
print('CTRL: ', last_start, next_action)
if time.ticks_diff(now, time.ticks_add(last_start, 100000)) < 0:
print(' DEADTIME -> ignore')
return last_start
if debug:
print(' DEADTIME -> ignore')
return last_start
if next_action is None and time.ticks_diff(time.ticks_add(last_start, 601000), now) > 0:
print(' ACTION TIMED OUT -> stopping')
next_action = (0,0)
if debug:
print(' ACTION TIMED OUT -> stopping')
next_action = (0,0)
elif next_action is None:
return last_start
return last_start
print('Starting action: ', next_action)
if debug:
print('Starting action: ', next_action)
if next_action[0] == 1:
MOTOR_A0.on()
@ -134,7 +141,8 @@ def mainloop(l):
a = None
try:
a = y.read(1)
print('RCV: ', a)
if debug:
print('RCV: ', a)
y.write(a)
except OSError:
# timeout