#include <libavformat/avformat.h>
#include <libavcodec/avcodec.h>
#include <libavcodec/avfft.h>
#include <libavutil/audio_fifo.h>
#include <libswresample/swresample.h>

#define R_NO_REMAP
#define STRICT_R_HEADERS
#include <Rinternals.h>
#include "avcompat.h"

enum AmplitudeScale { AS_LINEAR, AS_SQRT, AS_CBRT, AS_LOG, NB_ASCALES };

extern int total_open_handles;

typedef struct {
  int completed;
  AVFormatContext *demuxer;
  AVCodecContext *decoder;
  AVStream *stream;
} input_container;

typedef struct {
  uint8_t *buf;
  SwrContext *swr;
  FFTContext *fft;
  FFTComplex *fft_data;
  AVAudioFifo *fifo;
  input_container *input;
  int channels;
  int winsize;
  float overlap;
  float *winvec;
  float *src_data;
  double *dst_dbl;
  int *dst_int;
  int64_t end_pts;
} spectrum_container;

static size_t round_up(size_t v){
  if(v == 0)
    return 0;
  v--;
  v |= v >> 1;
  v |= v >> 2;
  v |= v >> 4;
  v |= v >> 8;
  v |= v >> 16;
  /* 64 bit only */
#if SIZE_MAX > 4294967296
  v |= v >> 32;
#endif
  return ++v;
}

static void bail_if(int ret, const char * what){
  if(ret < 0)
    Rf_errorcall(R_NilValue, "FFMPEG error in '%s': %s", what, av_err2str(ret));
}

static void bail_if_null(const void * ptr, const char * what){
  if(!ptr)
    bail_if(-1, what);
}

static input_container * new_input_container(AVFormatContext *demuxer, AVCodecContext *decoder, AVStream *stream){
  input_container *out = (input_container*) av_mallocz(sizeof(input_container));
  out->demuxer = demuxer;
  out->stream = stream;
  out->decoder = decoder;
  return out;
}

static void close_input(input_container **x){
  input_container *input = *x;
  if(input == NULL)
    return;
  avcodec_close(input->decoder);
  avcodec_free_context(&(input->decoder));
  avformat_close_input(&input->demuxer);
  avformat_free_context(input->demuxer);
  av_free(input);
  *x = NULL;
}

static void close_spectrum_container(void *ptr, Rboolean jump){
  total_open_handles--;
  spectrum_container *s = ptr;
  if(s->input)
    close_input(&s->input);
  if(s->fft)
    av_fft_end(s->fft);
  if(s->fifo)
    av_audio_fifo_free(s->fifo);
  if(s->swr)
    swr_free(&s->swr);
  if(s->winvec)
    av_free(s->winvec);
  if(s->fft_data)
    av_free(s->fft_data);
  if(s->src_data)
    av_free(s->src_data);
  if(s->dst_dbl)
    av_free(s->dst_dbl);
  if(s->dst_int)
    av_free(s->dst_int);
  if(s->buf)
    av_freep(&s->buf);
}

static int find_stream_type(AVFormatContext *demuxer, enum AVMediaType type){
  for (int si = 0; si < demuxer->nb_streams; si++) {
    AVStream *stream = demuxer->streams[si];
    if(stream->codecpar->codec_type == type)
      return si;
  }
  return -1;
}

static int find_stream_audio(AVFormatContext *demuxer, const char *file){
  int out = find_stream_type(demuxer, AVMEDIA_TYPE_AUDIO);
  if(out < 0){
    avformat_close_input(&demuxer);
    avformat_free_context(demuxer);
    Rf_error("Input %s does not contain suitable audio stream", file);
  }
  return out;
}

static input_container *open_input(const char *filename){
  AVFormatContext *demuxer = NULL;
  bail_if(avformat_open_input(&demuxer, filename, NULL, NULL), "avformat_open_input");
  bail_if(avformat_find_stream_info(demuxer, NULL), "avformat_find_stream_info");

  /* Try all input streams */
  int si = find_stream_audio(demuxer, filename);
  AVStream *stream = demuxer->streams[si];
  const AVCodec *codec = avcodec_find_decoder(stream->codecpar->codec_id);
  bail_if_null(codec, "avcodec_find_decoder");
  AVCodecContext *decoder = avcodec_alloc_context3(codec);
  bail_if(avcodec_parameters_to_context(decoder, stream->codecpar), "avcodec_parameters_to_context");
  bail_if(avcodec_open2(decoder, codec, NULL), "avcodec_open2 (audio)");
#ifdef NEW_CHANNEL_API
  if (decoder->ch_layout.order == AV_CHANNEL_ORDER_UNSPEC)
    av_channel_layout_default(&decoder->ch_layout, decoder->ch_layout.nb_channels);
#else
  if(!decoder->channel_layout)
    decoder->channel_layout = av_get_default_channel_layout(decoder->channels);
#endif
  return new_input_container(demuxer, decoder, demuxer->streams[si]);
}

