main: basic main loop

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();
 }