Arduino Speaker Test

#include <SPI.h>
#include <Adafruit_GFX.h>
#include <Adafruit_PCD8544.h>

#define SPEAKER 6

#define NOTE_INRV 1.059463
#define C4 261.626
#define TRANS 0

int BPM = 222;
int noteDiv = 16;

//  1   3       6   8   10
//0   2   4   5   7   9   11
const PROGMEM int octvs[] =
{6, 5, 5, 6, 5, 5, 6, 5, 5, 6, 5, 5, 6, 5, 6, 5,//P7 bar 26
 5, 5, 5, 5, 5, 5, 5, 5, 5, 5, 5, 4, 5, 4, 5, 4,
 5, 5, 4, 5, 5, 4, 5, 5, 4, 5, 5, 4, 5, 5, 5, 4,
 5, 5, 4, 5, 5, 4, 5, 4, 5, 5, 5, 5, 6, 5, 6, 5,//P8
 6, 6, 5, 6, 6, 5, 6, 6, 5, 6, 6, 5, 6, 6, 6, 6,
 6, 6, 6, 6, 6, 6, 6, 6, 6, 6, 6, 5, 6, 6, 6, 5,
 6, 5, 6, 5, 6, 5, 6, 5, 6, 5, 6, 5, 6, 5, 6, 5,
 6, 5, 5, 6, 5, 5, 6, 5, 5, 5, 5, 5, 5, 5, 5, 5,//P9
 6, 5, 6, 5, 6, 5, 6, 5, 6, 6, 6, 5, 6, 6, 6, 6,
 6, 6, 6, 6, 6, 6, 6, 5, 6, 5, 5, 6, 5, 5, 6, 5,
 5, 5, 5, 5, 6, 5, 6, 5, 6, 6, 6, 5, 5, 5, 5, 6,
 6, 6, 6, 5, 6, 6, 6, 5, 6, 6, 6, 5, 6, 6, 6, 5,//P10
 6, 6, 6, 6, 6, 6, 6, 6, 6, 6, 6, 6, 6, 6, 6, 6,
 6, 6, 6, 6, 6, 6, 6, 6, 6, 6, 6, 7, 6, 6, 6, 6,
 6, 6, 6, 6, 6, 6, 6, 6, 6, 6, 6, 6, 6, 6, 6, 6,
 7, 6, 7, 6, 7, 6, 7, 6, 6, 6, 6, 6, 6, 6, 6, 6,//P11
 3, 3, 3, 4, 3, 3, 4, 4, 3, 4, 4, 4, 4, 4, 4, 5,
 4, 4, 4, 5, 4, 4, 5, 5, 4, 5, 5, 5, 4, 5, 5, 6,
 6,-1
 };
const PROGMEM int notes[] =
{ 2,11, 7, 2,11, 7, 2,11, 7, 0, 7, 2, 0, 2, 0, 2,//P7 bar 26
 11, 7, 2,11, 7, 2,11, 7, 2, 6, 2, 9, 6, 9, 2, 9,
  9, 4,11, 9, 4,11, 9, 4,11, 7, 4,11, 7, 4, 7,11,
  6, 4,11, 6, 4,11, 7,11, 9, 2,11, 2, 0, 2, 2, 2,//P8
  4, 0, 9, 4, 0, 9, 4, 0, 9, 6, 0, 9, 7, 0, 6, 7,
  9, 4, 9, 0, 7, 4, 7, 0, 6, 0, 6, 9, 4, 0, 4, 9,
  4,11, 4, 6, 2,11, 2, 6, 1,11, 1, 6, 4,11, 4, 6,
  2,11, 7, 2,11, 7, 2,11, 7,11, 7, 4,11, 7,11, 4,//P9
  0, 7, 0, 4, 2, 7, 2, 4, 4, 0, 4, 7, 7, 4, 7, 0,
  6, 7, 6, 0, 4, 0, 4, 7, 2,11, 6, 2,11, 6, 0, 6,
 11, 6,11, 3, 3,11, 3, 6, 6, 3, 6, 6,11, 6,11, 3,
  9, 4, 9,11, 7, 4, 7,11, 6, 4, 6,11, 7, 2, 7,11,//P10
 11, 7, 4,11, 7, 4,11, 7, 4, 7, 4,11, 7, 4, 7, 9,
 11, 7,11, 7, 4, 1, 4, 1,11, 7, 4, 0, 7, 4, 7, 0,
 11, 7, 2,11, 7, 2,11, 7, 2, 9, 7, 2,11, 7,11, 2,
  2, 9, 2, 6, 0, 9, 0, 6,11, 6,11, 2, 9, 6, 9, 2,//P11
  2, 6, 9, 2, 6, 9, 0, 2, 9, 0, 2, 6, 0, 6, 9, 0,
  2, 6, 9, 2, 6, 9, 0, 2, 9, 0, 2, 6, 0, 6, 9, 0,
  2,-1
  };
