old demo that i want to try in mbed studio

Dependencies:   mbed SDFileSystem_Copy_of_mbed_version I2S

NotchingDemo.cpp

Committer:
roryhand
Date:
2019-09-27
Branch:
LargeFile_Tests
Revision:
58:a174e7a8f5f2
Parent:
57:0c76b15cabaf
Child:
59:8e7c25a915a0

File content as of revision 58:a174e7a8f5f2:


//  24/03/2018  update - I appear to be able to address the device and write something, as I am getting an ACK returned from the i2c write() function.
//however if i use the write function with 4 arguments (as opposed to just 1 argument) then it doesnt work
//only works with the 1 argument version!!!


//THIS VERSION WORKED, CHANGED SOME THINGS, THEN CHANGED THEM BACK.  NOW IT NO LONGER WORKS!!!!
#include "mbed.h"
#include "math.h"
#include "I2S.h"
#include "SDFileSystem.h"
#include "wm8731_Config_setup.h"
#include "WOLFSON_config_consts.h"
//#include "BlockDevice.h"
#include <string>
#include <stdlib.h>
#include <fstream>
#include <iostream>
#include <vector>
#include <string>
#define sample_freq 11025
#pragma import __use_two_region_memory
//BlockDevice *bd = BlockDevice::get_default_instance();
//#include "LittleFileSystem.h"
//LittleFileSystem fs("fs");

DigitalOut myled(LED1);
DigitalOut led2(LED2);
DigitalOut led3(LED3);
DigitalIn  NotchUp(p16);
DigitalIn  NotchDown(p17);//check the pin!!! Dont know if this will actually work...
InterruptIn Horn(p16);
Ticker sampletick;

Ticker TickFadeOut;
Timer t;
Timer t2;
Timer NotchTimer;
Timer timer_open;

Serial pc(USBTX, USBRX); // tx, rx //FOR DEBUGGING PROGRAM USING GNU SCREEN
DigitalOut cs(p8);
I2S i2s(I2S_TRANSMIT, p5, p6, p7);
SDFileSystem sd(p11, p12, p13, p8, "sd"); // the new pinout that i am using


/*struct A {
  int data;
  B b;
};*/




class classFade
{
public:

    float powerval;
    float FadeIteration;
    float DecayFactor;
    float Denom;
    float FadeCoeff;
    float Natural_Exp;
    int LengthSecs;
    int Length;

    //member Functions
    float FadeOut(void)
    {
        powerval = -FadeIteration/Denom;
        if (FadeIteration >=Length) {
            FadeCoeff = 0;

        } else {
            FadeCoeff = (Length - FadeIteration)/Length;
        }
        FadeIteration = FadeIteration + 1;
        return FadeCoeff;

    }
    float FadeIn(void)
    {
        powerval = FadeIteration/Denom;
        if (FadeIteration >=Length) {
            FadeCoeff = 1;

        } else {
            FadeCoeff = FadeIteration/Length;
        }

        FadeIteration = FadeIteration + 1;
        return FadeCoeff;

    }
};

classFade  IdleFadeOut;
classFade  N2FadeIn;

classFade   NotchFadeOut;
classFade   NotchFadeIn;





typedef struct uFMT_STRUCT {
    short comp_code;
    short num_channels;
    unsigned sample_rate;
    unsigned avg_Bps;
    short block_align;
    short sig_bps;
} FMT_STRUCT;

typedef struct uNotch_STRUCT {
    short Notch;
    short NotchTransUp;
    short NotchTransDown;
    short NotchDirection;
} Notch_STRUCT;

typedef struct uDATA_STRUCT {
    unsigned subchunk2_ID;
    unsigned subchunk2_size;
    char * data_buf;
} DATA_STRUCT;

typedef struct uWAV_FILE_STRUCT {
    FILE *WavFile;
    int id_number;
    char *slice_buf;
    int num_slices;
    FMT_STRUCT  FileFormat;
    DATA_STRUCT FileData;
} WAV_FILE_STRUCT;

