finalardu

#include <Servo.h>
#define NOTE_B0  31
#define NOTE_C1  33
#define NOTE_CS1 35
#define NOTE_D1  37
#define NOTE_DS1 39
#define NOTE_E1  41
#define NOTE_F1  44
#define NOTE_FS1 46
#define NOTE_G1  49
#define NOTE_GS1 52
#define NOTE_A1  55
#define NOTE_AS1 58
#define NOTE_B1  62
#define NOTE_C2  65
#define NOTE_CS2 69
#define NOTE_D2  73
#define NOTE_DS2 78
#define NOTE_E2  82
#define NOTE_F2  87
#define NOTE_FS2 93
#define NOTE_G2  98
#define NOTE_GS2 104
#define NOTE_A2  110
#define NOTE_AS2 117
#define NOTE_B2  123
#define NOTE_C3  131
#define NOTE_CS3 139
#define NOTE_D3  147
#define NOTE_DS3 156
#define NOTE_E3  165
#define NOTE_F3  175
#define NOTE_FS3 185
#define NOTE_G3  196
#define NOTE_GS3 208
#define NOTE_A3  220
#define NOTE_AS3 233
#define NOTE_B3  247
#define NOTE_C4  262
#define NOTE_CS4 277
#define NOTE_D4  294
#define NOTE_DS4 311
#define NOTE_E4  330
#define NOTE_F4  349
#define NOTE_FS4 370
#define NOTE_G4  392
#define NOTE_GS4 415
#define NOTE_A4  440
#define NOTE_AS4 466
#define NOTE_B4  494
#define NOTE_C5  523
#define NOTE_CS5 554
#define NOTE_D5  587
#define NOTE_DS5 622
#define NOTE_E5  659
#define NOTE_F5  698
#define NOTE_FS5 740
#define NOTE_G5  784
#define NOTE_GS5 831
#define NOTE_A5  880
#define NOTE_AS5 932
#define NOTE_B5  988
#define NOTE_C6  1047
#define NOTE_CS6 1109
#define NOTE_D6  1175
#define NOTE_DS6 1245
#define NOTE_E6  1319
#define NOTE_F6  1397
#define NOTE_FS6 1480
#define NOTE_G6  1568
#define NOTE_GS6 1661
#define NOTE_A6  1760
#define NOTE_AS6 1865
#define NOTE_B6  1976
#define NOTE_C7  2093
#define NOTE_CS7 2217
#define NOTE_D7  2349
#define NOTE_DS7 2489
#define NOTE_E7  2637
#define NOTE_F7  2794
#define NOTE_FS7 2960
#define NOTE_G7  3136
#define NOTE_GS7 3322
#define NOTE_A7  3520
#define NOTE_AS7 3729
#define NOTE_B7  3951
#define NOTE_C8  4186
#define NOTE_CS8 4435
#define NOTE_D8  4699
#define NOTE_DS8 4978
#define REST      0

Servo myservo;
// change this to make the song slower or faster
int tempo = 144;

// change this to whichever pin you want to use
int buzzer = 11;

int pinled[] = {10,8,5,3,2};
int randomnumber, prevrand;

int melody[] = {


  // Hedwig's theme fromn the Harry Potter Movies
  // Socre from https://musescore.com/user/3811306/scores/4906610

  REST, 2, NOTE_D4, 4,
  NOTE_G4, -4, NOTE_AS4, 8, NOTE_A4, 4,
  NOTE_G4, 2, NOTE_D5, 4,
  NOTE_C5, -2,
  NOTE_A4, -2,
  NOTE_G4, -4, NOTE_AS4, 8, NOTE_A4, 4,
  NOTE_F4, 2, NOTE_GS4, 4,
  NOTE_D4, -1,
  NOTE_D4, 4,

  NOTE_G4, -4, NOTE_AS4, 8, NOTE_A4, 4, //10
  NOTE_G4, 2, NOTE_D5, 4,
  NOTE_F5, 2, NOTE_E5, 4,
  NOTE_DS5, 2, NOTE_B4, 4,
  NOTE_DS5, -4, NOTE_D5, 8, NOTE_CS5, 4,
  NOTE_CS4, 2, NOTE_B4, 4,
  NOTE_G4, -1,
  NOTE_AS4, 4,

  NOTE_D5, 2, NOTE_AS4, 4,//18
  NOTE_D5, 2, NOTE_AS4, 4,
  NOTE_DS5, 2, NOTE_D5, 4,
  NOTE_CS5, 2, NOTE_A4, 4,
  NOTE_AS4, -4, NOTE_D5, 8, NOTE_CS5, 4,
  NOTE_CS4, 2, NOTE_D4, 4,
  NOTE_D5, -1,
  REST,4, NOTE_AS4,4,

  NOTE_D5, 2, NOTE_AS4, 4,//26
  NOTE_D5, 2, NOTE_AS4, 4,
  NOTE_F5, 2, NOTE_E5, 4,
  NOTE_DS5, 2, NOTE_B4, 4,
  NOTE_DS5, -4, NOTE_D5, 8, NOTE_CS5, 4,
  NOTE_CS4, 2, NOTE_AS4, 4,
  NOTE_G4, -1,

};


