diff --git a/src/omnibot_client/Dummybot.py b/src/omnibot_client/Dummybot.py index e19785409d97af8d717ebd0afcd43d664c97cd33..b87a5f95db62eabd6b74d108eeab87b49ae5816b 100644 --- a/src/omnibot_client/Dummybot.py +++ b/src/omnibot_client/Dummybot.py @@ -16,12 +16,24 @@ def run_dummybot(HOST,verbose=True): with OmniBot(HOST,verbose=verbose) as bot: print("Connected") - while time() < tstart + 5: + # Target speed for servos + vset = 100 + + # Go one way + while time() < tstart + 3: t0 = time() - bot.set_speed([]) - - + bot.set_speeds([vset,vset,vset]) + + print('x:'+bot.get_x()) + print('y:'+bot.get_y()) + + # Go the other way + while time() < tstart + 6: + t0 = time() + + bot.set_speeds([-vset,-vset,-vset]) + print('x:'+bot.get_x()) print('y:'+bot.get_y())