#include <Servo.h>

#define LED_RED 13//2
#define LED_GREEN  3
#define LED_BLUE  4

#define SERVO_PIN 6
#define SERVO_PIN1 7

String voice;

// Create a servo object
Servo servo1;
Servo servo2;

void RedOn() {
  digitalWrite (LED_RED, HIGH);
}

void GreenOn() {
  digitalWrite (LED_GREEN, HIGH);
}

void BlueOn() {
  digitalWrite (LED_BLUE, HIGH);
}

void allon() {
  digitalWrite (LED_RED, HIGH);
  digitalWrite (LED_GREEN, HIGH);
  digitalWrite (LED_BLUE, HIGH);
}

void alloff() {
  digitalWrite (LED_RED, LOW);
  digitalWrite (LED_GREEN, LOW);
  digitalWrite (LED_BLUE, LOW);
}

void servoLeft() {
  servo1.write(180);
  delay(100);
}

void servoRight() {
  servo1.write(0);
  delay(100);
}

void setup() {
  Serial.begin(9600);
  Serial.println("Working...");
  pinMode(LED_RED, OUTPUT);
  pinMode(LED_GREEN, OUTPUT);
  pinMode(LED_BLUE, OUTPUT);
  pinMode(8, OUTPUT);

  servo1.attach(SERVO_PIN);
  servo1.write(90);
  delay(10);
  servo2.attach(SERVO_PIN1);
  servo2.write(90);
  delay(10);
}

void loop() {
  while (Serial.available()) {
    delay(10);
    char c = Serial.read();
    if (c == '#')
    {
      break;
    }
    voice += c;
  }
  if (voice.length() > 0) {
    Serial.println(voice);
    if (voice == "on" || voice == "all")
    {
      allon();
      tone(8,100,1000);
    }
    else if (voice == "close" || voice == "all off")
    {
      alloff();
      tone(8,200,1000);
    }
    else if (voice == "red" || voice == "red on") {
      RedOn();
      tone(8,300,1000);
    }
    else if (voice == "green" || voice == "green on") {
      GreenOn();
      tone(8,400,1000);
    }
    else if (voice == "blue" || voice == "blue on") {
      BlueOn();
      tone(8,500,1000);
    }
    else if (voice == "left") {
      servoLeft();
      tone(8,600,1000);
    }
    else if (voice == "right") {
      servoRight();
      tone(8,700,1000);
    }
    else if (voice == "set45") {
      servo1.write(45);
      delay(100);
      tone(8,800,1000);
    }
    else if (voice == "set90") {
      servo1.write(90);
      delay(100);
      tone(8,900,1000);
    }
    else if (voice == "set135") {
      servo1.write(135);
      delay(100);
      tone(8,50,1000);
    }
    else if (voice == "tem") {
      servo2.write(135);
      delay(100);
      tone(8,1000,1000);
    }
    voice = "";
  }
}