/*
    DeaDBeeF -- the music player
    Copyright (C) 2009-2021 Oleksiy Yakovenko and other contributors

    This software is provided 'as-is', without any express or implied
    warranty.  In no event will the authors be held liable for any damages
    arising from the use of this software.

    Permission is granted to anyone to use this software for any purpose,
    including commercial applications, and to alter it and redistribute it
    freely, subject to the following restrictions:

    1. The origin of this software must not be misrepresented; you must not
     claim that you wrote the original software. If you use this software
     in a product, an acknowledgment in the product documentation would be
     appreciated but is not required.

    2. Altered source versions must be plainly marked as such, and must not be
     misrepresented as being the original software.

    3. This notice may not be removed or altered from any source distribution.
*/
#include "analyzer.h"
#include <math.h>
#include <stdint.h>
#include <stdio.h>
#include <stdlib.h>
#include <string.h>

#define OCTAVES 11
#define STEPS 24
#define ROOT24 1.0293022366 // pow(2, 1.0 / STEPS)
#define C0 16.3515978313 // 440 * pow(ROOT24, -114);

#pragma mark - Forward declarations

static float
_get_bar_height (ddb_analyzer_t *analyzer, float normalized_height, int view_height);

static void
_generate_frequency_labels (ddb_analyzer_t *analyzer);

static void
_generate_frequency_bars (ddb_analyzer_t *analyzer);

static void
_generate_octave_note_bars (ddb_analyzer_t *analyzer);

static void
_tempered_scale_bands_precalc (ddb_analyzer_t *analyzer);

static float _bin_for_freq_floor (ddb_analyzer_t *analyzer, float freq);

static float _bin_for_freq_round (ddb_analyzer_t *analyzer, float freq);

static float _freq_for_bin (ddb_analyzer_t *analyzer, int bin);

static float
_interpolate_bin_with_ratio (float *fft_data, int bin, float ratio);

#pragma mark - Public

ddb_analyzer_t *
ddb_analyzer_alloc (void) {
    return calloc(1, sizeof (ddb_analyzer_t));
}

ddb_analyzer_t *
ddb_analyzer_init (ddb_analyzer_t *analyzer) {
    analyzer->mode = DDB_ANALYZER_MODE_FREQUENCIES;
    analyzer->min_freq = 50;
    analyzer->max_freq = 22000;
    analyzer->view_width = 1000;
    analyzer->peak_hold = 10;
    analyzer->peak_speed_scale = 1000.f;
    analyzer->db_lower_bound = -80;
    analyzer->octave_bars_step = 1;
    analyzer->bar_gap_denominator = 3;
    return analyzer;
}

void
ddb_analyzer_dealloc (ddb_analyzer_t *analyzer) {
    free (analyzer->tempered_scale_bands);
    free (analyzer->fft_data);
    memset (analyzer, 0, sizeof (ddb_analyzer_t));
}

void
ddb_analyzer_free (ddb_analyzer_t *analyzer) {
    free (analyzer);
}

void
ddb_analyzer_process (ddb_analyzer_t *analyzer, int samplerate, int channels, const float *fft_data, int fft_size) {
    int need_regenerate = 0;

    if (channels > 2) {
        channels = 2;
    }

    if (!analyzer->max_of_stereo_data) {
        channels = 1;
    }

    if (analyzer->mode_did_change || channels != analyzer->channels || fft_size != analyzer->fft_size || samplerate/2 != analyzer->fft_samplerate) {
        analyzer->channels = channels;
        analyzer->fft_size = fft_size;
        analyzer->fft_samplerate = samplerate/2;
        free (analyzer->fft_data);
        analyzer->fft_data = malloc (fft_size * channels * sizeof (float));
        need_regenerate = 1;
        analyzer->mode_did_change = 0;
    }

    memcpy (analyzer->fft_data, fft_data, fft_size * channels * sizeof (float));

    if (need_regenerate) {
        switch (analyzer->mode) {
        case DDB_ANALYZER_MODE_FREQUENCIES:
            _generate_frequency_bars (analyzer);
            break;
        case DDB_ANALYZER_MODE_OCTAVE_NOTE_BANDS:
            _generate_octave_note_bars (analyzer);
            break;
        }

        _generate_frequency_labels (analyzer);
    }
}