/*typedef struct uWAV_FILE_STRUCT{
    FILE* WavFile;


}WAV_FILE_STRUCT;*/
class classPositionIndicators
{
public:
    int notch1_indicator, notch2_indicator, notch3_indicator, notch4_indicator;
    int notch5_indicator, notch6_indicator, notch7_indicator, notch8_indicator;
    int notch1_start_pt, notch2_start_pt, notch3_start_pt, notch4_start_pt;
    int notch5_start_pt, notch6_start_pt, notch7_start_pt, notch8_start_pt;
    classPositionIndicators()
    {
        notch1_start_pt = 44;
        notch2_start_pt = 220884+44;
        notch3_start_pt = notch2_start_pt+217698;
        notch4_start_pt = notch3_start_pt + 193060;
        notch5_start_pt = notch4_start_pt + 92010;
        notch6_start_pt = notch5_start_pt + 216642;
        notch7_start_pt = notch6_start_pt + 250316;
        notch8_start_pt = notch7_start_pt + 165084;
        notch1_indicator = notch1_start_pt;
        notch2_indicator = notch2_start_pt;
        notch3_indicator = notch3_start_pt;
        notch4_indicator = notch4_start_pt;
        notch5_indicator = notch5_start_pt;
        notch6_indicator = notch6_start_pt;
        notch7_indicator = notch7_start_pt;
        notch8_indicator = notch8_start_pt;

    }
};




class classSoundFile
{
public:

//add a class constructor at some point in the future (perform tests in visual studio)
    WAV_FILE_STRUCT FileInfo;
    short * data_sptr;
    string file_location;
    //classSoundFile(string filename);//this is the constructor
    //string filename;
};

//class constructor;
/*classSoundFile::classSoundFile(string filename)
{
    //Declare RootFolder and the directory for the appropriate file.
    //How we index into filename[] from the outside of this class is another
    //issue...
    FileInfo.WavFile = fopen("/sd/mydir/645Engine/Startup.wav","rb");
    fseek(FileInfo.WavFile,20,SEEK_SET);
    fread(&FileInfo.FileFormat,sizeof(FileInfo.FileFormat),1,FileInfo.WavFile);
    printf("wav_format.sample_rate: %d\n\r",FileInfo.FileFormat.sample_rate);
    fread(&FileInfo.FileData,sizeof(FileInfo.FileData),1,FileInfo.WavFile);
    printf("wav_data.subchunk2_size: %d\n\r",FileInfo.FileData.subchunk2_size);
    FileInfo.slice_buf = ( char *)malloc(FileInfo.FileFormat.block_align);
    fread(FileInfo.slice_buf,FileInfo.FileFormat.block_align,1,FileInfo.WavFile);   //This isnt actually required, its just a test
    FileInfo.num_slices = FileInfo.FileData.subchunk2_size/FileInfo.FileFormat.block_align;
}*/
int OneOff = 0;
int notch_flag = 0;
int i = 0;
int h = 0;
short bufflen = 1;
int buffer[1];
int AudioFormat, NumChannels, SampleRate, BitsPerSample ;
char *slice_buf;
short *data_sptr;
short *data_sptr_horn;
short *data_sptr_IdleN2;
short * data_sptr_bell;
short * data_sptr_N2;
short * data_sptr_Flange;
unsigned char *data_bptr;
int *data_wptr;
unsigned channel;
long slice, slice1, slice2, slice3, num_slices;
int verbosity  = 0;
int verbosity2 = 0;
int verbosity3 = 0;
int verbosity4 = 0;
int verbosity5 = 0;
int interrupt_condition = 1;
int sampling_freq = 11025;
const int BufferLen = 2000;
short Buffer1[BufferLen];
short Buffer2[BufferLen];
short place_hold1 = 0;
short place_hold2 = 0;


string FOLDER;
string RootFolder = "/sd/mydir/SoundDecoder/";
string  filename[25];
classSoundFile Sound[22];

