#include "psg.h"
#include "sequencer.h"


const t_tone notes[] = {
  { .octave = e_O_2, .note = e_G,   .length = e_L_1_2 },
  { .octave = e_O_2, .note = e_D,   .length = e_L_1_4 },
  { .octave = e_O_2, .note = e_Dis, .length = e_L_1_4 },

  { .octave = e_O_2, .note = e_F,   .length = e_L_1_2 },
  { .octave = e_O_2, .note = e_Dis, .length = e_L_1_4 },
  { .octave = e_O_2, .note = e_D,   .length = e_L_1_4},

  { .octave = e_O_2, .note = e_C,   .length = e_L_1_2},
  { .octave = e_O_2, .note = e_C,   .length = e_L_1_4},
  { .octave = e_O_2, .note = e_Dis, .length = e_L_1_4},

  { .octave = e_O_2, .note = e_G,   .length = e_L_1_2},
  { .octave = e_O_2, .note = e_F,   .length = e_L_1_4},
  { .octave = e_O_2, .note = e_Dis, .length = e_L_1_4},

  { .octave = e_O_2, .note = e_D,   .length = e_L_1_2},
  { .octave = e_O_2, .note = e_D,   .length = e_L_1_4},
  { .octave = e_O_2, .note = e_Dis, .length = e_L_1_4},

  { .octave = e_O_2, .note = e_F,   .length = e_L_1_2},
  { .octave = e_O_2, .note = e_G,   .length = e_L_1_2},

  { .octave = e_O_2, .note = e_Dis, .length = e_L_1_2},
  { .octave = e_O_2, .note = e_C,   .length = e_L_1_2},

  { .octave = e_O_2, .note = e_C,   .length = e_L_1_2},

  { .octave = e_O_2, .note = e_F,   .length = e_L_1_4},
  { .octave = e_O_2, .note = e_F,   .length = e_L_1_4},
  { .octave = e_O_2, .note = e_Gis, .length = e_L_1_4},

  { .octave = e_O_3, .note = e_C,   .length = e_L_1_2},
  { .octave = e_O_2, .note = e_Ais, .length = e_L_1_4},
  { .octave = e_O_2, .note = e_Gis,   .length = e_L_1_4},

  { .octave = e_O_2, .note = e_G,   .length = e_L_1_2},
  { .octave = e_O_2, .note = e_G,   .length = e_L_1_4},
  { .octave = e_O_2, .note = e_Dis, .length = e_L_1_4},

  { .octave = e_O_2, .note = e_G,   .length = e_L_1_2},
  { .octave = e_O_2, .note = e_F,   .length = e_L_1_4},
  { .octave = e_O_2, .note = e_Dis, .length = e_L_1_4},

  { .octave = e_O_2, .note = e_D,   .length = e_L_1_2},
  { .octave = e_O_2, .note = e_D,   .length = e_L_1_4},
  { .octave = e_O_2, .note = e_Dis, .length = e_L_1_4},

  { .octave = e_O_2, .note = e_F,   .length = e_L_1_2},
  { .octave = e_O_2, .note = e_G,   .length = e_L_1_2},

  { .octave = e_O_2, .note = e_Dis, .length = e_L_1_2},
  { .octave = e_O_2, .note = e_C,   .length = e_L_1_2},

  { .octave = e_O_2, .note = e_C,   .length = e_L_1_2},

  { .octave = e_O_2, .note = e_C,   .length = e_L_EndMark },
};

/*
const t_tone ladder[16] = {
  { .octave = e_O_2, .note = e_C,   .length = e_L_1_4 },
  { .octave = e_O_2, .note = e_D,   .length = e_L_1_4 },
  { .octave = e_O_2, .note = e_E,   .length = e_L_1_4 },
  { .octave = e_O_2, .note = e_F,   .length = e_L_1_4 },
  { .octave = e_O_2, .note = e_G,   .length = e_L_1_4 },
  { .octave = e_O_2, .note = e_A,   .length = e_L_1_4 },
  { .octave = e_O_2, .note = e_H,   .length = e_L_1_4 },
  { .octave = e_O_3, .note = e_C,   .length = e_L_1_4 },
  { .octave = e_O_2, .note = e_H,   .length = e_L_1_4 },
  { .octave = e_O_2, .note = e_A,   .length = e_L_1_4 },
  { .octave = e_O_2, .note = e_G,   .length = e_L_1_4 },
  { .octave = e_O_2, .note = e_F,   .length = e_L_1_4 },
  { .octave = e_O_2, .note = e_E,   .length = e_L_1_4 },
  { .octave = e_O_2, .note = e_D,   .length = e_L_1_4 },
  { .octave = e_O_2, .note = e_H,   .length = e_L_EndMark },
};
*/

t_melody melody= {
  .idx = 0,
  .lengthCnt = 0,
  .tones = notes
};


void melodyInit() {
  psgWrite(07, 0b11111110);
  psgWrite(010, 03);
  sequencerPlayMelody(&melody);
}