/// Update bars and peaks for the next frame
void
ddb_analyzer_tick (ddb_analyzer_t *analyzer) {
    if (analyzer->mode_did_change) {
        return; // avoid ticks until the next data update
    }
    // frequency lines
    for (int ch = 0; ch < analyzer->channels; ch++) {
        float *fft_data = analyzer->fft_data + ch * analyzer->fft_size;
        ddb_analyzer_bar_t *bar = analyzer->bars;
        for (int i = 0; i < analyzer->bar_count; i++, bar++) {
            float norm_h = _interpolate_bin_with_ratio (fft_data, bar->bin, bar->ratio);

            // if the bar spans more than one bin, find the max value
            for (int b = bar->bin+1; b <= bar->last_bin; b++) {
                float val = analyzer->fft_data[b];
                if (val > norm_h) {
                    norm_h = val;
                }
            }

            norm_h = norm_h;

            float bound = -analyzer->db_lower_bound;
            float height = (20*log10(norm_h) + bound)/bound;

            if (ch == 0) {
                bar->height = height;
            }
            else if (height > bar->height) {
                bar->height = height;
            }
        }
    }

    // peaks
    ddb_analyzer_bar_t *bar = analyzer->bars;
    for (int i = 0; i < analyzer->bar_count; i++, bar++) {
        if (bar->peak < bar->height) {
            bar->peak = bar->height;
            bar->peak_speed = analyzer->peak_hold;
        }

        if (bar->peak_speed-- < 0) {
            bar->peak += bar->peak_speed / analyzer->peak_speed_scale;
            if (bar->peak < bar->height) {
                bar->peak = bar->height;
            }
        }
    }
}

void
ddb_analyzer_get_draw_data (ddb_analyzer_t *analyzer, int view_width, int view_height, ddb_analyzer_draw_data_t *draw_data) {
    if (draw_data->bar_count != analyzer->bar_count) {
        free (draw_data->bars);
        draw_data->bars = calloc (analyzer->bar_count, sizeof (ddb_analyzer_draw_bar_t));
        draw_data->bar_count = analyzer->bar_count;
    }

    draw_data->mode = analyzer->mode;

    if (analyzer->mode == DDB_ANALYZER_MODE_FREQUENCIES) {
        draw_data->bar_width = 1;

        if (analyzer->enable_bar_index_lookup_table) {
            if (draw_data->bar_index_for_x_coordinate_table_size != view_width) {
                free (draw_data->bar_index_for_x_coordinate_table);
                draw_data->bar_index_for_x_coordinate_table = calloc (view_width
                                                                      , sizeof (int));
                draw_data->bar_index_for_x_coordinate_table_size = view_width;
            }
        }

    }
    else if (analyzer->mode == DDB_ANALYZER_MODE_OCTAVE_NOTE_BANDS) {
        if (analyzer->fractional_bars) {
            float width = (float)view_width / analyzer->bar_count;
            float gap = analyzer->bar_gap_denominator > 0 ? width/analyzer->bar_gap_denominator : 0;
            draw_data->bar_width = width - gap;
        }
        else {
            int width = view_width / analyzer->bar_count;
            int gap = analyzer->bar_gap_denominator > 0 ? width/analyzer->bar_gap_denominator : 0;
            if (gap < 1) {
                gap = 1;
            }
            if (width <= 1) {
                width = 1;
                gap = 0;
            }
            draw_data->bar_width = width - gap;
        }
    }

    if (draw_data->bar_index_for_x_coordinate_table != NULL) {
        memset(draw_data->bar_index_for_x_coordinate_table, 0xff, sizeof (int) * view_width);
    }

    ddb_analyzer_bar_t *bar = analyzer->bars;
    ddb_analyzer_draw_bar_t *draw_bar = draw_data->bars;
    for (int i = 0; i < analyzer->bar_count; i++, bar++, draw_bar++) {
        float height = bar->height;

        float xpos = bar->xpos * view_width;

        draw_bar->bar_height = _get_bar_height (analyzer, height, view_height);
        draw_bar->xpos = xpos;
        draw_bar->peak_ypos = _get_bar_height (analyzer, bar->peak, view_height);

        if (analyzer->mode == DDB_ANALYZER_MODE_FREQUENCIES
            && analyzer->enable_bar_index_lookup_table) {
            int lookup_index = (int)draw_bar->xpos;
            if (lookup_index < view_width
                && draw_data->bar_index_for_x_coordinate_table[lookup_index] == -1) {
                draw_data->bar_index_for_x_coordinate_table[lookup_index] = i;
            }
            if (lookup_index > 0
                && draw_data->bar_index_for_x_coordinate_table[lookup_index-1] == -1) {
                draw_data->bar_index_for_x_coordinate_table[lookup_index-1] = i;
            }
            if (lookup_index < view_width - 1
                && draw_data->bar_index_for_x_coordinate_table[lookup_index+1] == -1) {
                draw_data->bar_index_for_x_coordinate_table[lookup_index+1] = i;
            }
        }
    }

    memcpy (draw_data->label_freq_texts, analyzer->label_freq_texts, sizeof (analyzer->label_freq_texts));
    for (int i = 0; i < analyzer->label_freq_count; i++) {
        draw_data->label_freq_positions[i] = analyzer->label_freq_positions[i] * view_width;
    }
    draw_data->label_freq_count = analyzer->label_freq_count;
}