volatile int flag1 = 1;
volatile int flag2 = 0;
volatile int flag3 = 1;
volatile int flag4 = 0;
int FLAGBUFF1 = 0;
int FLAGBUFF2 = 0;
int BellFlag = 0;
int BellFlag2 = 0;
int FadeFlag = 0;
int BlockFlag = 0;
int FileSwitchFlag = 0;


short value[1];
FILE *HornWav;
FILE *edsheeran_wav;
FILE *Startup_wav;
FILE *IdleN2Wav;
FILE *N2Wav;
FILE *BellWav;
FILE *FlangeWav;
FILE *HeyWav;
//long long slice_value;
int slice_value[1];


FILE *wavfile1;
FILE *wavfile2;
FILE *wavfile3;

classSoundFile Sound1;
classSoundFile Sound2;
classSoundFile Sound3;

WAV_FILE_STRUCT WavInfo_Horn;
WAV_FILE_STRUCT WavInfo_IdleN2;
WAV_FILE_STRUCT WavInfo_N2;
WAV_FILE_STRUCT WavInfo_Bell;
WAV_FILE_STRUCT WavInfo_Flange;
WAV_FILE_STRUCT WavInfo_Hey;
WAV_FILE_STRUCT WavInfo_N3;
WAV_FILE_STRUCT WavInfo_Frustration;
Ticker flipper;
char * slice_buf_bell;
char * slice_buf_ed;
char * slice_buf_startup;
char * slice_buf_N2;
Notch_STRUCT NotchingSet;
//test
//short *data_sptr_bell = 0;
short *data_sptr_ed = 0;
short *data_sptr_startup = 0;
FILE *StartupWav;
FILE *N3Wav;
int temp = 0;
void flip()
{
    led2  = !led2;
}


void isr()
{
    //timer_interrupt.start();
    if(flag1 == 0) {
        value[0] = Buffer1[place_hold1]>>4;
        i2s.write(value,1);//Send next PWM value to amp
        place_hold1 = place_hold1 + 1;
        if( (place_hold1 >= BufferLen)) {
            led2  = !led2;
            place_hold1 = 0;
            place_hold2 = 0;
            flag1 = 1;
            flag2 = 0;
        }
    } else if(flag2 == 0) {
        value[0] = Buffer2[place_hold2]>>4;
        i2s.write(value,1);//Send next PWM value to amp
        place_hold2 = place_hold2 + 1;
        if( (place_hold2 >= BufferLen) ) {
            led2  = !led2;
            place_hold1 = 0;
            place_hold2 = 0;
            flag1 = 0;
            flag2 = 1;
            FLAGBUFF2 = 0;
        }
    }

    //timer_interrupt.stop();

}

void horn_sound()
{
    BellFlag = 1;
    fseek(HornWav,44,SEEK_SET);
    fseek(BellWav,44,SEEK_SET);
    fseek(FlangeWav,44,SEEK_SET);
    fseek(N2Wav,44,SEEK_SET);
}


void FileSwitch_isr()
{
    FileSwitchFlag = 1;
    temp = 1;
    /*FILE* testwav = fopen("/sd/mydir/SoundDecoder_second/05.wav","rb");
    if(N3Wav == NULL) {
        printf("Cannot Open testwav\n\r");
    }
    */
    fseek(N3Wav,44,SEEK_SET);
//    fclose(StartupWav);
}


void FadeOutIsr()
{
    FadeFlag = 1;
    OneOff = 1;
    /*
    wavfile2 = fopen("/sd/mydir/SoundDecoder_second/09.wav","rb");
    if(wavfile2 == NULL) {
    printf("Cannot Open wavfile2\n\r");
    }
    */



    /*
        wavfile3 = fopen("/sd/mydir/SoundDecoder_second/02.wav","rb");
            if(wavfile3 == NULL) {
            printf("Cannot Open wavfile3\n\r");
        }
        */
    /*
    FILE* wavfile4 = fopen("/sd/mydir/SoundDecoder_second/04.wav","rb");
    if(wavfile4 == NULL) {
        printf("Cannot Open wavfile3\n\r");
    }
    */
    //fseek(wavfile2,44,SEEK_SET);
    //fseek(wavfile3,44,SEEK_SET);
    slice2 = 0;
    slice3 = 0;
    BlockFlag = 1;
    //printf("We are inside the FadeOut interrupt routine\n\r");

}