const PROGMEM int beats[] =
{4, 4, 4, 4, 4, 4, 4, 4, 4, 4, 4, 4, 4, 4, 4, 4,//P7 bar 26
 4, 4, 4, 4, 4, 4, 4, 4, 4, 4, 4, 4, 4, 4, 4, 4,
 4, 4, 4, 4, 4, 4, 4, 4, 4, 4, 4, 4, 4, 4, 4, 4,
 4, 4, 4, 4, 4, 4, 4, 4, 4, 4, 4, 4, 4, 4, 4, 4,//P8
 4, 4, 4, 4, 4, 4, 4, 4, 4, 4, 4, 4, 4, 4, 4, 4,
 4, 4, 4, 4, 4, 4, 4, 4, 4, 4, 4, 4, 4, 4, 4, 4,
 4, 4, 4, 4, 4, 4, 4, 4, 4, 4, 4, 4, 4, 4, 4, 4,
 4, 4, 4, 4, 4, 4, 4, 4, 4, 4, 4, 4, 4, 4, 4, 4,//P9
 4, 4, 4, 4, 4, 4, 4, 4, 4, 4, 4, 4, 4, 4, 4, 4,
 4, 4, 4, 4, 4, 4, 4, 4, 4, 4, 4, 4, 4, 4, 4, 4,
 4, 4, 4, 4, 4, 4, 4, 4, 4, 4, 4, 4, 4, 4, 4, 4,
 4, 4, 4, 4, 4, 4, 4, 4, 4, 4, 4, 4, 4, 4, 4, 4,//P10
 4, 4, 4, 4, 4, 4, 4, 4, 4, 4, 4, 4, 4, 4, 4, 4,
 4, 4, 4, 4, 4, 4, 4, 4, 4, 4, 4, 4, 4, 4, 4, 4,
 4, 4, 4, 4, 4, 4, 4, 4, 4, 4, 4, 4, 4, 4, 4, 4,
 4, 4, 4, 4, 4, 4, 4, 4, 4, 4, 4, 4, 4, 4, 4, 4,//P11
 4, 4, 4, 4, 4, 4, 4, 4, 4, 4, 4, 4, 4, 4, 4, 4,
 4, 4, 4, 4, 4, 4, 4, 4, 4, 4, 4, 4, 4, 4, 4, 4,
16,48
 };

const int noteCount = sizeof(notes) / sizeof(int);


Adafruit_PCD8544 display = Adafruit_PCD8544(22, 23, 24, 25, 26);
int height = display.height();
int width = display.width();

void setup() {


  // init LCD
  display.begin();
  display.setContrast(50);
  display.setTextSize(1);
  display.setTextColor(BLACK);
  display.setRotation(2); // using it upside down
  display.setCursor(0, 0);
  display.clearDisplay();
  display.display();
}

void loop() {
  for (int i = 0; i < noteCount; i++) {
    int octv = pgm_read_word_near(octvs + i);
    int note = pgm_read_word_near(notes + i);
    int beat = pgm_read_word_near(beats + i);
    int freq = freqCalc(octv, note);
    long dura = ((long)beat) * 1000 * 60 / BPM / noteDiv;
    long now = millis();

    display.clearDisplay();
    display.print("i=");
    display.println(i);
    display.print("o,n=");
    display.print(octv);
    display.print(",");
    display.println(note);
    display.print("b=");
    display.println(beat);
    display.print("f=");
    display.println(freq);
    display.print("t=");
    display.println(dura);
    display.display();

    dura -= millis() - now;
    if (freq != 0)
      tone(SPEAKER, freq);
    delay(dura);
  }
  noTone(SPEAKER);
  delay(500);
  display.clearDisplay();
  display.display();
  while (1);
}

int freqCalc(int oct, int note) {
  if (oct < 0 || note < 0)
    return (0);
  else
    return ((1 << oct) * (pow(NOTE_INRV , (note + TRANS))) * C4 / 16);
}