void
ddb_analyzer_draw_data_dealloc (ddb_analyzer_draw_data_t *draw_data) {
    free (draw_data->bars);
    free (draw_data->bar_index_for_x_coordinate_table);
    memset (draw_data, 0, sizeof(ddb_analyzer_draw_data_t));
}

#pragma mark - Private

static float
_get_bar_height (ddb_analyzer_t *analyzer, float normalized_height, int view_height) {
    float height = normalized_height;
    if (height < 0) {
        height = 0;
    }
    else if (height > 1) {
        height = 1;
    }
    height *= view_height;
    return height;
}

static void
_generate_frequency_labels (ddb_analyzer_t *analyzer) {
    float min_freq_log = log10 (analyzer->min_freq);
    float max_freq_log = log10 (analyzer->max_freq);
    float view_width = analyzer->view_width;
    float width_log = view_width / (max_freq_log - min_freq_log);

    // calculate the distance between any 2 neighbour labels
    float freq = 64000;
    float freq2 = 32000;
    float pos = width_log * (log10(freq) - min_freq_log) / view_width;
    float pos2 = width_log * (log10(freq2) - min_freq_log) / view_width;
    float dist = pos - pos2;

    // generate position and text for each label
    int index = 0;
    while (freq > 30 && index < DDB_ANALYZER_MAX_LABEL_FREQS) {
        analyzer->label_freq_positions[index] = pos;

        if (freq < 1000) {
            snprintf (analyzer->label_freq_texts[index], sizeof(analyzer->label_freq_texts[index]), "%d", (int)round(freq));
        }
        else {
            snprintf (analyzer->label_freq_texts[index], sizeof(analyzer->label_freq_texts[index]), "%dk", ((int)freq)/1000);
        }

        pos -= dist;
        freq /= 2;
        index += 1;
    }
    analyzer->label_freq_count = index;
}

static void
_generate_frequency_bars (ddb_analyzer_t *analyzer) {
    float min_freq_log = log10 (analyzer->min_freq);
    float max_freq_log = log10 (analyzer->max_freq);
    float view_width = analyzer->view_width;
    float width_log = view_width / (max_freq_log - min_freq_log);

    float minIndex = _bin_for_freq_floor (analyzer, analyzer->min_freq);
    float maxIndex = _bin_for_freq_round (analyzer, analyzer->max_freq);

    int prev = -1;

    analyzer->bar_count = 0;

    if (analyzer->bar_count_max != analyzer->view_width) {
        free (analyzer->bars);
        analyzer->bars = calloc (analyzer->view_width, sizeof (ddb_analyzer_bar_t));
        analyzer->bar_count_max = analyzer->view_width;
    }

    for (int i = minIndex; i <= maxIndex; i++) {
        float freq = _freq_for_bin (analyzer, i);

        // FIXME: only int position!
        int pos = width_log * (log10(freq) - min_freq_log);

        if (pos > prev && pos >= 0) {
            // start accumulating frequencies for the new band
            ddb_analyzer_bar_t *bar = analyzer->bars + analyzer->bar_count;

            bar->xpos = pos / view_width; // normalized position
            bar->bin = i;
            bar->ratio = 0;
            analyzer->bar_count += 1;

            prev = pos;
        }
    }
}

