// Arduino Water Board
// pkvi
#include <Servo.h>
Servo spigot;
Servo rightarm;
// Servo Position
int spigpos = 45;
int armpos = 15;
// Resting State
float lieset = 0;
int lierec = 0;
int lietotal = 0;
int lieavg = 0;
int lienew = 0;
// Variance
int spvar = 20;
int liepin = A0;
// Valve
int valve = 8;
// LEDs
int blue = 13;
int green = 12;
int red = 11;
void setup() {
  spigot.attach(9); // Spigot
  rightarm.attach(10); // Rag Arm
  pinMode(valve, OUTPUT);
  pinMode(blue, OUTPUT);
  pinMode(green, OUTPUT);
  pinMode(red, OUTPUT);
  Serial.begin(9600);
  // Reset Position
  spigot.write(45);
  delay(1500);
  rightarm.write(15);
  digitalWrite(valve, LOW);
  // Obtain Resting State -- Calibration
  for (int x = 0; x < 100; x++) {
    lieavg = analogRead(liepin);
    lietotal = lietotal + lieavg;
  }
  lieset = round(lietotal / 100);
}
void loop() {
  Serial.println(analogRead(liepin));
  digitalWrite(red, LOW);
  digitalWrite(green, LOW);
  digitalWrite(blue, HIGH);
  // Jacob Communication
  if (Serial.available()) {
    char ser = Serial.read();
    switch (ser) {
      case '1':
        detect();
        break;
    }
  }
  delay(20);
}
void detect() {
  // Query GV Response
  for (int x = 0; x < 50; x++) {
    lieavg = analogRead(liepin);
    lietotal = lietotal + lieavg;
    Serial.println(analogRead(liepin));
    delay(2);
  }
  lienew = round(lietotal / 50);
  // Lie or Truth?
  // Jacob Polls Serial Response
  if (lienew + spvar > lieset || lienew - spvar > lieset) {
    Serial.println("Lie");
    torture();
  }
  else if (lieset > lienew + spvar || lieset > lienew - spvar) {
    Serial.println("Truth");
    truth();
  }
  else {
    Serial.println("Unclear")
    detect();
  }
}
void torture() {
  digitalWrite(red, HIGH);
  digitalWrite(green, LOW);
  digitalWrite(blue, LOW);
  for (armpos = 15; armpos <= 85; armpos += 1) {
    rightarm.write(armpos);
    delay(15);
  }
  for (spigpos = 45; spigpos <= 90; spigpos += 1) {
    spigot.write(spigpos);
    delay(15);
  }
  delay(1500);
  digitalWrite(valve, HIGH);
  delay(10000);
  digitalWrite(valve, LOW);
  spigot.write(45);
  delay(1500);
  rightarm.write(15);
}
void truth() {
  digitalWrite(red, LOW);
  digitalWrite(green, HIGH);
  digitalWrite(blue, LOW);
}