 
 #define colorPin 2
 #define jumperPin 3
-#define enemyLedPin 5
+
+#define enemyLedPin 13
+#define greenLedPin 7
+#define yellowLedPin 6
 
 #define starterServoPin 19
 

  // Serial
  Serial.begin(9600);

  if (isGreen()) {
    digitalWrite(13, LOW);
  } else {
    digitalWrite(13, HIGH);
  }
}

void loop() {

  pinMode(colorPin, INPUT);

  // Debug led
  pinMode(enemyLedPin, OUTPUT);
  pinMode(6, OUTPUT);
  pinMode(7, OUTPUT);
  digitalWrite(6, HIGH);
  digitalWrite(7, HIGH);

  // Jumper
  pinMode(jumperPin, INPUT);
