#include "all-headers.h"

static void setupIO (INIT_MODE) {
	pinMode (L0_LED, DigitalMode::OUTPUT);
	pinMode (L1_LED, DigitalMode::OUTPUT);
	pinMode (L2_LED, DigitalMode::OUTPUT);
	pinMode (L3_LED, DigitalMode::OUTPUT);
	pinMode (L4_LED, DigitalMode::OUTPUT);
	pinMode (TEENSY_LED, DigitalMode::OUTPUT);

	pinMode (P0_PUSH_BUTTON, DigitalMode::INPUT_PULLUP);
	pinMode (P1_PUSH_BUTTON, DigitalMode::INPUT_PULLUP);
	pinMode (P2_PUSH_BUTTON, DigitalMode::INPUT_PULLUP);
	pinMode (P3_PUSH_BUTTON, DigitalMode::INPUT_PULLUP);
	pinMode (P4_PUSH_BUTTON, DigitalMode::INPUT_PULLUP);

	// Start teensy led
	digitalWrite (TEENSY_LED, true);
}

MACRO_INIT_ROUTINE (setupIO);