#include "config.h"
#include "sequencer.h"
#include <LCDMenuLib2.h>
#include <LiquidCrystal_I2C.h>

extern LCDMenuLib2 LCDML;
extern LiquidCrystal_I2C lcd;
extern config_t configuration;
extern void handleNoteOn(byte , byte , byte );
extern void handleNoteOff(byte , byte , byte );
extern void UI_func_sequencer(uint8_t);
extern void UI_func_arpeggio(uint8_t);
extern const char* seq_find_shortname(uint8_t);
boolean interrupt_swapper = false;

void sequencer_part1(void)
{
  //if (seq_note_in > 0 && seq_note_in < 62 && seq_recording == false ) {
  //handleNoteOff(configuration.dexed[0].midi_channel, seq_data[3][seq_step] + seq_transpose , 0);
  //handleNoteOff(configuration.dexed[0].midi_channel, seq_data[3][seq_step - 1] + seq_transpose , 0);
  //if (seq_note_in>65)seq_note_in=seq_note_in-12;
  //seq_transpose = seq_note_in % 12 ;
  //seq_transpose=seq_transpose-12;
  //seq_note_in = 0;
  //}

  //  if (LCDML.FUNC_getID() == LCDML.OTHER_getIDFromFunction(UI_func_sequencer)) {  //is in UI of Sequencer

  //write to sequencer if in sequencer menu
  //    if (seq_note_in > 0 && seq_recording == true) {
  //
  //      //  if (  seq_content_type[ seq_patternchain[seq_chain_active_step][active_track]  ] == 1) handleNoteOff(configuration.dexed[0].midi_channel, seq_data[active_track][seq_step] + seq_transpose , 0);
  //
  //      seq_data[seq_active_track][seq_step] = seq_note_in;
  //      seq_vel[seq_active_track][seq_step] = seq_note_in_velocity;
  //      seq_note_in = 0;
  //      seq_note_in_velocity = 0;
  //    }

  for (uint8_t d = 0; d < 4; d++)
  {
    if ( seq_track_type[d] == 0) { // drum track
      if (seq_data[ seq_patternchain[seq_chain_active_step][d] ][seq_step] > 0 && seq_vel[ seq_patternchain[seq_chain_active_step][d] ][seq_step] > 0)
      {
        handleNoteOn(DRUM_MIDI_CHANNEL, seq_data[ seq_patternchain[seq_chain_active_step][d] ][seq_step] , seq_vel[ seq_patternchain[seq_chain_active_step][d] ][seq_step]);
      }
    }
    else {
      if (seq_data[ seq_patternchain[seq_chain_active_step][d] ][seq_step] > 0 && seq_vel[ seq_patternchain[seq_chain_active_step][d] ][seq_step] > 0)  // instrument track
      {
        if (seq_track_type[d] == 1 || seq_track_type[d] == 3 )
        {
          handleNoteOn(configuration.dexed[seq_inst_dexed[d]].midi_channel, seq_data[ seq_patternchain[seq_chain_active_step][d] ][seq_step] + seq_transpose , seq_vel[ seq_patternchain[seq_chain_active_step][d] ][seq_step]);
        }
        seq_prev_note[d] = seq_data[ seq_patternchain[seq_chain_active_step][d] ][seq_step] + seq_transpose;
        seq_prev_vel[d] = seq_vel[ seq_patternchain[seq_chain_active_step][d] ][seq_step];
        if (seq_track_type[d] == 2) {  //Chords
          if (seq_vel[ seq_patternchain[seq_chain_active_step][d] ][seq_step] > 199)
          {
            handleNoteOn(configuration.dexed[seq_chord_dexed_inst].midi_channel, seq_data[ seq_patternchain[seq_chain_active_step][d] ][seq_step] + seq_transpose + seq_chords[seq_vel[ seq_patternchain[seq_chain_active_step][d] ][seq_step] - 200][0], seq_chord_velocity);
            handleNoteOn(configuration.dexed[seq_chord_dexed_inst].midi_channel, seq_data[ seq_patternchain[seq_chain_active_step][d] ][seq_step] + seq_transpose + seq_chords[seq_vel[ seq_patternchain[seq_chain_active_step][d] ][seq_step] - 200][1], seq_chord_velocity);
            handleNoteOn(configuration.dexed[seq_chord_dexed_inst].midi_channel, seq_data[ seq_patternchain[seq_chain_active_step][d] ][seq_step] + seq_transpose + seq_chords[seq_vel[ seq_patternchain[seq_chain_active_step][d] ][seq_step] - 200][2], seq_chord_velocity);
            handleNoteOn(configuration.dexed[seq_chord_dexed_inst].midi_channel, seq_data[ seq_patternchain[seq_chain_active_step][d] ][seq_step] + seq_transpose + seq_chords[seq_vel[ seq_patternchain[seq_chain_active_step][d] ][seq_step] - 200][3], seq_chord_velocity);
          }
        }
        else if (seq_track_type[d] == 3) {  //Arp
          arp_step = 0;
          arp_counter = 0;
          arp_note = seq_data[ seq_patternchain[seq_chain_active_step][d] ][seq_step] + seq_transpose;
          arp_chord = seq_vel[ seq_patternchain[seq_chain_active_step][d] ][seq_step];
        }
      }
    }
    if (seq_track_type[d] == 3)
    { //Arp
      if (arp_speed == 0 || (arp_speed == 1 && arp_counter == 2) ) {
        if (arp_step == 0 ) {
          handleNoteOn(configuration.dexed[seq_chord_dexed_inst].midi_channel, arp_note + arp_octave * 12 , seq_chord_velocity);
          arp_note_prev = arp_note + arp_octave * 12;
        }
        else
        { if (arp_style == 0) { //arp up
            handleNoteOn(configuration.dexed[seq_chord_dexed_inst].midi_channel, arp_note + seq_chords[arp_chord - 200][arp_step - 1] + arp_octave * 12, seq_chord_velocity);
            arp_note_prev = arp_note + seq_chords[arp_chord - 200][arp_step - 1] + arp_octave * 12;
          }
          else if (arp_style == 3) { //arp random
            uint8_t rnd1 = random(4);
            uint8_t rnd2 = random(arp_oct_usersetting + 1) * 12;
            handleNoteOn(configuration.dexed[seq_chord_dexed_inst].midi_channel, arp_note + seq_chords[arp_chord - 200][rnd1] + rnd2, seq_chord_velocity);
            arp_note_prev = arp_note + seq_chords[arp_chord - 200][rnd1] + rnd2;
          }
        }
      }
    }
    seq_noteoffsent[d] = false;
  }

  seq_step++;

  if (arp_speed == 0)  // Arp Speed 1/16
  {
    arp_step++;
  }
  else
  {
    if (arp_speed == 1) // Arp Speed 1/8
    {
      if (arp_counter > 1)  {
        arp_counter = 0;
        arp_step++;
      }
      arp_counter++;
    }
  }
  if (arp_step > 3 || seq_chords[arp_chord - 200][arp_step] == 0   ) {
    arp_step = 0;
    arp_octave++;
    if (arp_octave > arp_oct_usersetting) arp_octave = 0;
  }
  if (seq_step > 15) {
    seq_step = 0;
    if (seq_chain_lenght > 0) {
      seq_chain_active_step++;
      if (seq_chain_active_step > seq_chain_lenght)
      {
        seq_chain_active_step = 0;
      }
    }
  }
}

