/*
Sensor Game
=====================
Simon Harchun, Samantha Kafri, Emmanuel Lalande
*/

// vars for holding analog sensors values
int val1 = 0;
int val2 = 0;
int val3 = 0;
int val4 = 0;
// flags used to activate LEDs/motors
boolean trig1 = false;
boolean trig2 = false;
boolean trig3 = false;
boolean trig4 = false;
// "sensitivity" variable (sensors trigger below this value)
int sens = 10;

void setup()             
{
  // set output pins
  pinMode(3, OUTPUT);
  pinMode(4, OUTPUT);
  pinMode(5, OUTPUT);
  pinMode(6, OUTPUT);
  pinMode(7, OUTPUT);
  pinMode(8, OUTPUT);
  
  // will get serial data
  Serial.begin(9600);
}

void loop()      
{
  // get the values of all sensors
  val1 = analogRead(0);
  val2 = analogRead(1);
  val3 = analogRead(2);
  val4 = analogRead(3);

  // activate outputs according to flags
  
  if (trig1)  // Win LED 1
    digitalWrite(3, HIGH);
  else
    digitalWrite(3, LOW);

  if (trig2)  // Motor 1
    digitalWrite(4, HIGH);
  else
    digitalWrite(4, LOW);

  if (trig3)  // Motor 2
    digitalWrite(5, HIGH);
  else
    digitalWrite(5, LOW);

  if (trig4)  // Win LED 2
    digitalWrite(6, HIGH);
  else 
    digitalWrite(6, LOW);


  // set flags according to sensor values
  
  if (val1 < sens) {  // Win LED 1
    if (trig2 == true) {  // only if Motor 1 is active
      trig1 = true;  // led on
      trig2 = false;  // motor off
    }
  }

  if (val2 < sens) {  // Motor 1
    if (trig1 == false && trig4 == false) {  // only if nobody has won yet
      trig2 = true;  // this motor on
      trig3 = false; // other motor off
    }
  }

  if (val3 < sens) {  // Motor 2
    if (trig1 == false && trig4 == false) {  // only if nobody has won yet
      trig3 = true;  // this motor on
      trig2 = false; // other motor off
    }
  }

  if (val4 < sens) {  // Win LED 2
    if (trig3 == true) {  // only if Motor 2 is active
      trig4 = true;  // led on
      trig3 = false;  // motor off
    }
  }

  // print sensor values (for debugging)
  Serial.println(val1);
  Serial.println(val2);
  Serial.println(val3);
  Serial.println(val4);
  Serial.println("=========");
  //delay(500);

}