/*For six targets with 0,1,2 on one shaft, and 3,4,5 on the other with 0 and 3 
in the same position, 1 and 4 in the same postion and 2 and 5 in ths same position.

*/

#include <Servo.h>

int n;//first random number
int m;//second random number
int threshold=30;
int targets=6;
int score=0;//initialized to 0
int time=3000;//time to hit target once it pops up
int TIME=60000;//total time for game==1 minute--and yes 60000 fits into an int
int TIME_Played=0;//initialize time played

Servo servo0;//servo names
Servo servo1;
Servo servo2;
Servo servo3;
Servo servo4;
Servo servo5;

int anodePin=4;//all led's use this pin for their long leg

int cathodePin0=14;//A0
int cathodePin1=15;//A1
int cathodePin2=16;//A2
int cathodePin3=17;//A3
int cathodePin4=18;//A4
int cathodePin5=19;//A5

int delaysn=0;  //starts all delays at 0
int delaysm=0;

int tworandom(int i);//random funcition generator for second number
int initialize(int servonum);//sets initial servo positons
int moves(int servonum);//pops up servos
int reads(int led);//read led
int readsavg(int n, int led);//takes average of n readings for led
int reset(int servonum);//initialize current servo, reset delay of current servo, assign a new serov to n or m
int scores(int servonum);//score when you shoot (shooting aliens==++)
int scored(int servonum);//score when you don't shoot (don't shoot humans==++)

void setup()
{
  
  //deactivates pullup resistors
  _SFR_IO8(0x35) |= 4;
  _SFR_IO8(0x35) |= (1<<4); 
  
  randomSeed(analogRead(0));//select start point of random number chain before setting pin A0 to output--reading analog should allow for random start in chain--wiring led to there may get rid of random start--will just cause every game to be the same--will change for final design, but for this week it would not be a problem
  n=random(targets);  //choose first random number
  m=tworandom(n);  //choose second random number based off of the first
  
  
  pinMode(anodePin, OUTPUT);  //set pins associated with led light sensors to outputs
  pinMode(cathodePin0, OUTPUT);
  pinMode(cathodePin1, OUTPUT);
  pinMode(cathodePin2, OUTPUT);
  pinMode(cathodePin3, OUTPUT);
  pinMode(cathodePin4, OUTPUT);
  pinMode(cathodePin5, OUTPUT);
  
  digitalWrite(anodePin, HIGH);
  digitalWrite(cathodePin0,LOW);
  digitalWrite(cathodePin1,LOW);
  digitalWrite(cathodePin2,LOW);
  digitalWrite(cathodePin3,LOW);
  digitalWrite(cathodePin4,LOW);
  digitalWrite(cathodePin5,LOW);
  
  servo0.attach(3);  //use all of the pwms pins
  servo1.attach(5);
  servo2.attach(6);
  servo3.attach(9);
  servo4.attach(10);
  servo5.attach(11);
  
  servo0.write(90);  //initialize servo positons
  servo1.write(90);
  servo2.write(90);
  servo3.write(90);
  servo4.write(90);
  servo5.write(90);
  
  Serial.begin(9600);//set up serial communication to monitor
}

void loop(){
  Serial.print("n and m are ");
  Serial.print(n);
  Serial.println(m);//*/
  moves(m);//pop up the first two servos
  moves(n);
  int number=3;//number of times led is read
  //all delays initialized at 0 or reset to 0 in "reset"
  delaysm=delaysm+(2*number*50);//each read delays 50 so n times 50 is full delay
  delaysn=delaysn+(2*number*50);
  //read sensors
  int i = readsavg(number, (n+14));//servo will be 0 to 5 but led is 14 to 19
  int j = readsavg(number, (m+14));
  /*Serial.print("i and j are");
  Serial.print(i );
  Serial.println(j);//*/
  if((i<threshold)&&(i>0)){
    //you hit target n
    Serial.println("You hit n");
    scores(n);
    int sameasbeforen=n;
    while(n==sameasbeforen){
      n=reset(n,m);
    }
    /*delaysn=0;
    initialize(n);
    n=tworandom(m);//*/
  }
  if((j<threshold)&&(j>0)){
    Serial.println("You hit m");
    //you hit target m
    scores(m);
    /*delaysm=0;
    initialize(m);
    m=tworandom(n);*/
    while(m==sameasbeforem){
      m=reset(m,n);
    }
  }
  if((delaysn>time)&&(delaysm>time)){
    //Serial.println("ran out of time 0");
    /*delaysn=0;
    delaysm=0;
    initialize(m);
    initialize(n);
    n=random(targets);  //choose first random number
    m=tworandom(n);  //choose second random number based off of the first*/
    int sameasbeforen=n;
    while(n==sameasbeforen){
      n=reset(n,m);
    }
    int sameasbeforem=m;
    while(m==sameasbeforem){
      m=reset(m,n);
    }
  }
  if(delaysn>time){
    //Serial.println("ran out of time 1");
    //you ran out of time for target n
    scored(n);
    /*delaysn=0;
    initialize(n);
    n=tworandom(m);//*/
    int sameasbeforen=n;
    while(n==sameasbeforen){
      n=reset(n,m);
    }
  }
  if(delaysm>time){
    //Serial.println("ran out of time 2");
    //you ran out of time for target m
    scored(m);
    /*delaysm=0;
    initialize(m);
    m=tworandom(n);*/
    int sameasbeforem=m;
    while(m==sameasbeforem){
      m=reset(m,n);
    }
  }
  TIME_Played=TIME_Played+(2*number*50);
  if(TIME_Played<TIME){
    Serial.print("Game over.  Your score is");
    Serial.print(score);
    while(1){
      
    }
  }
}
//////////////////////
//////////////////////////////////////////////////////
//////////////////////////////////////////////////////
///////////////////////////////////////////////////////
int tworandom(int i){
  //chooses second random number that is not the same as the fist or equal to that of its pair
  int k=0;
  k=random(targets);//not redundant--if i is not in the first position setting m to 0 at first would cause it to be 0 almost always
  while(((k-3)==i)||(k==i)||((k+3)==i)){
    k=random(targets);
  }
  return k;
}