static double amp_scale(double a, int ascale){
  double min = 1e-6;
  switch(ascale) {
  case AS_SQRT:
    return 1.0 - sqrt(a);
  case AS_CBRT:
    return 1.0 - cbrt(a);
  case AS_LOG:
    return log(av_clipd(a, min, 1)) / log(min);
  case AS_LINEAR:
    return 1.0 - a;
  }
  return a;
}

/* https://stackoverflow.com/questions/14989397/how-to-convert-sample-rate-from-av-sample-fmt-fltp-to-av-sample-fmt-s16 */
#ifdef NEW_CHANNEL_API
static SwrContext *create_resampler(AVCodecContext *decoder, int64_t sample_rate, AVChannelLayout layout, enum AVSampleFormat fmt){
  SwrContext *swr = swr_alloc();
  swr_alloc_set_opts2(&swr, &layout, fmt, sample_rate,
                                       &decoder->ch_layout, decoder->sample_fmt, decoder->sample_rate, 0, NULL);
#else
static SwrContext *create_resampler(AVCodecContext *decoder, int64_t sample_rate, int64_t layout, enum AVSampleFormat fmt){
  SwrContext *swr = swr_alloc_set_opts(NULL, layout, fmt, sample_rate,
    decoder->channel_layout, decoder->sample_fmt, decoder->sample_rate, 0, NULL);
#endif
  bail_if(swr_init(swr), "swr_init");
  return swr;
}

static SwrContext *create_resampler_fft(AVCodecContext *decoder, int64_t sample_rate){
#ifdef NEW_CHANNEL_API
  AVChannelLayout layout = {0};
  av_channel_layout_default(&layout, 1);
  return create_resampler(decoder, sample_rate, layout, AV_SAMPLE_FMT_FLTP);
#else
  return create_resampler(decoder, sample_rate, AV_CH_LAYOUT_MONO, AV_SAMPLE_FMT_FLTP);
#endif
}

static SwrContext *create_resampler_bin(AVCodecContext *decoder, int64_t sample_rate, int channels){
#ifdef NEW_CHANNEL_API
  AVChannelLayout layout = {0};
  av_channel_layout_default(&layout, channels);
  return create_resampler(decoder, sample_rate, layout, AV_SAMPLE_FMT_S32);
#else
  return create_resampler(decoder, sample_rate, av_get_default_channel_layout(channels), AV_SAMPLE_FMT_S32);
#endif
}

static float *to_float(SEXP window){
  size_t n = Rf_length(window);
  double *input = REAL(window);
  float *output = av_calloc(n, sizeof(*output));
  for(int i = 0; i < n; i++)
    output[i] = (float) input[i];
  return output;
}

static double calc_window_scale(int winsize, float *winvec){
  double scale = 0;
  for (int i = 0; i < winsize; i++) {
    scale += winvec[i] * winvec[i];
  }
  return scale;
}

static SEXP run_fft(spectrum_container *output, int ascale){
  AVPacket *pkt = av_packet_alloc();
  AVFrame *frame = av_frame_alloc();
  input_container * input = output->input;
  int fft_size = output->winsize;
  float overlap = output->overlap;
  int fft_bits = av_log2(fft_size);
  int window_size = 1 << fft_bits;
  int hop_size = window_size * (1 - overlap);
  int output_range = window_size / 2;
  int iter = 0;
  output->fft = av_fft_init(fft_bits, 0);
  output->fft_data = av_calloc(window_size, sizeof(*output->fft_data));
  output->src_data = av_calloc(window_size, sizeof(*output->src_data));
  output->fifo = av_audio_fifo_alloc(AV_SAMPLE_FMT_FLTP, 1, window_size);
  av_samples_alloc(&output->buf, NULL, 1, 4 * output->winsize, AV_SAMPLE_FMT_FLTP, 0);
  double winscale = calc_window_scale(output->winsize, output->winvec);
  int eof = 0;
  int64_t elapsed = 0;
  while(!eof){

    /* Step 1: fill the FIFO with audio samples */
    while(!eof && av_audio_fifo_size(output->fifo) < window_size){
      int ret = avcodec_receive_frame(input->decoder, frame);
      if(ret == AVERROR(EAGAIN)){
        ret = av_read_frame(input->demuxer, pkt);
        if(ret == AVERROR_EOF){
          bail_if(avcodec_send_packet(input->decoder, NULL), "avcodec_send_packet (flush)");
        } else {
          bail_if(ret, "av_read_frame");
          if(pkt->stream_index == input->stream->index){
            //av_packet_rescale_ts(pkt, input->stream->time_base, input->decoder->time_base);
            bail_if(avcodec_send_packet(input->decoder, pkt), "avcodec_send_packet (audio)");

            /* Check for elapsed time limit */
            elapsed = av_rescale_q(pkt->pts, input->stream->time_base, AV_TIME_BASE_Q);
            if(output->end_pts > 0 && elapsed > output->end_pts)
              eof = 1;
            av_packet_unref(pkt);
          }
        }
      } else if(ret == AVERROR_EOF){
        eof = 1;
        break;
      } else {
        bail_if(ret, "avcodec_receive_frame");
        /* https://ffmpeg.org/doxygen/3.2/group__lavu__sampmanip.html#ga4db4c77f928d32c7d8854732f50b8c04
         * 4x is a conservative multiplier for when the input samle_fmt is smaller than 32 bit (such as flac)*/
        int out_samples = swr_convert (output->swr, &output->buf, 4 * output->winsize, (const uint8_t**) frame->extended_data, frame->nb_samples);
        bail_if(out_samples, "swr_convert");
        av_frame_unref(frame);
        int nb_written = av_audio_fifo_write(output->fifo, (void **) &output->buf, out_samples);
        bail_if(nb_written, "av_audio_fifo_write");
      }
      R_CheckUserInterrupt();
    }

    /* Step 2: read samples from the FIFO and store transformed data */
    while ((av_audio_fifo_size(output->fifo) >= window_size) || (av_audio_fifo_size(output->fifo) > 0 && eof)) {
      int n_samples = av_audio_fifo_peek(output->fifo, (void**) &(output->src_data), window_size);
      bail_if(n_samples, "av_audio_fifo_peek");
      const float *src = output->src_data;
      FFTComplex *fft_channel = output->fft_data;
      int n;
      for (n = 0; n < n_samples; n++) {
        fft_channel[n].re = src[n] * output->winvec[n];
        fft_channel[n].im = 0;
      }
      for (; n < window_size; n++) {
        fft_channel[n].re = 0;
        fft_channel[n].im = 0;
      }
      av_fft_permute(output->fft, fft_channel);
      av_fft_calc(output->fft, fft_channel);
      output->dst_dbl = av_realloc(output->dst_dbl, round_up((iter+1) * output_range * sizeof(*output->dst_dbl)));
      for (int n = 0; n < output_range; n++) {
        FFTSample re = fft_channel[n].re;
        FFTSample im = fft_channel[n].im;
        output->dst_dbl[iter * output_range + n] = amp_scale(sqrt(re*re + im*im) / winscale, ascale);
      }
      av_audio_fifo_drain(output->fifo, hop_size);
      R_CheckUserInterrupt();
      iter++;
    }
  }
  SEXP dims = PROTECT(Rf_allocVector(INTSXP, 2));
  INTEGER(dims)[0] = output_range;
  INTEGER(dims)[1] = iter;
  SEXP out = PROTECT(Rf_allocVector(REALSXP, iter * output_range));
  memcpy(REAL(out), output->dst_dbl, iter * output_range * sizeof(*output->dst_dbl));
  Rf_setAttrib(out, R_DimSymbol, dims);
  Rf_setAttrib(out, PROTECT(Rf_install("endtime")), Rf_ScalarReal((double) elapsed / AV_TIME_BASE));
  UNPROTECT(3);
  return out;
}

static SEXP run_bin(spectrum_container *output){
  AVPacket *pkt = av_packet_alloc();
  AVFrame *frame = av_frame_alloc();
  input_container * input = output->input;
  AVCodecContext *decoder = input->decoder;
  int max_frame_size = av_get_audio_frame_duration(decoder, 0);
  if(max_frame_size < 1){
    REprintf("Unknown frame size for input audio format: %s\n", decoder->codec->name);
    max_frame_size = 50000; /* Very high fallback, should hopefully never happen */
  }
  av_samples_alloc(&output->buf, NULL, output->channels, max_frame_size, AV_SAMPLE_FMT_S32, 0);
  int64_t elapsed = 0;
  int channels = output->channels;
  int samplesize = channels * av_get_bytes_per_sample(AV_SAMPLE_FMT_S32);
  int total_samples = 0;
  int eof = 0;
  while(!eof){
    int ret = avcodec_receive_frame(input->decoder, frame);
    if(ret == AVERROR(EAGAIN)){
      ret = av_read_frame(input->demuxer, pkt);
      if(ret == AVERROR_EOF){
        bail_if(avcodec_send_packet(input->decoder, NULL), "avcodec_send_packet (flush)");
      } else {
        bail_if(ret, "av_read_frame");
        if(pkt->stream_index == input->stream->index){
          bail_if(avcodec_send_packet(input->decoder, pkt), "avcodec_send_packet (audio)");
          elapsed = av_rescale_q(pkt->pts, input->stream->time_base, AV_TIME_BASE_Q);
          if(output->end_pts > 0 && elapsed > output->end_pts)
            eof = 1;
          av_packet_unref(pkt);
        }
      }
    } else if(ret == AVERROR_EOF){
      eof = 1;
      break;
    } else {
      bail_if(ret, "avcodec_receive_frame");
      int n_samples = swr_convert (output->swr, &output->buf, max_frame_size, (const uint8_t**) frame->extended_data, frame->nb_samples);
      bail_if(n_samples, "swr_convert");
      if(n_samples < frame->nb_samples)
        REprintf("Insufficient memory to recode all samples");
      av_frame_unref(frame);
      output->dst_int = av_realloc(output->dst_int, round_up((total_samples + n_samples) * samplesize));
      memcpy(output->dst_int + total_samples * channels, output->buf, n_samples * samplesize);
      total_samples = total_samples + n_samples;
    }
    R_CheckUserInterrupt();
  }
  R_xlen_t outlen = total_samples * channels;
  SEXP out = Rf_allocVector(INTSXP, outlen);
  memcpy(INTEGER(out), output->dst_int, total_samples * samplesize);
  for(int *ptr = INTEGER(out); ptr < INTEGER(out) + outlen; ptr++){
    if(*ptr == NA_INTEGER)
      *ptr = NA_INTEGER + 1;
  }
  return out;
}

static SEXP calculate_audio_fft(void *output){
  total_open_handles++;
  return run_fft(output, AS_LOG);
}

static SEXP calculate_audio_bin(void *output){
  total_open_handles++;
  return run_bin(output);
}

SEXP R_audio_fft(SEXP audio, SEXP window, SEXP overlap, SEXP sample_rate, SEXP start_time, SEXP end_time){
  spectrum_container *output = av_mallocz(sizeof(spectrum_container));
  output->winsize = Rf_length(window);
  output->winvec = to_float(window);
  output->overlap = Rf_asReal(overlap);
  output->input = open_input(CHAR(STRING_ELT(audio, 0)));
  AVCodecContext *decoder = output->input->decoder;
  int output_sample_rate = Rf_length(sample_rate) ? Rf_asInteger(sample_rate) : decoder->sample_rate;
  output->swr = create_resampler_fft(decoder, output_sample_rate);
  if(Rf_length(end_time)){
    output->end_pts = Rf_asReal(end_time) * AV_TIME_BASE;
  }
  if(Rf_length(start_time)){
    double pos = Rf_asReal(start_time);
    if(pos > 0)
      av_seek_frame(output->input->demuxer, -1, pos * AV_TIME_BASE, AVSEEK_FLAG_ANY);
  }
  SEXP out = PROTECT(R_UnwindProtect(calculate_audio_fft, output, close_spectrum_container, output, NULL));
  Rf_setAttrib(out, PROTECT(Rf_install("sample_rate")), Rf_ScalarInteger(output_sample_rate));
  UNPROTECT(2);
  return out;
}

SEXP R_audio_bin(SEXP audio, SEXP channels, SEXP sample_rate, SEXP start_time, SEXP end_time){
  spectrum_container *output = av_mallocz(sizeof(spectrum_container));
  output->input = open_input(CHAR(STRING_ELT(audio, 0)));
  if(Rf_length(end_time)){
    output->end_pts = Rf_asReal(end_time) * AV_TIME_BASE;
  }
  if(Rf_length(start_time)){
    double pos = Rf_asReal(start_time);
    if(pos > 0)
      av_seek_frame(output->input->demuxer, -1, pos * AV_TIME_BASE, AVSEEK_FLAG_ANY);
  }
  AVCodecContext *decoder = output->input->decoder;
  int output_sample_rate = Rf_length(sample_rate) ? Rf_asInteger(sample_rate) : decoder->sample_rate;
#ifdef NEW_CHANNEL_API
  int output_channels = Rf_length(channels) ? Rf_asInteger(channels) : decoder->ch_layout.nb_channels;
#else
  int output_channels = Rf_length(channels) ? Rf_asInteger(channels) : decoder->channels;
#endif
  output->channels = output_channels;
  output->swr = create_resampler_bin(output->input->decoder, output_sample_rate, output_channels);
  SEXP out = PROTECT(R_UnwindProtect(calculate_audio_bin, output, close_spectrum_container, output, NULL));
  Rf_setAttrib(out, PROTECT(Rf_install("channels")), Rf_ScalarInteger(output_channels));
  Rf_setAttrib(out, PROTECT(Rf_install("sample_rate")), Rf_ScalarInteger(output_sample_rate));
  UNPROTECT(3);
  return out;
}