classFade FadeDataInitialise(classFade FadeData);





//function prototypes
classSoundFile ReadFileInfo(classSoundFile Sound, FILE * wav_file);
classSoundFile LoadFileStream(classSoundFile FileInfo, string filename);

float FadeOut(void);
void Play_WaveFile(FILE * my_wav, WAV_FILE_STRUCT FileInfo);
void Play_WaveFileDual(FILE * my_wav, WAV_FILE_STRUCT FileInfo);
//void Play_WaveFileLoop(FILE * my_wav, WAV_FILE_STRUCT FileInfo);
//*********************INTERRUPT ROUTINE FOR NOTCHING***************************

void NotchUpIsr()
{
    if(1 <= NotchingSet.Notch < 8) {

        NotchingSet.Notch = NotchingSet.Notch + 1;
        NotchingSet.NotchTransUp = NotchingSet.Notch + 7;
        NotchingSet.NotchDirection = 1;
        FadeDataInitialise(NotchFadeIn);
        FadeDataInitialise(NotchFadeOut);
    }
}

void NotchDownIsr()
{
    if(1 < NotchingSet.Notch <= 8) {
        NotchingSet.Notch = NotchingSet.Notch - 1;
        NotchingSet.NotchTransDown = NotchingSet.Notch + 15;;
        NotchingSet.NotchDirection = 0;
        FadeDataInitialise(NotchFadeIn);
        FadeDataInitialise(NotchFadeOut);
    }
}


/**********************END OF INTERRUPT ROUTINE FOR NOTCHING*******************/






void Play_WaveFileLoop(classSoundFile Sound1, FILE* wavfile1,classPositionIndicators Positions);
int main()
{

    NotchUp.mode(PullUp);
    NotchDown.mode(PullUp);

    pc.printf("Beginning of program\n");




    printf("Do we even get to this stupid bloody point\n\r");
    //Populate our class instances with some data (is there an implicit way to do this?)


    printf("hello\n\r");
    //Set up the wolfson Audio Codec board
    wm8731_Config_setup();
    //i2s audio data transfer code??
    i2s.stereomono(I2S_STEREO);
    i2s.masterslave(I2S_MASTER);
    led3 = 1;
    led2 = 1;
    printf("Hello i2s has started!");
    i2s.start();
    sampletick.attach(&isr,1.0/sampling_freq);  //1/16000
    //fileswitch_tick.attach(&FileSwitch_isr,6.0);//So we can switch between playing file 1 and file 2, including opening and closing
    //not convinced we need this above line at the moment!!
    









    TickFadeOut.attach(&FadeOutIsr,10.0);

    classPositionIndicators Positions;
    slice1 = 0;
    FILE* wavfile1 = fopen("/sd/mydir/SoundDecoder_second/All_eight_notches.wav","rb");
    classSoundFile Sound1;
    Sound1 = ReadFileInfo(Sound1, wavfile1);
    printf("about to play wav file\n\r");
    //Play_WaveFileLoop(Sound1,wavfile1,Positions);
    printf("finished playing Wav file\n\r");


    timer_open.reset();
    timer_open.start();
    fclose(wavfile1);
    timer_open.stop();
    printf("It took %d useconds to close file\n\r",timer_open.read_us());




    /************************************PLAY WAV FILE LOOP*******************/
    /************************************END OF PLAY WAV FILE LOOP*************/


    i2s.stop();

}