static void
_generate_octave_note_bars (ddb_analyzer_t *analyzer) {
    analyzer->bar_count = 0;

    _tempered_scale_bands_precalc (analyzer);

    if (analyzer->bar_count_max != OCTAVES * STEPS) {
        free (analyzer->bars);
        analyzer->bars = calloc (OCTAVES * STEPS, sizeof (ddb_analyzer_bar_t));
        analyzer->bar_count_max = OCTAVES * STEPS;
    }

    int minBand = -1;

    ddb_analyzer_bar_t *prev_bar = NULL;
    for (int i = 0; i < OCTAVES * STEPS; i += analyzer->octave_bars_step) {
        ddb_analyzer_band_t *band = &analyzer->tempered_scale_bands[i];

        if (band->freq < analyzer->min_freq || band->freq > analyzer->max_freq) {
            continue;
        }

        if (minBand == -1) {
            minBand = i;
        }

        ddb_analyzer_bar_t *bar = analyzer->bars + analyzer->bar_count;

        int bin = _bin_for_freq_floor(analyzer, band->freq);

        bar->bin = bin;
        bar->last_bin = 0;
        bar->ratio = 0;

        // interpolation ratio of next bin of previous bar to the first bin of this bar
        if (prev_bar && bin-1 > prev_bar->bin) {
            prev_bar->last_bin = bin-1;
        }

        analyzer->bar_count += 1;

        // get interpolation ratio to the next bin
        int bin2 = bin+1;
        if (bin2 < analyzer->fft_size) {
            float p = log10(band->freq);
            float p1 = log10(_freq_for_bin(analyzer, bin));
            float p2 = log10(_freq_for_bin(analyzer, bin2));
            float d = p2-p1;
            bar->ratio = (p-p1)/d;
        }

        prev_bar = bar;
    }

    for (int i = 0; i < analyzer->bar_count; i++) {
        analyzer->bars[i].xpos = (float)i/analyzer->bar_count;
    }
}

static float _bin_for_freq_floor (ddb_analyzer_t *analyzer, float freq) {
    float max = analyzer->fft_size - 1;
    float bin = floor (freq * analyzer->fft_size / analyzer->fft_samplerate);
    return bin < max ? bin : max;
}

static float _bin_for_freq_round (ddb_analyzer_t *analyzer, float freq) {
    float max = analyzer->fft_size - 1;
    float bin = round (freq * analyzer->fft_size / analyzer->fft_samplerate);
    return bin < max ? bin : max;
}

static float _freq_for_bin (ddb_analyzer_t *analyzer, int bin) {
    return (int64_t)bin * analyzer->fft_samplerate / analyzer->fft_size;
}

// Precalculate data for tempered scale
static void
_tempered_scale_bands_precalc (ddb_analyzer_t *analyzer) {
    if (analyzer->tempered_scale_bands != NULL) {
        return;
    }

    analyzer->tempered_scale_bands = calloc (OCTAVES * STEPS, sizeof (ddb_analyzer_band_t));

    for (int i = 0; i < OCTAVES * STEPS; i++) {
        float f = C0 * pow(ROOT24, i);
        float bin = _bin_for_freq_floor (analyzer, f);
        float binf  = _freq_for_bin (analyzer, bin);
        float fn = _freq_for_bin (analyzer, bin+1);
        float ratio = (f - binf) / (fn - binf);

        analyzer->tempered_scale_bands[i].bin = bin;
        analyzer->tempered_scale_bands[i].freq = f;
        analyzer->tempered_scale_bands[i].ratio = ratio;
    }
}

static float
_interpolate_bin_with_ratio (float *fft_data, int bin, float ratio) {
    float a = fft_data[bin];
    float b = fft_data[bin + 1];
    float result = a + (b - a) * ratio;

    // Don't allow to go lower than 0,
    // since log10(x<0) returns NaN,
    // which may result in visual glitches
    if (result < 0.f) {
        return 0.f;
    }
    return result;
}

