From 0f913d8ad12f3a377d728978ccfda5a50b91dbe4 Mon Sep 17 00:00:00 2001
From: "ema.coletta@gmail.com" <emamaker0@gmail.com>
Date: Thu, 29 Oct 2020 17:19:20 +0100
Subject: [PATCH] implement test menu in main loop

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

diff --git a/src/main.cpp b/src/main.cpp
index 4ff75dc..cd37a1e 100755
--- a/src/main.cpp
+++ b/src/main.cpp
@@ -7,6 +7,9 @@
 #include "sensors/sensors.h"
 #include "strategy_roles/games.h"
 #include "vars.h"
+#include "test_menu.h"
+
+TestMenu* testmenu;
 
 void setup() {
   delay(1500);
@@ -17,6 +20,7 @@ void setup() {
       cosins[i] =  (float) cos((i*3.14/180));
   }
 
+  testmenu = new TestMenu();
   initStatusVector();
   initSensors();
   initGames();
@@ -27,8 +31,8 @@ void setup() {
 
 void loop() {
   updateSensors();
-  //TestMenu testmenu;
-  //testmenu.testMenu();
+  if(DEBUG.available()) testmenu->testMenu();
+  
   goalie->play(role==1);
   keeper->play(role==0);