int initialize(int servonum){
  //set all servos to an inital 90 degrees.  Allows for rotation in either direction of 90 degrees
  if(servonum==0){
    servo0.write(90);
  }
  if(servonum==1){
    servo1.write(90);
  }
  if(servonum==2){
    servo2.write(90);
  }
  if(servonum==3){
    servo3.write(90);
  }
  if(servonum==4){
    servo4.write(90);
  }
  if(servonum==5){
    servo5.write(90);
  }
  delay(150);
}

int moves(int servonum){
  //moves servo to the popped up positon--all move same way because we can just flip the servo
  if(servonum==0){
    servo0.write(0);
  }
  if(servonum==1){
    servo1.write(0);
  }
  if(servonum==2){
    servo2.write(0);
  }
  if(servonum==3){
    servo3.write(0);
  }
  if(servonum==4){
    servo4.write(0);
  }
  if(servonum==5){
    servo5.write(0);
  }
  delay(150);
}

int reads(int led){
  int val = 0;
  int vcc=anodePin;
  int ground=led;
  
  //already emitting light
  
  delay(50);
  
  //switch potentials -- charge LED to -5V
  digitalWrite(vcc,   LOW);
  digitalWrite(ground, HIGH);
  
  //measure time for potential to equalize (for cathode to be LOW)
  
  //switch pinmode 
  pinMode(ground,  INPUT);
  
  //measure time it takes for cathodePin to go to zero
  //this value probably depends on the chip clock or something
  while(digitalRead(ground) != 0){
    delay(1);
    val++;      
  }
  pinMode(ground,  OUTPUT);
  
  digitalWrite(vcc,   HIGH);
  digitalWrite(ground, LOW);
  //Serial.println(val, DEC);
  return val;
}

int readsavg(int n, int led){
  int val=0;
  for(int i=0; i<n; i++){
    val=val+reads(led);//read n times and sum
  }
  val=val/n;//divide by n for average
  return val;
}
  
int reset(int servonum1, int servonum2){
  if(servonum1==m){
    initialize(m);//lower servo m
    delaysm=0;//reset delay before setting new m
    int j=tworandom(servonum2);//choose new m based on n
    /*Serial.print("the new m is");
    Serial.println(m);
    Serial.print("the old n was");
    Serial.println(servonum2);//*/
    return j;
  }
  if(servonum1==n){
    initialize(n);//lower servo n
    delaysn=0;//reset delay before setting new n
    int j=tworandom(servonum2);//choose new n based on m
    /*Serial.print("the new n is");
    Serial.println(n);
    Serial.print("the old m was");
    Serial.println(servonum2);//*/
    return j;
  }
}  

int scores(int servonum){
  //scores==score when shot
  if((servonum==0)||(servonum==1)||(servonum==2)){
    //servos 0, 1, 2 are humans
    score--;//don't shoot humans 
  }
  if((servonum==3)||(servonum==4)||(servonum==5)){
    //servos 3, 4, 5 are aliens
    score++;//do shoot aliens
  }
}
int scored(int servonum){
  //scored==scored when did not shoot
  if((servonum==0)||(servonum==1)||(servonum==2)){
    //servos 0, 1, 2 are humans
    score++;//good you did not shoot the humans
  }
  if((servonum==3)||(servonum==4)||(servonum==5)){
    //servos 3, 4, 5 are aliens
    score--;//baka, you forgot to shoot the aliens--have you seen Independence Day?
  }
}