From 43777e4ccdbcc276edcfd6df408b935ade45b373 Mon Sep 17 00:00:00 2001
From: emamaker <emamaker0@gmail.com>
Date: Mon, 16 May 2022 22:47:48 +0200
Subject: [PATCH] main: basic main loop

---
 src/main.cpp | 16 ++--------------
 1 file changed, 2 insertions(+), 14 deletions(-)

diff --git a/src/main.cpp b/src/main.cpp
index 108ca10..ca62f3a 100755
--- a/src/main.cpp
+++ b/src/main.cpp
@@ -47,22 +47,10 @@ void setup() {
 
 void loop() {
   updateSensors();
-
   drive->resetDrive();
-  
-  // striker_condition = role == HIGH || ((Keeper*)keeper)->shouldStrike;
-  // keeper_condition = role == LOW;
-
-  // if(robot_indentifier){
-  //   tc3_2->play(role);
-  //   tc3_1->play(!role);
-
-  //   // Last thing to do: movement and update status vector
-  //   drive->drivePrepared();  
-  // }else{
-  //   drive->stopAll();
-  // }
 
   testmenu->testMenu();
+  
+  drive->drivePrepared();
   updateStatusVector();
 }
\ No newline at end of file