/*
 * Matrix - Dokumentation
 *   13 schaltet Reihe 1
 *   12 schaltet Reihe 2
 *   11 schaltet Reihe 3
 *   10 schaltet Reihe 4
 *   9 schaltet Spalte 1
 *   8 schaltet Spalte 2
 *   7 schaltet Spalte 3
 *   6 schaltet Spalte 4
*/

//Key Matrix
int button[16] = {1022, 697, 527, 424, 510, 413, 347, 299, 340, 293, 258, 231, 254, 227, 208, 188};
int keyInput = A0;
int offset = 2;

//Random Generator
int randomInput = A1;

//Interrupt-"Switch"
volatile bool keyCalibrateSwitch = false;

struct Node;

struct Node {
  int value;
  struct Node *next;
};

void clearList(struct Node *head) {
  struct Node *current = head;
  struct Node *previous = NULL;

  bool stop = false;
  while(!stop) {
	if(current->next != NULL) {
	  previous = current;
	  current = current->next;
	}
	else {
	  if(previous != NULL) {
		previous->next = NULL;
		previous = NULL;
	  }
	  else {
		stop = true;
	  }

	  free(current);
	}
  }
}

void switchKeyBool() {
  keyCalibrateSwitch = true;
}

void setup() {
  Serial.begin(9600);
  pinMode(keyInput, INPUT);

  pinMode(3, INPUT);
  digitalWrite(3, HIGH);
  attachInterrupt(digitalPinToInterrupt(2), switchKeyBool, FALLING);
  
  DDRB = B111111;
  DDRD = B11100000;
  for(int i = 0; i < 3; i++){
	setMatrixLights(17);
	delay(250);
	setMatrixLights(0);
	delay(250);
  }
  //keyCalibrate();
}

void loop() {
  bool stop = false;
  Serial.print("KeyCalibrateSwitch: ");
  Serial.println(keyCalibrateSwitch);
  if(keyCalibrateSwitch == true){
	keyCalibrateSwitch == false;
	keyCalibrate();
	getKeyValue();
  }
  while(!stop) {
	for(int i = 1; i <= 16; ++i) {
	  setMatrixLights(i);
	  delay(100);
	  int value = analogRead(keyInput);
	  for(int i = 0; i < 16; ++i) {
		if(value != 0 && value <= button[i]+offset && value >= button[i]-offset) {
		  tone(5, 3000/(i+1), 100);
		  stop = true;
		  break;
		}
	  }
	  if(stop) {
		break;
	  }
	  setMatrixLights(0);
	}
  }-  
  writeFont(3,50);
  writeFont(2,50);
  writeFont(1,50);  
  writeFont('-',75);
  pacmanStartSound();
  struct Node *firstNode = NULL;
  struct Node *latestNode = NULL;
  //int counter = 0;
  setSeed();
  Serial.println("Test");
  while(true) {
	Serial.println("Test2");
	//Read Random Seed
	int randomLED = random(1, 17);
	Serial.println("Test3");
	if(firstNode == NULL) {
	  //counter = 0;
	  firstNode = (struct Node *) malloc(sizeof(struct Node));
	  firstNode->value = randomLED;
	  firstNode->next = NULL;
	  latestNode = firstNode;
	}
	else {
	  //++counter;
	  latestNode->next = (struct Node *) malloc(sizeof(struct Node));
	  latestNode = latestNode->next;
	  latestNode->value = randomLED;
	  latestNode->next = NULL;
	}
	
	//Set LED on Matrix (Complete Nodes)
	Serial.println("New Number:");
	Serial.println(latestNode->value, DEC);
	struct Node *temp = firstNode;
	while(true) {
	  tone(5, 3000/temp->value, 100);
	  writePixel(temp->value, 600);
	  if(temp->next != NULL) {
		Serial.println(temp->value);
		temp = temp->next;
	  }
	  else {
		break;
	  }
	  delay(100);
	}
	//Check key streak
	struct Node *checkNode = firstNode;
	bool wrongButton = false;
	while(true) {
	  //Read Key
	  Serial.println("Input Key:");
	  int inputKey = getKeyValue();
	  Serial.println(inputKey, DEC);
	  if(checkNode->value == inputKey) {
		Serial.println("Hit!");
		if(checkNode->next != NULL) {
		  checkNode = checkNode->next;
		}
		else {
		  break;
		}
	  }
	  else {
		Serial.println("Miss!");
		for(int i = 0; i < 5; ++i) {
		  tone(5, 3000/checkNode->value, 100);
		  setMatrixLights(checkNode->value);
		  delay(250);
		  setMatrixLights(0);
		  delay(250);
		}
		gameOverSound();
		gameOver();
		for(int i = 0; i < 4; ++i) {
		  setMatrixLights(17);
		  delay(250);
		  setMatrixLights(0);
		  delay(250);
		}
		Serial.println("==============================");
		Serial.println("Start New Game!");
		Serial.println("==============================");
		wrongButton = true;
		break;
	  }
	}
	delay(500);
	
	if(wrongButton) {
	  break;
	}
  }
  //clearList(firstNode);
  firstNode = NULL;
  latestNode = NULL;
}

