#include <Wire.h>

#include <bombatuino_INPUT_MCP23017.h>
#include <bombatuino_INPUT_74HC4051.h>
#include <bombatuino_MIDI.h>
#include <bombatuino_ROTARY_ENCODER.h>

MIDI Midi;

INPUT_MCP23017 input_MCP23017_0;
INPUT_MCP23017 input_MCP23017_1;
INPUT_MCP23017 input_MCP23017_3;
INPUT_MCP23017 input_MCP23017_4;

INPUT_74HC4051 input_4051_A0;
INPUT_74HC4051 input_4051_A1;
INPUT_74HC4051 input_4051_A2;

ROTARY_ENCODER rotary_encoder_jogwheel_left(rotary_encoder_jogwheel_left_inc, rotary_encoder_jogwheel_left_dec);
ROTARY_ENCODER rotary_encoder_jogwheel_right(rotary_encoder_jogwheel_right_inc, rotary_encoder_jogwheel_right_dec);
ROTARY_ENCODER rotary_encoder_browse(rotary_encoder_browse_inc,rotary_encoder_browse_dec);


void setup() {
  Midi.begin();
  input_MCP23017_0.begin(0,digitalCallback);
  input_MCP23017_1.begin(1,digitalCallback1);
  input_MCP23017_3.begin(3,digitalCallback3);
  input_MCP23017_4.begin(4,digitalCallback);
  
  input_4051_A0.begin(A0,8,9,10,analogCallback);
  input_4051_A1.begin(A1,8,9,10,analogCallback);
  input_4051_A2.begin(A2,8,9,10,analogCallback);
}

void loop() {
  input_MCP23017_0.loop(); 
  input_MCP23017_1.loop(); 
  input_MCP23017_3.loop(); 
  input_MCP23017_4.loop(); 
  input_4051_A0.loop();
  input_4051_A1.loop();
  input_4051_A2.loop();
}

void analogCallback(int id, int pin, int value) {
  Midi.controlChange((id-A0) * 8 + pin,value);
}

void digitalCallback(int id, int pin, int value) {
    if (value == HIGH)
      Midi.noteOn(id * 16 + pin, MIDI_MAX_DATA);
    else Midi.noteOff(id * 16 + pin);
}


void digitalCallback1(int id, int pin, int value) {
    if (pin == 6)
      rotary_encoder_jogwheel_left.setPinA(value);
    if (pin == 7)
      rotary_encoder_jogwheel_left.setPinB(value);
    if (pin != 6 && pin !=7) {
        if (value == HIGH)
          Midi.noteOn(id * 16 + pin, MIDI_MAX_DATA);
        else Midi.noteOff(id * 16 + pin);
    }
}

void digitalCallback3(int id, int pin, int value) {
    if (pin == 9)
      rotary_encoder_jogwheel_right.setPinA(value);
    if (pin == 10)
      rotary_encoder_jogwheel_right.setPinB(value);
    if (pin == 6)
      rotary_encoder_browse.setPinA(value);
    if (pin == 5)
      rotary_encoder_browse.setPinB(value);
    if (pin!= 9 && pin != 10 && pin != 6 && pin != 5){
        if (value == HIGH)
          Midi.noteOn(id * 16 + pin, MIDI_MAX_DATA);
        else Midi.noteOff(id * 16 + pin);
    }
}

//left jogwheel
void rotary_encoder_jogwheel_left_inc() {
  Midi.controlChange(MIDI_MAX_DATA-5,65);
}

void rotary_encoder_jogwheel_left_dec() {
  Midi.controlChange(MIDI_MAX_DATA-5,63);
}

//right jogwheel
void rotary_encoder_jogwheel_right_inc() {
  Midi.controlChange(MIDI_MAX_DATA-6,65);
}

void rotary_encoder_jogwheel_right_dec() {
  Midi.controlChange(MIDI_MAX_DATA-6,63);
}

//Browse
void rotary_encoder_browse_inc() {
  Midi.noteOn(3 * 16 + 6, MIDI_MAX_DATA);
  Midi.noteOff(3 * 16 + 6);
}

void rotary_encoder_browse_dec() {
  Midi.noteOn(3 * 16 + 5, MIDI_MAX_DATA);
  Midi.noteOff(3 * 16 + 5);
}