From 53fa1fec233cda688e27b091fbe81977386023f8 Mon Sep 17 00:00:00 2001
From: Felix Agner <felix.agner@control.lth.se>
Date: Tue, 1 Nov 2022 11:36:20 +0100
Subject: [PATCH] completed the dummybot example

---
 src/omnibot_client/Dummybot.py | 20 ++++++++++++++++----
 1 file changed, 16 insertions(+), 4 deletions(-)

diff --git a/src/omnibot_client/Dummybot.py b/src/omnibot_client/Dummybot.py
index e197854..b87a5f9 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())
 
-- 
GitLab