 #define SERIALDEV Serial
 #endif
 
+#define START_BUTTON_DEBOUNCE_TIME_MS        250
+
 #define TEENSY_LED          13
+#define START_BUTTON        14
+
 #define IR_LEFT             A9
 #define IR_RIGHT            A8
 #define IR_FRONT_LEFT       A7

Servo drivingservo;

bool m_automatic = false;

uint32_t last_time = 0;

MCDriver driver;


	analogReadResolution(10);
	pinMode(TEENSY_LED, OUTPUT);

	pinMode(START_BUTTON, INPUT_PULLUP);
	attachInterrupt(START_BUTTON, button_service, FALLING);

	telemetry.header = BC_TELEMETRY;
}

void button_service() {
	if (m_button_active) {
		m_button_press = true;
		m_button_active = false;
		m_last_button_time = millis();
	}
}

void toggle_led() {
