diff --git a/include/vars.h b/include/vars.h index 55cf324..0bb05e7 100755 --- a/include/vars.h +++ b/include/vars.h @@ -13,10 +13,6 @@ the new setup is the one commented, leds have to be written in the 32U4 code*/ -#define LED_R 20 -#define LED_Y 17 -#define LED_G 13 - #define BUZZER 6 #define SWITCH_1 39 #define SWITCH_2 38 diff --git a/src/sensors/sensors.cpp b/src/sensors/sensors.cpp index 2deba21..e7bfa1c 100644 --- a/src/sensors/sensors.cpp +++ b/src/sensors/sensors.cpp @@ -4,11 +4,7 @@ void initSensors(){ pinMode(SWITCH_1, INPUT); pinMode(SWITCH_2, INPUT); - - pinMode(LED_R, OUTPUT); - pinMode(LED_Y, OUTPUT); - pinMode(LED_G, OUTPUT); - + drive = new DriveController(new Motor(12, 11, 4, 55), new Motor(25, 24, 5, 135), new Motor(27, 26, 2, 225), new Motor(29, 28, 3, 305)); //drive = new DriveController(new Motor(12, 11, 2, 45),new Motor(25, 24, 5, 135), new Motor(27, 26, 6, 225), new Motor(21, 22, 23, 315)); compass = new DataSourceBNO055();