Starting revamp of Furio&Cornelia

Revert "do not initialize LEDs"

This reverts commit a4be313e96.
pull/1/head
emamaker 2022-05-16 20:12:44 +02:00
parent 788684ef0a
commit 33466b9a34
2 changed files with 11 additions and 4 deletions

View File

@ -13,6 +13,10 @@
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_SX 39
#define SWITCH_DX 38

View File

@ -2,9 +2,12 @@
#include "sensors/sensors.h"
void initSensors(){
pinMode(SWITCH_DX, INPUT);
pinMode(SWITCH_SX, INPUT);
pinMode(SWITCH_ID, INPUT);
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));
// tone(BUZZER, 270, 250);