/*
 * Copyright (C) 2018, Hogeschool Rotterdam, Harry Broeders
 * All rights reserved.
 */

#include <stdint.h>
#include <stddef.h>
#include <stdio.h>
#include <NoRTOS.h>

#include <ti/devices/cc32xx/inc/hw_memmap.h>
#include <ti/devices/cc32xx/inc/hw_types.h>
#include <ti/devices/cc32xx/driverlib/prcm.h>
#include <ti/devices/cc32xx/driverlib/i2s.h>
#include <ti/drivers/I2C.h>

#include "ti_drivers_config.h"
#include "config.h"

// You can select the sample rate here:
#define SAMPLINGFREQUENCY 8000
#if SAMPLINGFREQUENCY < 8000 || SAMPLINGFREQUENCY > 48000 || SAMPLINGFREQUENCY % 4000 != 0
#error Sampling Frequency must be between 8 kHz and 48 kHz (included) and must be a multiple of 4 kHz.
#endif

#define N 15

const int BL = 15;
const int16_t B[15] = {
    -2321,  -3829,  -3249,      0,   5415,  11486,  16244,  18043,  16244,
    11486,   5415,      0,  -3249,  -3829,  -2321
};

int16_t buffer_R[N];

int main(void)
{
    // Init CC3220S LAUNCHXL board.
    Board_initGeneral();
    // Prepare to use TI drivers without operating system.
    NoRTOS_start();

    printf("line-in_2_line_out: STEREO LINE IN ==> HP LINE OUT.\n");
    printf("Sampling frequency = %d Hz.\n", SAMPLINGFREQUENCY);

    // Configure an I2C connection which is used to configure the audio codec.
    I2C_Handle i2cHandle = ConfigureI2C(CONFIG_I2C_0, I2C_400kHz);
    // Configure the audio codec.
    ConfigureAudioCodec(i2cHandle, SAMPLINGFREQUENCY);

    // Configure an I2S connection which is use to send/receive samples to/from the codec.
    ConfigureI2S(CONFIG_I2S_0, I2S_BASE, SAMPLINGFREQUENCY);
    unsigned long n = 0;
    unsigned long dataLeft, dataRight;
    int k;
    while (1)
    {
        long outR, v;
        // The 16-bit samples are stored in 32-bit variables because the API also supports 24-bit samples.
        I2SDataGet(I2S_BASE, I2S_DATA_LINE_1, &dataLeft);
        //dataLeft = dataLeft ;//+ (buffer_L[n % N] / 2);
        // You can process the 16-bit left sample here.
        I2SDataPut(I2S_BASE, I2S_DATA_LINE_0,(int16_t) 0);
        I2SDataGet(I2S_BASE, I2S_DATA_LINE_1, &dataRight);
        buffer_R[n] = dataRight;
        outR = 0;
        for (k=0; k < BL; k++)
        {
            v = n-k;
            if(v < 0){
                outR += B[k] * (long)buffer_R[v + BL];
            }else{
                outR += B[k] * (long)buffer_R[v];
            }
        }
        I2SDataPut(I2S_BASE, I2S_DATA_LINE_0, (outR >> 16));
        n++;
        if(n >= BL){
            n = 0;
        }
    }
    return 0;
}