   sound.tag = 'A';  // for Audio
   midi.tag = 'M';
 
-  led_state = false;
   interrupts();
 }
 
 void setup() {
-  pinMode(LED_PIN_RED, OUTPUT);
-  pinMode(LED_PIN_GREEN, OUTPUT);
+    // LEDs
+  pinMode(DEBUG_LED1, OUTPUT);
   pinMode(DEBUG_LED2, OUTPUT);
   pinMode(LED_PIN_INT, OUTPUT);
 
-  pinMode(TOUCH_PIN_A, OUTPUT);
-  pinMode(TOUCH_PIN_B, OUTPUT);
-
-  pinMode(PD_LASER_PIN, INPUT_PULLUP);
+  // Sensors
   pinMode(PD_SCREEN_PIN, INPUT);
   pinMode(G_PIN, INPUT);
-
+  pinMode(PD_LASER_PIN, INPUT_PULLUP);
   attachInterrupt(PD_LASER_PIN, irq_laser, CHANGE);
 
-  // Turn on the red LED, will be turned off once time is synced
-  led_state = HIGH;
+  Serial.begin(115200);
+  serial_over_midi = false;
+  init_vars();
+
+  led_state = HIGH;  // Turn on all LEDs on startup
   digitalWrite(LED_PIN_INT, led_state);
-  // digitalWrite(LED_PIN_RED, HIGH);
-  Serial.begin(115200);
-
-  serial_over_midi = false;
-
-  init_vars();
+  digitalWrite(DEBUG_LED1, HIGH);
+  digitalWrite(DEBUG_LED2, HIGH);
 }
 
 

#define MIDI_SYSEX_BEGIN '\xF0'
#define MIDI_SYSEX_END '\xF7'

// On Teensy LC probably need to use the high current pins
// for most LEDs.
#define LED_PIN_GREEN 16
#define LED_PIN_RED 17
#define DEBUG_LED2 21

// Pins for the relay based touch probes, collide with LEDs above
#define TOUCH_PIN_A 16
#define TOUCH_PIN_B 17

// An pins below are the same on Teeny LC and 3.1
#define LED_PIN_INT 13
#define PD_LASER_PIN 14
#define PD_SCREEN_PIN 20 // Same as A6
#define G_PIN 15 // Same as A1
#define AUDIO_PIN 22 // Same as A8
#define MIC_PIN 23 // Same as A9

// Threshold and hysteresis for screen on/off reading
#define SCREEN_THRESH_HIGH  110

    init_clock();
    clock.is_synced = true;
    interrupts();
    led_state = LOW;
    digitalWrite(DEBUG_LED1, LOW);
    digitalWrite(DEBUG_LED2, LOW);
    send_ack(CMD_SYNC_ZERO);
  } else if (cmd == CMD_TIME_NOW) {
    send("t ");