void gameOverSound() {
  beep(523, 125);
  beep(554, 125);
  beep(587, 125);
  delay(200);
  beep(494, 125);
  beep(698, 125);
  delay(50);
  beep(698, 125);
  beep(698, 125);
  beep(659, 125);
  beep(587, 125);
  beep(523, 125);
  beep(330, 125);
  delay(50);
  beep(196, 125);
  beep(330, 125);
  beep(262, 125);
}

void pacmanStartSound(){
   beep(493, 125);
   beep(987, 125);
   beep(739, 125);
   beep(622, 125);
  
  delay(50);
  //B5/F#5/D#5
   beep(987, 125);
   beep(739, 125);
   beep(622, 125);
  
  delay(50);
  //C5/C6/G5/E5
   beep(523, 125);
   beep(1046,125);
   beep(783, 125);
   beep(659, 125);
  
  delay(50);
  //C6/G5/E5
   beep(1046,125);
   beep(783, 125);
   beep(659, 125);
  
  delay(50);
  //B4/B5/F#5/D#5
   beep(493, 125);
   beep(987, 125);
   beep(739, 125);
   beep(622, 125);
  
  delay(50);
  //B5/F#5/D#5
   beep(987, 125);
   beep(739, 125);
   beep(622, 125);
  
  //D#5/E5/F5
   beep(622, 125);
   
   beep(659, 125);
   
   beep(698, 125);
   
  
  //F5/F#5/G5
   beep(698, 125); 
   beep(739, 125); 
   beep(783, 125); 
  
  //G5/G#5/A5
   beep(783, 125); 
   beep(830, 125); 
   beep(880, 125); 
  
  //A5/A#5/B5
   beep(880, 125); 
   beep(932, 125); 
   beep(987, 125); 
   delay(150);
}

void beep(int fr, int dur){
  tone(5, fr, dur);
  delay(dur);
}

void gameOver() {
  writeFont('G',50);
  writeFont('A',50);
  writeFont('M',50);
  writeFont('E',50);
  writeFont('-',50);
  writeFont('O',50);
  writeFont('V',50);
  writeFont('E',50);
  writeFont('R',50);
  writeFont('!',50);
  writeFont('-',150);
  writeFont('!',50);
  writeFont('-',150);
  writeFont('!',50);
  writeFont('-',150);
}

void setSeed() {
  long currentSeed = analogRead(randomInput);
  Serial.println(currentSeed);
  randomSeed(currentSeed);
}

int getKeyValue() {
  while(true) {
	int value = analogRead(keyInput);
	for(int i = 0; i < 16; ++i) {
	  if(value != 0 && value <= button[i]+offset && value >= button[i]-offset) {
		tone(5, 3000/(i+1), 100);
		setMatrixLights(i+1);
		while(true) {
		  value = analogRead(keyInput);
		  if(value == 0) {
			setMatrixLights(0);
			return i+1; 
		  }
		}
	  }
	}
  }
}

int keyAnalogCalc() {
  unsigned long sum = 0;
  int last = 0;
  int counter = 0;
  int counter2 = 0;
  while(true) {
	int value = analogRead(keyInput);
	if(value != 0) {
	  sum += value;
	  ++counter;
	  if((sum/counter) == last) {
		if(counter % 1000 == 0) {
		  Serial.print(".");
		}
		++counter2;
	  }
	  else {
		last = (sum/counter);
		counter2 = 0;
	  }
  
	  if(counter2 == 7500) {
		break;
	  }
	}
  }
  Serial.println("");
  Serial.println("Stop Pressing the button!");
  setMatrixLights(17);
  while(true) {
	int value = analogRead(keyInput);
	if(value == 0) {
	  break;
	}
  }

  return sum/counter;
}

void keyCalibrate() {
  int counter;
  int sum;
  
  Serial.println("Key Calibration");
  for(int i = 0; i < 16; ++i) {
	Serial.print("Keep Pressing ");
	Serial.print(i+1);
	setMatrixLights(i+1);
	button[i] = keyAnalogCalc();
	Serial.print("Button ");
	Serial.print(i+1);
	Serial.print(" Value: ");
	Serial.println(button[i], DEC);
	setMatrixLights(0);
  }
  delay(500);
  for(int i = 1; i <= 16; ++i) {
	setMatrixLights(i);
	delay(100);
  }
  setMatrixLights(17);
  delay(250);
  writeFont('O', 250);
  Serial.print("Set Offset (Default 2): ");
  offset = getKeyValue();
  delay(250);
  Serial.println(offset);
  Serial.println("Calibration done!");
  for(int i = 1; i <= offset; ++i) {
	setMatrixLights(17);
	delay(250);
	setMatrixLights(0);
	delay(250);
  }
}

