/*
http://arduinomidilib.fortyseveneffects.com/a00025.html
*/

#include "Structs.h"
#include "MIDI.h"
#include "midi_Defs.h"
#include "midi_Message.h"
#include "midi_Namespace.h"
#include "midi_Settings.h"

/**
#include <MIDI.h>
#include <midi_Defs.h>
#include <midi_Message.h>
#include <midi_Namespace.h>
#include <midi_Settings.h>
**/
//#define DEBUG

#define MIN_SPEED 100
#define MAX_SPEED 10000
#define MIDI_CHANNEL 4

#define PINS 15
int pinArray[] = {13, 12, 11, 10, 9, 8, 7, 6, 5, 4, 3, 2, 14, 15, 16};

int timer = 100;
int currentSpeaker=0;
boolean goingBack=false;

Timer change;
unsigned long currentTime;


MIDI_CREATE_DEFAULT_INSTANCE();

void startTimer(Timer* timer,long interval,boolean repeat,void (*callbackFunction)());



void handleNoteOn(byte inChannel, byte inNote, byte inVelocity)
{
  if(inNote<PINS)
  {
    //doloci zvocnik po noti
     digitalWrite(pinArray[currentSpeaker],LOW);
     digitalWrite(pinArray[inNote],HIGH);
     currentSpeaker=inNote;
     stopTimer(&change);

  }
  else if(inNote==PINS)
  {
     startTimer(&change,speedWithVelocity(127-inVelocity),true,stepUp);
  }
  else if(inNote==(PINS+1))
  {
     startTimer(&change,speedWithVelocity(127-inVelocity),true,stepDown);
  }
  else if(inNote==(PINS+2))
  {
    startTimer(&change,speedWithVelocity(127-inVelocity),true,rnd);
  }
  else if(inNote==(PINS+3))
  {
    startTimer(&change,speedWithVelocity(127-inVelocity),true,pingPong);
  }
  
  
  
#ifdef DEBUG
    for (byte i=0;i<inNote;i++)
    {
        digitalWrite(13,HIGH);
        delay(30);
        digitalWrite(13,LOW);
        delay(30);
    }
#endif
}



void setup(){
 // pinMode(0,INPUT_PULLUP);
  pinMode(13,OUTPUT);
  randomSeed(analogRead(0));
  MIDI.setHandleNoteOn(handleNoteOn);
  MIDI.begin(MIDI_CHANNEL); 
  for (int i=0;i<PINS;i++) {
    pinMode(pinArray[i], OUTPUT);
  }
  digitalWrite(currentSpeaker,HIGH);
  
  currentTime = millis();
  startTimer(&change,640,true,stepUp);
}

void loop() {
  currentTime = millis();
  MIDI.read();
  checkTimer(&change);
}


int speedWithVelocity(byte velocity)
{
   return round(MIN_SPEED+(float)velocity/127.0*(MAX_SPEED-MIN_SPEED));
}

void stepUp()
{
   int nextSpeaker=(currentSpeaker+1)%PINS;
    digitalWrite(pinArray[currentSpeaker], LOW);
    digitalWrite(pinArray[nextSpeaker], HIGH);
    currentSpeaker=nextSpeaker;
}

void stepDown()
{
   int nextSpeaker=currentSpeaker-1;
   if(nextSpeaker<0)nextSpeaker=PINS-1;
    digitalWrite(pinArray[currentSpeaker], LOW);
    digitalWrite(pinArray[nextSpeaker], HIGH);
    currentSpeaker=nextSpeaker;
}

void pingPong()
{
   if(!goingBack)
   {
     if(currentSpeaker<PINS-1)stepUp();
     else 
     {
       goingBack=true;
       stepDown();
     }
     if(currentSpeaker>0)stepDown();
     else 
     {
       goingBack=false;
       stepUp();
     }
   }
}

void rnd()
{
   int nextSpeaker=random(PINS);
    digitalWrite(pinArray[currentSpeaker], LOW);
    digitalWrite(pinArray[nextSpeaker], HIGH);
    currentSpeaker=nextSpeaker;
}


void startTimer(Timer* timer,long interval,boolean repeat,void (*callbackFunction)())
{
  // Serial.println("timer started");
  timer->startTime=currentTime;
  timer->interval=interval;
  timer->repeat=repeat;
  timer->callbackFunction=*callbackFunction;
  timer->running=true;
}




void checkTimer(Timer* timer)
{

  //Serial.println("timer check");
  if(timer->running && (currentTime - timer->startTime > timer->interval))
  {
    timer->callbackFunction();
    //Serial.println("timer step");

    if(timer->repeat)
    {
      //resetTimer
      timer->startTime=currentTime;
      // Serial.println("timer reset");
    }
    else
    {
      //stopTimer
      timer->running=false;
    }
  }
}

void stopTimer(Timer* timer)
{
  timer->running=false;
}