looking at past days' work

include/vars.h

@@ -1,5 +1,5 @@
 #pragma once
-#define DEBUG Serial3
+#define DEBUG Serial
 
 #define GLOBAL_SPD_MULT 1.0
 

src/main.cpp

@@ -1,5 +1,6 @@
 #include <Arduino.h>
 
+#include "test_menu.h"
 #include "behaviour_control/status_vector.h"
 #include "position/positionsys_zone.h"
 #include "sensors/sensors.h"
@@ -19,10 +20,12 @@ void setup() {
 
 void loop() {
   updateSensors();
-
+/*   TestMenu testmenu;
+  testmenu.testMenu();
   goalie->play(role==1);
   keeper->play(role==0);
-
+ */
+drive->m1->test();
   // Last thing to do: movement and update status vector
   drive->drivePrepared();  
   updateStatusVector();

src/motors_movement/motor.cpp

@@ -41,9 +41,9 @@ void Motor::test(){
     digitalWrite(pinA, 1);
     digitalWrite(pinB, 0);
     analogWrite(pinPwm, 255);
-    delay(150);
+    delay(1500);
     digitalWrite(pinA, 0);
     digitalWrite(pinB, 1);
     analogWrite(pinPwm, 255);
-    delay(150);
+    delay(1500);
 }

src/test_menu.cpp

@@ -83,6 +83,7 @@ void TestMenu :: testMenu(){
             break;
             case '7':
             case '8':
+            if(DEBUG.available() == 0){
                 DEBUG.println("To do Line Sensors test, decide the role first");
                 DEBUG.println("1)Keeper");
                 DEBUG.println("2)Goalie");
@@ -98,6 +99,7 @@ void TestMenu :: testMenu(){
                         DEBUG.println("INVALID ROLE");
                     break;
                     }
+                }
             break;
             default:
             break;