#include "pipe.h"
#include "fingering.h"
#include "tuning.h"

// Kludge time: this is something I did just to make my breadboard look nicer.
#define KEY_OFFSET 2

#define CLOSEDVAL 0x30
#define OPENVAL 0x70
#define GLISSANDO_STEPS (OPENVAL - CLOSEDVAL)

Pipe::Pipe() {
  keysLast = 0;
}

bool Pipe::Init() {
  // Capacative touch sensor
  if (!capSensor.begin(0x5A)) {
    return false;
  }

  // Proximity sensor
  if (paj7620Init()) {
    return false;
  }

  // Bag button
  bagSensor.begin();
  // This library takes the entire program out if you poll it 5-40 times without anything connected
  bag_enabled = bagSensor.isConnected();

  return true;
}

void Pipe::Update() {
  uint8_t glissandoKeys = 0;

  // Read the bag state, if there's a bag.
  // if there isn't a bag, don't try, or this library will crash the program.
  if (bag_enabled) {
    bag = bagSensor.isPressed();
  } else {
    bag = false;
  }

  // 0x6c is actually 8 bytes, but all 8 are always the same...
  paj7620ReadReg(0x6c, 1, &kneeClosedness);

  keysLast = keys;
  keys = 0;
  glissandoKeys = 0;
  for (int i = 0; i < 8; i++) {
    uint16_t val = max(capSensor.filteredData(i + KEY_OFFSET), CLOSEDVAL);
    float openness = ((val - CLOSEDVAL) / float(GLISSANDO_STEPS));

    // keys = all keys which are at least touched
    // glissandoKeys = all keys which are fully closed
    // The glissando operation computes the difference.
    if (openness < 1.0) {
      glissandoOpenness = max(glissandoOpenness, openness);
      bitSet(keys, i);
    }
    if (openness == 0.0) {
      bitSet(glissandoKeys, i);
    }
  }

  // Look up notes in the big table
  struct Fingering f = uilleann_matrix[keys];
  struct Fingering gf = uilleann_matrix[glissandoKeys];

  note = f.note;
  glissandoNote = gf.note;

  // Was the high bit set? That indicates "alternate fingering", which sounds different.
  altFingering = f.alt;

  // If the bag is squished, jump up an octave
  // But only if the left thumb is down!
  if (bag && (keys & bit(7))) {
    note += NOTE_OCTAVE;
    glissandoNote += NOTE_OCTAVE;
  }

  // All keys closed + knee = no sound
  silent = ((kneeClosedness > 240) && (keys == 0xff));
}

bool Pipe::Pressed(uint8_t key) {
  return bitRead(keys, key);
}

bool Pipe::JustPressed(uint8_t key) {
  if (bitRead(keys, key)) {
    return !bitRead(keysLast, key);
  }
  return false;
}