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:
- 61:212d2db45c56
- Parent:
- 60:36df2997de3d
- Child:
- 63:a8c1971d3d42
File content as of revision 61:212d2db45c56:
// 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
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 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 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;
int notch_start_pts [9];
int notch_position_indicators[9];
int notch_transitions_start_pts[15];
int notch_transitions_position_indicators[15];
int auxiliary_start_pts[5];
int auxiliary_position_indicators[5];
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 + 150152;
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;
notch_start_pts[1] = notch1_start_pt;
notch_start_pts[2] = notch2_start_pt;
notch_start_pts[3] = notch3_start_pt;
notch_start_pts[4] = notch4_start_pt;
notch_start_pts[5] = notch5_start_pt;
notch_start_pts[6] = notch6_start_pt;
notch_start_pts[7] = notch7_start_pt;
notch_start_pts[8] = notch8_start_pt;
notch_position_indicators[1] = notch1_indicator;
notch_position_indicators[2] = notch2_indicator;
notch_position_indicators[3] = notch3_indicator;
notch_position_indicators[4] = notch4_indicator;
notch_position_indicators[5] = notch5_indicator;
notch_position_indicators[6] = notch6_indicator;
notch_position_indicators[7] = notch7_indicator;
notch_position_indicators[8] = notch8_indicator;
}
};
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];
//long long slice_value;
int slice_value[1];
FILE *wavfile1;
FILE *wavfile2;
FILE *wavfile3;
classSoundFile Sound1;
classSoundFile Sound2;
classSoundFile Sound3;
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();
}
//function prototypes
classSoundFile ReadFileInfo(classSoundFile Sound, FILE * wav_file);
classSoundFile LoadFileStream(classSoundFile FileInfo, string filename);
void Play_WaveFile(FILE * my_wav, WAV_FILE_STRUCT FileInfo);
void Play_WaveFileDual(FILE * my_wav, WAV_FILE_STRUCT FileInfo);
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
classPositionIndicators Positions;
slice1 = Positions.notch7_start_pt;
FILE* wavfile1 = fopen("/sd/mydir/SoundDecoder_second/All_eight_notches.wav","rb");
//FILE* wavfile1 = fopen("/sd/mydir/SoundDecoder_second/01.wav","rb");
classSoundFile Sound1;
Sound1 = ReadFileInfo(Sound1, wavfile1);
fseek(wavfile1,Positions.notch7_start_pt,SEEK_SET);
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);
printf("Wav File Block Align (number of bytes per sample!!: %d\n\r", 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.notch8_start_pt) ) {
slice1 = Positions.notch7_start_pt;
fseek(wavfile1,Positions.notch7_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 + 2;//increment up by the number of bytes per Audio data sample! Makes sense it is 2 bytes, as this is 16-bit data.
slice2 = slice2 + 1;
slice3 = slice3 + 1;
}
}