#include <csl.h>
#include <csl_timer.h>
#include <dsk6416.h>
#include <dsk6416_led.h>
#include <dsk6416_dip.h>
#include <dsk6416_aic23.h>

#include <math.h>

#define PI (3.14159265358979323846)

DSK6416_AIC23_CodecHandle hCodec;
DSK6416_AIC23_Config codecConfig = { \
        0x0017,  /* 0 DSK6416_AIC23_LEFTINVOL  Left line input channel volume */ \
        0x0017,  /* 1 DSK6416_AIC23_RIGHTINVOL Right line input channel volume */\
        0x00d8,  /* 2 DSK6416_AIC23_LEFTHPVOL  Left channel headphone volume */  \
        0x00d8,  /* 3 DSK6416_AIC23_RIGHTHPVOL Right channel headphone volume */ \
        0x0015,  /* 4 DSK6416_AIC23_ANAPATH    Analog audio path control */      \
        0x0000,  /* 5 DSK6416_AIC23_DIGPATH    Digital audio path control */     \
        0x0000,  /* 6 DSK6416_AIC23_POWERDOWN  Power down control */             \
        0x0043,  /* 7 DSK6416_AIC23_DIGIF      Digital audio interface format */ \
        0x0001,  /* 8 DSK6416_AIC23_SAMPLERATE Sample rate control */            \
        0x0001   /* 9 DSK6416_AIC23_DIGACT     Digital interface activation */   \
};

float r, f, a, b;
volatile int sample, amp;
volatile float sample_0, sample_1, sample_2;

void CodecTransmit(void);

int main(void) {

    CSL_init();

    DSK6416_init();

    DSK6416_DIP_init();

    hCodec = DSK6416_AIC23_openCodec(0, &codecConfig);

    amp=32000;
    r = 1.0;
    f = 1000.0/48000.0;

    a = 2*r*cos(2*PI*f);
    b = -r*r;

    sample_2 = 0;
    sample_1 = sin(2*PI*f);

    sample_0 = a*sample_1+b*sample_2;
    sample_2 = sample_1;
    sample_1 = sample_0;
    sample = amp*sample_0;

    IRQ_globalDisable();
    IRQ_enable(IRQ_EVT_RINT2);
    IRQ_globalEnable();

//  DSK6416_AIC23_closeCodec(hCodec);

    return 0;
}

void CodecTransmit(void) {
    static int mode = 1;

    if(mode == 0) {
        DSK6416_AIC23_write(hCodec, sample);

        sample_0 = a*sample_1+b*sample_2;
        sample_2 = sample_1;
        sample_1 = sample_0;

        sample = amp*sample_0;
    }
    else {
        DSK6416_AIC23_write(hCodec, sample);
    }

    mode = !mode;
}