#include "pwmclass.h"
#include "GsmDecoder.h"

GsmDecoder::GsmDecoder(FIFO<PText, FIFOLEN> & f) noexcept : OneWay(), fifo(f), gsm() {
}
static constexpr int      INPUT_BIT_RANGE = 16;
static constexpr unsigned SIGMA_MASK      = (1u << (INPUT_BIT_RANGE  + 0)) - 1u;
static constexpr unsigned SIGNED_OFFEST   = (1u << (INPUT_BIT_RANGE  - 1));
 // Předpokládá se na vstupu signed int o šířce INPUT_BIT_RANGE
 // přičemž 0 na vstupu odpovídá MAXPWM / 2 na výstupu. Vypadá to divně, ale funguje.
static unsigned pwm_sd (const int input) {
  static unsigned sigma  = 0;   // podstatné je, že proměnná je statická
  const  unsigned sample = (input + SIGNED_OFFEST) * MAXPWM;
  sigma &= SIGMA_MASK;          // v podstatě se odečte hodnota PWM
  sigma += sample;              // integrace prostým součtem
  return sigma  >> INPUT_BIT_RANGE;
}
unsigned GsmDecoder::Send(uint16_t * dptr, const unsigned len) {
  PText source;
  if (fifo.Read(source)) {
    gsm_frame tmp;
    memcpy (tmp, source.get(), sizeof(gsm_frame));
    gsm.decode(tmp, tmpbuf);
    for (unsigned n=0u, k=0u; k<len; n++) {
      const int16_t s = tmpbuf[n];
      dptr [k++] = pwm_sd (s);    // vyzkoušená metoda jak vylepšit PWM
      dptr [k++] = pwm_sd (s);    // pokud máme frekvenci PWM větší
      dptr [k++] = pwm_sd (s);    // než vzorkovací frekvence signálu ft = n * fs, n = 3
    }
    return GSMLEN;
  }
  for (unsigned n=0u; n<len; n++) {
    dptr [n] = MAXPWM >> 1;
  }
  return 0;
}