#include <Arduino.h>
#include <ToneDetector.h>


void setup() {
// initialize the digital pin as an output.

    Serial.begin(115200);

    /*
     * initialize ToneDetector with default values
     */
    setToneDetectorControlDefaults();
  

  digitalWrite(2, HIGH);
  delay(200);
  digitalWrite(3, HIGH);
  delay(200);
  digitalWrite(4, HIGH);
  delay(200);
  digitalWrite(5, HIGH);
  delay(200);
  digitalWrite(6, HIGH);
  delay(200);
  digitalWrite(7, HIGH);
  delay(200);
  digitalWrite(8, HIGH);
  delay(200);
  digitalWrite(9, HIGH);
  delay(200);
  digitalWrite(10, HIGH);
  delay(200);
  digitalWrite(11, HIGH);
  delay(200);
  digitalWrite(12, HIGH);
  delay(200);
  digitalWrite(13, HIGH);
  delay(500);

  for (int i=0; i<=14; i++){
    digitalWrite(i, LOW); 
  }
    
}

void loop() {
    /*
     * Read samples and compute and output frequency
     */
    uint16_t tFrequency = readSignal(); //Entrada mic A1

    if (tFrequency > SIGNAL_MAX_ERROR_CODE) {
        // print value
        
        Serial.println(tFrequency);
        Serial.print(" ");
  
  //C
  if ((tFrequency>=32 && tFrequency<=33)||(tFrequency>=63 && tFrequency<=67)
  ||(tFrequency>=126 && tFrequency<=133)||(tFrequency>=255 && tFrequency<=265)
  ||(tFrequency>=515 && tFrequency<=530)||(tFrequency>=1020 && tFrequency<=1060)
  ||(tFrequency>=2000 && tFrequency<=2100)||(tFrequency>=4000 && tFrequency<=4200)){
  digitalWrite(2, HIGH);   
  }
  //C#
  if ((tFrequency>=33 && tFrequency<=35)||(tFrequency>=67 && tFrequency<=70)
  ||(tFrequency>=135 && tFrequency<=140)||(tFrequency>=268 && tFrequency<=285)
  ||(tFrequency>=540 && tFrequency<=560)||(tFrequency>=1100 && tFrequency<=1150)
  ||(tFrequency>=2200 && tFrequency<=2250)||(tFrequency>=4200 && tFrequency<=4460)){
  digitalWrite(3, HIGH);
  }
  //D
  if ((tFrequency>=36 && tFrequency<=37)||(tFrequency>=71 && tFrequency<=74)
  ||(tFrequency>=143 && tFrequency<=149)||(tFrequency>=289 && tFrequency<=295)
  ||(tFrequency>=570 && tFrequency<=595)||(tFrequency>=1160 && tFrequency<=1185)
  ||(tFrequency>=2260 && tFrequency<=2360)||(tFrequency>=4500 && tFrequency<=4800)){
  digitalWrite(4, HIGH);    
  }
  //D#
  if ((tFrequency>=39 && tFrequency<=39)||(tFrequency>=75 && tFrequency<=79)
  ||(tFrequency>=152 && tFrequency<=158)||(tFrequency>=305 && tFrequency<=316)
  ||(tFrequency>=600 && tFrequency<=630)||(tFrequency>=1200 && tFrequency<=1260)
  ||(tFrequency>=2400 && tFrequency<=2500)||(tFrequency>=4900 && tFrequency<=5100)){
  digitalWrite(5, HIGH);
  }
  //E
  if ((tFrequency>=40 && tFrequency<=42)||(tFrequency>=80 && tFrequency<=84)
  ||(tFrequency>=160 && tFrequency<=169)||(tFrequency>=320 && tFrequency<=335)
  ||(tFrequency>=640 && tFrequency<=660)||(tFrequency>=1270 && tFrequency<=1340)
  ||(tFrequency>=2550 && tFrequency<=2680)||(tFrequency>=5150 && tFrequency<=5300)){
  digitalWrite(6, HIGH);
  }
  //F
  if ((tFrequency>=20 && tFrequency<=22)||(tFrequency>=42 && tFrequency<=45)
  ||(tFrequency>=84 && tFrequency<=90)||(tFrequency>=170 && tFrequency<=180)
  ||(tFrequency>=340 && tFrequency<=350)||(tFrequency>=665 && tFrequency<=700)
  ||(tFrequency>=1345 && tFrequency<=1400)||(tFrequency>=2680 && tFrequency<=2800)
  ||(tFrequency>=5400 && tFrequency<=5600)){
  digitalWrite(7, HIGH); 
  }
  //F#
  if ((tFrequency>=22 && tFrequency<=24)||(tFrequency>=45 && tFrequency<=47)
  ||(tFrequency>=90 && tFrequency<=95)||(tFrequency>=181 && tFrequency<=190)
  ||(tFrequency>=350 && tFrequency<=370)||(tFrequency>=710 && tFrequency<=750)
  ||(tFrequency>=1400 && tFrequency<=1530)||(tFrequency>=2800 && tFrequency<=3050)
  ||(tFrequency>=5600 && tFrequency<=6100)){
  digitalWrite(8, HIGH);
  }
  //G
  if ((tFrequency>=24 && tFrequency<=25)||(tFrequency>=47 && tFrequency<=50)
  ||(tFrequency>=95 && tFrequency<=100)||(tFrequency>=190 && tFrequency<=205)
  ||(tFrequency>=370 && tFrequency<=400)||(tFrequency>=750 && tFrequency<=800)
  ||(tFrequency>=1530 && tFrequency<=1600)||(tFrequency>=3050 && tFrequency<=3200)
  ||(tFrequency>=6100 && tFrequency<=6300)){
  digitalWrite(9, HIGH); 
  }  
  //G#
  if ((tFrequency>=25 && tFrequency<=26)||(tFrequency>=50 && tFrequency<=53)
  ||(tFrequency>=100 && tFrequency<=105)||(tFrequency>=205 && tFrequency<=215)
  ||(tFrequency>=400 && tFrequency<=420)||(tFrequency>=800 && tFrequency<=840)
  ||(tFrequency>=1600 && tFrequency<=1700)||(tFrequency>=3200 && tFrequency<=3450)){
  digitalWrite(10, HIGH);
  }
  //A
  if ((tFrequency>=26 && tFrequency<=28)||(tFrequency>=53 && tFrequency<=56)
  ||(tFrequency>=105 && tFrequency<=115)||(tFrequency>=215 && tFrequency<=225)
  ||(tFrequency>=420 && tFrequency<=450)||(tFrequency>=840 && tFrequency<=900)
  ||(tFrequency>=1700 && tFrequency<=1800)||(tFrequency>=3450 && tFrequency<=3550)){
  digitalWrite(11, HIGH);    
  }
  //A#
  if ((tFrequency>=28 && tFrequency<=30)||(tFrequency>=56 && tFrequency<=59)
  ||(tFrequency>=115 && tFrequency<=120)||(tFrequency>=225 && tFrequency<=240)
  ||(tFrequency>=450 && tFrequency<=480)||(tFrequency>=900 && tFrequency<=950)
  ||(tFrequency>=1800 && tFrequency<=1900)||(tFrequency>=3550 && tFrequency<=3800)){
  digitalWrite(12, HIGH);  
  }
  //B
  if ((tFrequency>=30 && tFrequency<=31)||(tFrequency>=59 && tFrequency<=62)
  ||(tFrequency>=120 && tFrequency<=130)||(tFrequency>=240 && tFrequency<=255)
  ||(tFrequency>=480 && tFrequency<=515)||(tFrequency>=950 && tFrequency<=1020)
  ||(tFrequency>=1900 && tFrequency<=2000)||(tFrequency>=3800 && tFrequency<=4000)){
  digitalWrite(13, HIGH);   
  }
  delay(500);
  }
  for (int i=0; i<=14; i++){
    digitalWrite(i, LOW); 
  }
  
}