void sequencer_part2(void)
{
  for (uint8_t d = 0; d < 4; d++)
  {
    if ( seq_noteoffsent[d] == false) {
      if ( seq_prev_note[d] > 0 && seq_track_type[d] > 0)
      {
        handleNoteOff(configuration.dexed[seq_inst_dexed[d]].midi_channel, seq_prev_note[d] , 0);
        if (seq_track_type[d] == 2) {  //Chords
          if ( seq_prev_vel[d]  > 199)  {
            handleNoteOff(configuration.dexed[seq_chord_dexed_inst].midi_channel, seq_prev_note[d] + seq_chords[seq_prev_vel[d] - 200][0], 0);
            handleNoteOff(configuration.dexed[seq_chord_dexed_inst].midi_channel, seq_prev_note[d] + seq_chords[seq_prev_vel[d] - 200][1] , 0);
            handleNoteOff(configuration.dexed[seq_chord_dexed_inst].midi_channel, seq_prev_note[d] + seq_chords[seq_prev_vel[d] - 200][2] , 0);
            handleNoteOff(configuration.dexed[seq_chord_dexed_inst].midi_channel, seq_prev_note[d] + seq_chords[seq_prev_vel[d] - 200][3] , 0);
          }
        }
        else if (seq_track_type[d] == 3)
        { //Arp
          handleNoteOff(configuration.dexed[seq_chord_dexed_inst].midi_channel, arp_note_prev, 0);
        }
      }
      seq_noteoffsent[d] = true;
    }
  }
}


void sequencer(void)
{ // Runs in Interrupt Timer. Switches between the Noteon and Noteoff Task, each cycle

  interrupt_swapper = !interrupt_swapper;

  if (interrupt_swapper) sequencer_part1();
  else sequencer_part2();
}