int notes = sizeof(melody) / sizeof(melody[0]) / 2;

// this calculates the duration of a whole note in ms
int wholenote = (60000 * 4) / tempo;

int divider = 0, noteDuration = 0;


int valor = 0;
int proceso = 1;
bool alreadydid = false;
int pos = 20;
int counter = 0;
long check;
unsigned long previousMillis = 0;
unsigned long previousMilli = 0;
int signo = 1;

int lg = 10;
int ly = 8;
int lr = 5;
int bg = 3;
int br = 2;

void setup() {
  // put your setup code here, to run once:
  Serial.begin(9600);
  myservo.attach(6);
  myservo.write(0);
  pinMode(lg,OUTPUT);
  pinMode(ly,OUTPUT);
  pinMode(lr,OUTPUT);
  pinMode(bg,OUTPUT);
  pinMode(br,OUTPUT);

  pinMode(9,INPUT);

  digitalWrite(lr,HIGH);
  digitalWrite(ly,LOW);
  digitalWrite(lg,LOW);
  digitalWrite(bg,HIGH);
  digitalWrite(br,LOW);

}

void loop() {
  unsigned long currentMillis = millis();
  check = currentMillis - previousMillis;
  //Serial.println(check);
  valor = digitalRead(9);

  if(valor == HIGH){
    signo *= -1;
    Serial.println(proceso);
    counter++;
    Serial.println(counter);
    previousMillis = currentMillis;
    alreadydid = false;
    if(counter < 9) proceso = 1 * signo;
    if(counter == 9) tone(buzzer, melody[2], 500);
    if(counter >= 9 && counter < 18){
      proceso = 3 * signo;
    }
    if(counter == 18) tone(buzzer, melody[2], 500);
    if(counter >= 18 && counter < 27){
      proceso = 4 * signo;
    }


    if(counter >= 27) proceso = 2 * signo;
  }

  if(valor == LOW) counter = 0;

  if(proceso == -1 && alreadydid == false){
    if (currentMillis - previousMillis >= 750 && currentMillis - previousMillis < 950) {
      digitalWrite(lg,LOW);
    }
    if (currentMillis - previousMillis >= 950 && currentMillis - previousMillis < 1950) {
      digitalWrite(ly,HIGH);
    }
    if (currentMillis - previousMillis >= 1950) {
      previousMillis = currentMillis;
      digitalWrite(lr,HIGH);
      digitalWrite(ly,LOW);
      digitalWrite(bg,HIGH);
      digitalWrite(br,LOW);
      alreadydid = true;
      myservo.write(100);
    }
  }

  if(proceso == 1 && alreadydid == false){
    if (currentMillis - previousMillis >= 750 && currentMillis - previousMillis < 950) {
      digitalWrite(ly,HIGH);
    }
    if (currentMillis - previousMillis >= 950 && currentMillis - previousMillis < 1950) {
      digitalWrite(lr,LOW);
    }
    if (currentMillis - previousMillis >= 1950) {
      digitalWrite(lg,HIGH);
      digitalWrite(ly,LOW);
      digitalWrite(bg,LOW);
      digitalWrite(br,HIGH);
      alreadydid = true;
      previousMillis = currentMillis;
      myservo.write(0);
    }
  }

  if(proceso == 2 || proceso == -2 && alreadydid == false){
    digitalWrite(lg,LOW);
    digitalWrite(lr,LOW);
    digitalWrite(ly,LOW);
    digitalWrite(bg,LOW);
    digitalWrite(br,LOW);
    for (int thisNote = 0; thisNote < notes * 2; thisNote = thisNote + 2) {
    do{
      randomnumber = int(random(0,5));
    }while(randomnumber == prevrand);

    // calculates the duration of each note
    divider = melody[thisNote + 1];
    if (divider > 0) {
      // regular note, just proceed
      noteDuration = (wholenote) / divider;
    } else if (divider < 0) {
      // dotted notes are represented with negative durations!!
      noteDuration = (wholenote) / abs(divider);
      noteDuration *= 1.5; // increases the duration in half for dotted notes
    }
    prevrand = randomnumber;
    // we only play the note for 90% of the duration, leaving 10% as a pause
    tone(buzzer, melody[thisNote], noteDuration * 0.9);
    if(melody[thisNote] != 0)digitalWrite(pinled[randomnumber],HIGH);
    // Wait for the specief duration before playing the next note.
    delay(noteDuration);
    digitalWrite(pinled[randomnumber],LOW);
    // stop the waveform generation before the next note.
    noTone(buzzer);
  }
  alreadydid = true;
  }
  if(proceso == 3 || proceso == -3){

    if (currentMillis - previousMillis >= 250 && currentMillis - previousMillis < 500) {
      digitalWrite(lg,HIGH);
      digitalWrite(br,HIGH);
    }
    if (currentMillis - previousMillis >= 500 && currentMillis - previousMillis < 750) {
      digitalWrite(ly,HIGH);
      digitalWrite(bg,HIGH);
    }
    if (currentMillis - previousMillis >= 750 && currentMillis - previousMillis < 1000) {
      digitalWrite(lr,HIGH);
    }
    if (currentMillis - previousMillis >= 1000 && currentMillis - previousMillis < 1250) {
      digitalWrite(lr,LOW);
    }
    if (currentMillis - previousMillis >= 1250 && currentMillis - previousMillis < 1500) {
      digitalWrite(ly,LOW);
      digitalWrite(bg,LOW);
    }
    if (currentMillis - previousMillis >= 1500) {
      digitalWrite(lg,LOW);
      digitalWrite(br,LOW);
      previousMillis = currentMillis;
    }
  }
  if(proceso == 4 || proceso == -4){
    if (currentMillis - previousMillis >= 250 && currentMillis - previousMillis < 500) {
      digitalWrite(lg,HIGH);
      //digitalWrite(br,HIGH);
    }
    if (currentMillis - previousMillis >= 500 && currentMillis - previousMillis < 750) {
      digitalWrite(ly,HIGH);
      //digitalWrite(bg,HIGH);
    }
    if (currentMillis - previousMillis >= 750 && currentMillis - previousMillis < 1000) {
      digitalWrite(lr,HIGH);
    }
    if (currentMillis - previousMillis >= 1000 && currentMillis - previousMillis < 1250) {
      digitalWrite(bg,HIGH);
    }
    if (currentMillis - previousMillis >= 1250 && currentMillis - previousMillis < 1500) {
      digitalWrite(br,HIGH);
      //digitalWrite(bg,LOW);
    }
    if (currentMillis - previousMillis >= 1500 && currentMillis - previousMillis < 1750) {
      digitalWrite(br,LOW);
      //digitalWrite(br,HIGH);
    }
    if (currentMillis - previousMillis >= 1750 && currentMillis - previousMillis < 2000) {
      digitalWrite(bg,LOW);
      //digitalWrite(bg,HIGH);
    }
    if (currentMillis - previousMillis >= 2000 && currentMillis - previousMillis < 2250) {
      digitalWrite(lr,LOW);
    }
    if (currentMillis - previousMillis >= 2250 && currentMillis - previousMillis < 2500) {
      digitalWrite(ly,LOW);
    }
    if (currentMillis - previousMillis >= 2500) {
      digitalWrite(lg,LOW);
      //digitalWrite(bg,LOW);
      previousMillis = currentMillis;
    }

  }
  delay(180);
}

int servo(int IzDr, unsigned long currentMillis){

  if(IzDr == 1){
    pos = 0;
    do{
      if(currentMillis - previousMilli >= 15){
        myservo.write(pos);
        previousMilli = currentMillis;
        pos++;
      }

    } while(pos <= 100);

  }
  else{
    pos = 100;
    do{
      if(currentMillis - previousMilli >= 15){
        myservo.write(pos);
        previousMilli = currentMillis;
        pos--;
      }

    } while(pos >= 0);

  }
}