#include <Servo.h>

#define WATER_POWER 9
#define WATER_TEMP 10

String voice;

// Create a servo object
Servo power, temp;
int p=0,t=90;

void PowerUp() {
  if(p<=135){
    p=p+45;
    power.write(p);
  }
  Serial.println(p);
}

void PowerDown(){
  if (p>=45){
    p=p-45;
    power.write(p);
  }
  Serial.println(p);
}

void TempUp() {
  if (t<=135){
    t=t+45;
    temp.write(t);
  }
  Serial.println(t);
}

void TempDown(){
  if (t>=5){
    t=t-5;
    temp.write(t);
  }
  Serial.println(t);
}

void Comfort(){
  p=120;
  t=160;
  power.write(p);
  temp.write(t);
   Serial.print("Power =  ");
   Serial.println(p);
   Serial.print("Temperature =  ");
   Serial.println(t);
}

void setup() {
  Serial.begin(9600);
  Serial.println("Working...");
  power.attach(WATER_POWER);
  power.write(p);
  temp.attach(WATER_TEMP);
  temp.write(t);


  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 == "UP")
    {
      PowerUp();
    }
    else if (voice == "DOWN")
    {
      PowerDown();
    }
    else if (voice == "RIGHT") {
      TempUp();
    }
    else if (voice == "LEFT") {
      TempDown();
    }
    else if (voice == "FAR") {
    }
    else if (voice == "NEAR") {
      Comfort();
    }
    else if (voice == "NONE") {
    }
    voice = "";
  }
}