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; } } */