void setMatrixLights(int seg){
  switch(seg){
	case 0:  delayMicroseconds(500);
			 PORTB = 0x0;
			 PORTD = 0x0;
			 break;
	case 1:  PORTB = B100001;
			 PORTD = B11000000;
			 break;
	case 2:  PORTB = B100010;
			 PORTD = B11000000;
			 break;
	case 3:  PORTB = B100011;
			 PORTD = B01000000;
			 break;
	case 4:  PORTB = B100011;
			 PORTD = B10000000;
			 break;
	case 5:  PORTB = B010001;
			 PORTD = B11000000;
			 break;
	case 6:  PORTB = B010010;
			 PORTD = B11000000;
			 break;
	case 7:  PORTB = B010011;
			 PORTD = B01000000;
			 break;
	case 8:  PORTB = B010011;
			 PORTD = B10000000;
			 break;
	case 9:  PORTB = B001001;
			 PORTD = B11000000;
			 break;
	case 10: PORTB = B001010;
			 PORTD = B11000000;
			 break; 
	case 11: PORTB = B001011;
			 PORTD = B01000000;
			 break; 
	case 12: PORTB = B001011;
			 PORTD = B10000000;
			 break;
	case 13: PORTB = B000101;
			 PORTD = B11000000;
			 break;
	case 14: PORTB = B000110;
			 PORTD = B11000000;
			 break;
	case 15: PORTB = B000111;
			 PORTD = B01000000;
			 break;
	case 16: PORTB = B000111;
			 PORTD = B10000000;
			 break;
	case 17: PORTB = B111100;
			 PORTD = B00000000;
			 break;
  }
}

void writeFont(int number, unsigned long timeValue) {
  for(unsigned long i = 0; i < timeValue; ++i) {
	font(number);
	delay(1);
  }
}

void writePixel(int pixel, int timeValue) {
	setMatrixLights(pixel);
	delay(timeValue);
	setMatrixLights(0);  
}

void setFont(bool ledStatus[16]){
  for(int i = 0; i < 16; i++){
	  if(ledStatus[i]){
		setMatrixLights(i+1);
		setMatrixLights(0);  
	  }
  }
}

