#pragma GCC diagnostic ignored "-Wno-expansion-to-defined"
 
#include <MozziGuts.h>
#include <Oscil.h>
#include <tables/saw_analogue512_int8.h> // oscillator waveform
#include <tables/cos2048_int8.h> // filter modulation waveform
#include <LowPassFilter.h>
#include <mozzi_rand.h>  // for rand()
#include <mozzi_midi.h>  // for mtof()

#define NUM_VOICES 5

Oscil<SAW_ANALOGUE512_NUM_CELLS, AUDIO_RATE> aOscs [NUM_VOICES];

Oscil<COS2048_NUM_CELLS, CONTROL_RATE> kFilterMod(COS2048_DATA);

LowPassFilter lpf;
uint8_t resonance = 170; // range 0-255, 255 is most resonant

uint8_t notes[] = {33, 34, 31}; // possible notes to play MIDI A1, A1#, G1
uint16_t note_duration = 17500;
uint8_t note_id = 0;
uint32_t lastMillis = 0;

void setup() {
  // RP2040 defaults to GP0, from https://github.com/pschatzmann/Mozzi/
  // Mozzi.setPin(0,2); // this sets RP2040 GP2
  // Mozzi.setPin(0,16); // this sets RP2040 GP16  // MacroPad
  // Mozzi.setPin(0,16); // this sets RP2040 GP16  // Trinkey QT2040 GP16 
  // Mozzi.setPin(0,19); // this sets RP2040 GP19  // KB2040 GP19 pin 14 
   //Mozzi.setPin(0,29);  // this sets RP2040 GP29  // QT Py A0 
   // above doesn't work if Board set to QTPy RP2040
//  Mozzi.setPin(0,5);  // this sets RP2040 GP29  // QT Py RX
//  Mozzi.setPin(0,20);  // this sets RP2040 GP29  // QT Py TX
   
  Serial.begin(115200);
  
  startMozzi();
  kFilterMod.setFreq(0.08f);
  lpf.setCutoffFreqAndResonance(20, resonance);
  for( int i=0; i<NUM_VOICES; i++) { 
     aOscs[i].setTable(SAW_ANALOGUE512_DATA);
  }
  setNotes();
}

void loop() {
  audioHook();
}

void setNotes() {
  float f = mtof(notes[note_id]);
  for(int i=1;i<NUM_VOICES-1;i++) {
    aOscs[i].setFreq( f + (float)rand(100)/100); // orig 1.001, 1.002, 1.004
  }
  aOscs[NUM_VOICES-1].setFreq( (f/2) + (float)rand(100)/1000);
}

// mozzi function, called every CONTROL_RATE
void updateControl() {
  // filter range (0-255) corresponds with 0-8191Hz
  // oscillator & mods run from -128 to 127
  //byte cutoff_freq = 67 + kFilterMod.next()/2;
  byte cutoff_freq = analogRead(A0) / 16; 
  byte resonance = analogRead(A1) / 16; 
  lpf.setCutoffFreqAndResonance(cutoff_freq, resonance);
  
  if(rand(CONTROL_RATE) == 0) { // about once every second
    Serial.println("!");
    Serial.print(cutoff_freq); Serial.print(":"); Serial.print(resonance);
    kFilterMod.setFreq((float)rand(255)/4096);  // choose a new modulation frequency
    setNotes(); // wiggle the tuning a little
  }
  
  if( millis() - lastMillis > note_duration )  {
    lastMillis = millis();
    note_id = rand(3); // (note_id+1) % 3;
    Serial.print("note: "); Serial.println((byte)notes[note_id]);
    if( Serial.available() ) { 
      for(int i=1;i<NUM_VOICES-1;i++) {
        aOscs[i].setFreq( 0 ); // orig 1.001, 1.002, 1.004
      }
    }
  }
}

// mozzi function, called every AUDIO_RATE to output sample
AudioOutput_t updateAudio() {
  int16_t asig = (long) 0;
  for( int i=0; i<NUM_VOICES; i++) {
    asig += aOscs[i].next();
  }
  asig = lpf.next(asig);
  return MonoOutput::fromAlmostNBit(11, asig);
}