   // Initialize speaker
   pinMode(SPEAKER_PIN, OUTPUT);
   
+  
+  rgbLED(255, 0, 0);
   beep(50);
+  rgbLED(0, 255, 0);
   beep(50);
+  rgbLED(0, 0, 255);
   beep(50);
 
   Serial.println("Setup complete");

#include <Servo.h>

int LED_PIN = 13;
int SERVO_PIN = 9;
int BUTTON_PIN = 8;
int SPEAKER_PIN = 6;

Servo servo;
int servo_pos = 90;

    if (servo_state != 0) {
      Serial.println("Servo disabled");
      digitalWrite(LED_PIN, LOW);
      rgbLED(255, 0, 0);
      beep(50);
      servo_state = 0;
    } 
    else {
      Serial.println("Servo enabled");
      digitalWrite(LED_PIN, HIGH);
      rgbLED(0, 255, 0);
      beep(50);
      servo_state = 1;
    }

    while (digitalRead(BUTTON_PIN) == HIGH);
  }
}

void rgbLED(int red, int green, int blue) {
  analogWrite(RED_LED_PIN, red);
  analogWrite(GREEN_LED_PIN, green);
  analogWrite(BLUE_LED_PIN, blue);  
}

void beep(unsigned char delayms) {