void font(int number){
  bool leds[16] = {0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0};
  switch(number){
	case '-': 
			setFont(leds);
			break;
	case 0: leds[0] = 1;
			leds[1] = 1;
			leds[2] = 1;
			leds[3] = 1;
			leds[4] = 1;
			leds[5] = 1;
			leds[7] = 1;
			leds[8] = 1;
			leds[10] = 1;
			leds[11] = 1;
			leds[12] = 1;
			leds[13] = 1;
			leds[14] = 1;
			leds[15] = 1;
			setFont(leds);
			break;
	case 1: leds[0] = 1;
			leds[1] = 1;
			leds[2] = 1;
			leds[5] = 1;
			leds[6] = 1;
			leds[9] = 1;
			leds[10] = 1;
			leds[12] = 1;
			leds[13] = 1;
			leds[14] = 1;
			leds[15] = 1;
			setFont(leds);
			break;
	case 2: leds[0] = 1;
			leds[1] = 1;
			leds[2] = 1;
			leds[3] = 1;
			leds[5] = 1;
			leds[6] = 1;
			leds[7] = 1;
			leds[8] = 1;
			leds[9] = 1;
			leds[10] = 1;
			leds[12] = 1;
			leds[13] = 1;
			leds[14] = 1;
			leds[15] = 1;
			setFont(leds);
			break;
	case 3: leds[0] = 1;
			leds[1] = 1;
			leds[2] = 1;
			leds[3] = 1;
			leds[5] = 1;
			leds[6] = 1;
			leds[7] = 1;
			leds[10] = 1;
			leds[11] = 1;
			leds[12] = 1;
			leds[13] = 1;
			leds[14] = 1;
			leds[15] = 1;
			setFont(leds);
			break;
	case 4: leds[0] = 1;
			leds[2] = 1;
			leds[3] = 1;
			leds[4] = 1;
			leds[5] = 1;
			leds[6] = 1;
			leds[7] = 1;
			leds[8] = 1;
			leds[9] = 1;
			leds[10] = 1;
			leds[11] = 1;
			leds[14] = 1;
			leds[15] = 1;
			setFont(leds);
			break;
	case 5: leds[0] = 1;
			leds[1] = 1;
			leds[2] = 1;
			leds[3] = 1;
			leds[4] = 1;
			leds[5] = 1;
			leds[6] = 1;
			leds[9] = 1;
			leds[10] = 1;
			leds[11] = 1;
			leds[12] = 1;
			leds[13] = 1;
			leds[14] = 1;
			leds[15] = 1;
			setFont(leds);
			break;
	case 6: leds[0] = 1;
			leds[4] = 1;
			leds[5] = 1;
			leds[6] = 1;
			leds[7] = 1;
			leds[8] = 1;
			leds[11] = 1;
			leds[12] = 1;
			leds[13] = 1;
			leds[14] = 1;
			leds[15] = 1;
			setFont(leds);
			break;
	case 7: leds[0] = 1;
			leds[1] = 1;
			leds[2] = 1;
			leds[3] = 1;
			leds[6] = 1;
			leds[7] = 1;
			leds[10] = 1;
			leds[11] = 1;
			leds[14] = 1;
			leds[15] = 1;
			setFont(leds);
			break;
	case 8: leds[1] = 1;
			leds[2] = 1;
			leds[3] = 1;
			leds[5] = 1;
			leds[7] = 1;
			leds[8] = 1;
			leds[9] = 1;
			leds[10] = 1;
			leds[11] = 1;
			leds[12] = 1;
			leds[13] = 1;
			leds[14] = 1;
			leds[15] = 1;
			setFont(leds);
			break;
	case 9: leds[0] = 1;
			leds[1] = 1;
			leds[2] = 1;
			leds[3] = 1;
			leds[4] = 1;
			leds[6] = 1;
			leds[7] = 1;
			leds[8] = 1;
			leds[9] = 1;
			leds[10] = 1;
			leds[11] = 1;
			leds[14] = 1;
			leds[15] = 1;
			setFont(leds);
			break;
	case 'G':leds[0] = 1;
			leds[1] = 1;
			leds[2] = 1;
			leds[3] = 1;
			leds[4] = 1;
			leds[5] = 1;
			leds[8] = 1;
			leds[9] = 1;
			leds[11] = 1;
			leds[12] = 1;
			leds[13] = 1;
			leds[14] = 1;
			leds[15] = 1;
			setFont(leds);
			break;
	case 'A':leds[0] = 1;
			leds[1] = 1;
			leds[2] = 1;
			leds[3] = 1;
			leds[4] = 1;
			leds[5] = 1;
			leds[7] = 1;
			leds[8] = 1;
			leds[9] = 1;
			leds[10] = 1;
			leds[11] = 1;
			leds[12] = 1;
			leds[13] = 1;
			leds[15] = 1;
			setFont(leds);
			break;
	case 'M':leds[0] = 1;
			leds[1] = 1;
			leds[2] = 1;
			leds[3] = 1;
			leds[4] = 1;
			leds[6] = 1;
			leds[7] = 1;
			leds[8] = 1;
			leds[11] = 1;
			leds[12] = 1;
			leds[15] = 1;
			setFont(leds);
			break;
	case 'E':leds[0] = 1;
			leds[1] = 1;
			leds[2] = 1;
			leds[3] = 1;
			leds[4] = 1;
			leds[5] = 1;
			leds[6] = 1;
			
			leds[8] = 1;
			leds[9] = 1;
			leds[12] = 1;
			leds[13] = 1;
			leds[14] = 1;
			leds[15] = 1;
			setFont(leds);
			break;
	case 'O':leds[0] = 1;
			leds[1] = 1;
			leds[2] = 1;
			leds[3] = 1;
			leds[4] = 1;
			leds[5] = 1;
			leds[7] = 1;
			leds[8] = 1;
			leds[9] = 1;
			leds[11] = 1;
			leds[12] = 1;
			leds[13] = 1;
			leds[14] = 1;
			leds[15] = 1;
			setFont(leds);
			break;
	case 'V':leds[0] = 1;
			leds[3] = 1;
			leds[4] = 1;
			leds[7] = 1;
			leds[8] = 1;
			leds[9] = 1;
			leds[10] = 1;
			leds[11] = 1;
			leds[13] = 1;
			leds[14] = 1;
			setFont(leds);
			break;
	case 'R':leds[0] = 1;
			leds[1] = 1;
			leds[2] = 1;
			leds[3] = 1;
			leds[4] = 1;
			leds[5] = 1;
			leds[7] = 1;
			leds[8] = 1;
			leds[9] = 1;
			leds[10] = 1;
			leds[12] = 1;
			leds[13] = 1;
			leds[15] = 1;
			setFont(leds);
			break;
	case '!':
			leds[1] = 1;
			leds[2] = 1;
			leds[5] = 1;
			leds[6] = 1;
			leds[13] = 1;
			leds[14] = 1;
			setFont(leds);
			break;
  } 
}