#include <Arduino.h>
#include <I2S.h>
#include "Heavy_temp_a2960967.hpp"

// Erzeuge eine globale Heavy-Instanz
Heavy_temp_a2960967* hv = nullptr;
I2S i2s(OUTPUT);

#define SAMPLERATE 44100
#define BLOCKSIZE 64                 // Heavy block size
#define BUFFERSIZE (2 * BLOCKSIZE)   // Stereo interleaved

int16_t buffer[BUFFERSIZE];

inline int16_t float_to_i16(float x) {
    if (x > 1.0f) x = 1.0f;
    if (x < -1.0f) x = -1.0f;
    return (int16_t)(x * 32767.0f);
}

void codec_transmit() {

  // Testausgabe mit einem leeren Audiobuffer
  const int blockSize = 64;
  float output[2 * blockSize]; // 2 Kanäle interleaved

  // DSP verarbeiten
  hv->processInlineInterleaved(nullptr, output, blockSize);

  for (int i = 0; i < 2*blockSize; i++) {
    buffer[i] = float_to_i16(output[i]);
    //buffer[i] = random(-12000, 12000);
  }

  i2s.write((const uint8_t *)&buffer, BUFFERSIZE * sizeof(int16_t));
}

void setup() {
  i2s.setSysClk(SAMPLERATE);
  Serial.begin(115200);
  while (!Serial) {
    // Ausgabe auf USB-Seriell *versuchen* (zeigt sich erst bei Verbindung)
    Serial.print(".");
    delay(100);
  }
  Serial.println("\nSerial connected!");
  Serial.println("Heavy DSP Test startet...");

  // Heavy-Context initialisieren (44.1 kHz z. B.)
  hv = new Heavy_temp_a2960967(SAMPLERATE);

  if (hv) {
    Serial.println("Heavy context erfolgreich erstellt!");
  } else {
    Serial.println("Fehler: Heavy context konnte nicht erstellt werden.");
  }
  i2s.onTransmit(codec_transmit);
  i2s.setDATA(8);  // DAC DIN
  i2s.setBCLK(6);  // Note: LRCLK = BCLK + 1
  i2s.setMCLK(9);
  i2s.setMCLKmult(256);  // 256 = 12.288.000Hz 512 = 25MHz
//  i2s.swapClocks();
  i2s.setFrequency(SAMPLERATE);
  i2s.setBitsPerSample(16);

  i2s.setBuffers(4, BUFFERSIZE * sizeof(int16_t) / sizeof(uint32_t));

  if (!i2s.begin(SAMPLERATE)) {
    Serial.println("0: I2S error!");
    while (100);
  }
  
  delay(100);
}

void loop() {
  
}