classSoundFile ReadFileInfo(classSoundFile Sound, FILE * wav_file)
{
    fseek(wav_file,20,SEEK_SET);
    printf("We have just seeked through this file\n\r");
    fread(&Sound.FileInfo.FileFormat,sizeof(Sound.FileInfo.FileFormat),1,wav_file);
    //printf("wav_format.sample_rate: %d\n\r",FileInfo.FileFormat.sample_rate);

    fread(&Sound.FileInfo.FileData,sizeof(Sound.FileInfo.FileData),1,wav_file);
    printf("wav_data.subchunk2_size: %d\n\r",Sound.FileInfo.FileData.subchunk2_size);
    Sound.FileInfo.slice_buf = ( char *)malloc(Sound.FileInfo.FileFormat.block_align);
    fread(Sound.FileInfo.slice_buf,Sound.FileInfo.FileFormat.block_align,1,wav_file);   //This isnt actually required, its just a test
    Sound.FileInfo.num_slices = Sound.FileInfo.FileData.subchunk2_size/Sound.FileInfo.FileFormat.block_align;
    //printf("Number of Slices: %d\n\r",FileInfo.num_slices);
    return Sound;
}






void Play_WaveFile(FILE * my_wav, WAV_FILE_STRUCT FileInfo)
{
    while(slice<FileInfo.num_slices) {
        fread(FileInfo.slice_buf,FileInfo.FileFormat.block_align,1,my_wav);
        data_sptr=(short *)FileInfo.slice_buf;     // 16 bit samples
        for (channel=0; channel<FileInfo.FileFormat.num_channels; channel++) {
            if(flag1 == 1) {
                Buffer1[place_hold1] = data_sptr[channel];
                place_hold1 = place_hold1 + 1;
                if(place_hold1 >= BufferLen) {
                    while(1) {
                        if(flag1 == 0) {

                            break;
                        }

                    }
                }

            } else if(flag2 == 1) {
                Buffer2[place_hold2] = data_sptr[channel];
                place_hold2 = place_hold2 + 1;
                if(place_hold2 >= BufferLen) {

                    while(1) {
                        if(flag2 == 0) {

                            break;
                        }
                    }
                }
            }

        }
        slice = slice + 1;
    }
}




//***************************************************************************//

//**************************************************************************//





/*

void Play_WaveFileLoop(classSoundFile Sound1, FILE *wavfile1, classPositionIndicators Positions)
{
    while(1) { //might have to change this to a while(1) loop?





//Sound1=======================================================================================
            if( slice1 == (Positions.notch2_start_pt) ) {
                slice1 = 0;
                fseek(wavfile1,Positions.notch1_start_pt,SEEK_SET);
            }

            fread(Sound1.FileInfo.slice_buf,Sound1.FileInfo.FileFormat.block_align,1,wavfile1);
            Sound1.data_sptr=(short *)Sound1.FileInfo.slice_buf;     // 16 bit samples
//=============================================================================================

            



        for (channel=0; channel<Sound1.FileInfo.FileFormat.num_channels; channel++) {
            switch (Sound1.FileInfo.FileFormat.sig_bps) {
                case 16:
                    if(flag1 == 1) {
                        Buffer1[place_hold1] = Sound1.data_sptr[channel];
                        place_hold1 = place_hold1 + 1;
                        if(place_hold1 >= BufferLen) {
                            while(1) {
                                if(flag1 == 0) {
                                    break;
                                }//if(flag1 == 0)


                            }//while(1)
                        }//if(place_hold1 > = BufferLen)

                    } else if(flag2 == 1) {
                        Buffer2[place_hold2] = Sound1.data_sptr[channel];
                        place_hold2 = place_hold2 + 1;
                        if(place_hold2 >= BufferLen) {
                            while(1) {

                                if(flag2 == 0) {
                                    break;
                                }
                            }
                        }

                    }
            }
        }
        slice1 = slice1 + 1;
        slice2 = slice2 + 1;
        slice3 = slice3 + 1;
    }
}

*/