// Karl's MS G4 Transmitter Code // Nordic packet: NO_FFTS, FFT_SIZE, 32 Floating Pt. Magnitude Sums

Size: px

Start display at page:

Download "// Karl's MS G4 Transmitter Code // Nordic packet: NO_FFTS, FFT_SIZE, 32 Floating Pt. Magnitude Sums"

Polly Barber
6 years ago
Views:

1 // Karl's MS G4 Transmitter Code // Nordic packet: NO_FFTS, FFT_SIZE, 32 Floating Pt. Magnitude Sums #include "DSP28x_Project.h" #include "Nordic_TX.h" #include <FPU.h> #include <math.h> #define FFT_SIZE 256 //32, 64, 128, 256, etc. #define FFT_STAGES 8 //log2(fft_size) #define NO_FFTS 1 //number of FFTs to sample & process //Linker file reserves space for up to 32*64 bins #define Nordic_CSN_low GpioDataRegs.GPACLEAR.bit.GPIO20 = 1 //Nordic Interface #define Nordic_CSN_high GpioDataRegs.GPASET.bit.GPIO20 = 1 #define Nordic_CE_low GpioDataRegs.GPACLEAR.bit.GPIO21 = 1 #define Nordic_CE_high GpioDataRegs.GPASET.bit.GPIO21 = 1 #define NordicIRQ GpioDataRegs.GPADAT.bit.GPIO24 #define PACKET_BYTES 288 //NO_FFTS, FFT_SIZE, 32 Mag Sums = 136 bytes + 24 dummy bytes to //create 160 bytes = 5x32 bytes = 5 packets void void void System_init(void); FFT_init(void); Transmit_Data(void); samplebuffer[fft_size*no_ffts]; OutBuffer[FFT_SIZE]; TwiddleBuffer[FFT_SIZE]; MagBuffer[FFT_SIZE/2]; SumSpectrum[FFT_SIZE/2]; Hanning[FFT_SIZE] = 0, , , , , , , , , , , , , , , , , , , , , , , , , , , , , , , , , , , , , , , , , , , , , , , , , , , , , , , , , , , , , , , , , , , , , , , , , , , , , , , , , , , , , , , , , , , , , , , , , , , , , , , , , , , , , , , , , , , , , , , , , , , , , , , , , , , , , ,

2 42, , , , , , , , , , , , , , , , , , , , , , , , , , , , , , , , , , , , , , , , , , , , , , , , , , , , , , , , , , , , , , , , , , , , , , , , , , , , , , , , , , , , , , , , , , , , , , , , , , , , , , , , , , , , , , , , , , , , , , , , ,0.0; RFFT_F32_STRUCT fft; TempSum; unsigned long Nordic_Fail_Counter; char Nordic_Fail_Flg; // if counter overflows, flg is set & the entire transmit // event is dumped unsigned long TXdata[PACKET_BYTES]; #pragma DATA_SECTION(samplebuffer, "INBUFA"); //Align the INBUF section to 2*FFT_SIZE in the linker file void main(void) //LPM_ini(); EALLOW; FlashRegs.FPWR.all = 0; EDIS; System_init(); EALLOW; GpioCtrlRegs.GPADIR.all = 0x0005; GpioCtrlRegs.GPAPUD.bit.GPIO24 = 1; GpioDataRegs.GPADAT.bit.GPIO24 = 0; EDIS; sample_count = 0; FFT_init(); SetupNordicTX(); Nordic_Fail_Counter = 0; //Configure Low Power Mode (only needed for idle) //Turn off flash module //Initialize Peripheral Clock //Nordic GPIO Setup // GPIO0-GPIO31 are inputs... 0, 2, are output //diable pullup on nordic IRQ line //Initialize sample counter //Initialize FFT Configuration //Initialize Nordic // while(1) //this while loop is used for testing code...comment out when finished testing

3 Nordic_Fail_Flg = 0; Zero_SumSpectrum(); //Zero out Spectrum Sum values InitPll(1,1); //Clk Speed 1X (2,2), 2X (4,2), 3X (6,2), 4X (8,2) //5X (10,2) first number multiplies, second number (1) = /4 //(2) = /2, (3) = /1 does not work for(i=0;i<fft_size;i++) samplebuffer[i] = samplebuffer[i] * Hanning[i]; for(j=0;j<(no_ffts);j++) //COMPUTE ALL FFTs and MAGNITUDES fft.inbuf = &samplebuffer[j*fft_size]; //Set FFT input ptr to original sample buffer RFFT_f32(&fft); //Real FFT Calc (read from sample buffer) fft.magbuf = &samplebuffer[j*(fft_size/2)]; //Set Mag output ptr to orig sample buf RFFT_f32_mag(&fft); //Real Mag Calc (write back to sample buf) for(j=0;j<(no_ffts);j++) //COMPUTE SUM SPECTRUM for(i=0;i<(fft_size/2);i++) TempSum = SumSpectrum[i] + samplebuffer[(j*(fft_size/2))+i]; SumSpectrum[i] = TempSum; SumSpectrum[0] = 0.0; if (Channel == 0) LED_on; NordicWReg(RF_CH, 40); NordicWReg(RF, 0x86); Nordic_CE_high; while(1) LED_on; Transmit_Data(); LED_off; //make DC term zero //CONSTANT CARRIER TEST CODE //Write RF Channel Register // pulse CE high for 10uS t start packet transmit //NORDIC TRANSMIT DATA // //end of test while loop...comment out when finished testing

4 void Zero_SumSpectrum(void) for(i=0;i<(fft_size/2);i++) SumSpectrum[i]= 0.0; void Zero_SampleBuffer(void) for(j=0;j<(no_ffts);j++) for(i=0;i<(fft_size);i++) samplebuffer[j*fft_size+i]= 0.0; //Zero Out SumSpectrum values //DEBUG PURPOSES - load sample buffer with zeros void System_init(void) InitSysCtrl(); InitPll(2,2); //SYSTEM INITIALIZATION 2MHZ XTAL //Clk Speed 1X (2,2), 2X (4,2), 3X (6,2), 4X (8,2) 5X (10,2) first number //multiplies, second number (1) = /4, (2) = /2, (3) = /1 does not work void FFT_init(void) //FFT INITIALIZATION fft.inbuf = samplebuffer; //Input data buffer fft.outbuf = OutBuffer; //FFT output buffer fft.cossinbuf = TwiddleBuffer; //Twiddle factor buffer fft.fftsize = FFT_SIZE; //FFT length fft.fftstages = FFT_STAGES; //FFT Stages fft.magbuf = MagBuffer; //Magnitude buffer RFFT_f32_sincostable(&fft); //Initialize Twiddle Buffer typedef Uint16 UBYTE; /* Unsigned 8 bit quantity */ typedef Uint16 UWORD; /* Unsigned 16 bit quantity */ void RF_calc_crc(unsigned long *pdata, int count) UWORD CRC, temp; unsigned long value; int i,j,k;

5 CRC=0xffff; for(i=0;i<count;i++) value=*pdata++; for(j=0;j<4;j++) temp=value>>(8*j); temp=temp & 0x00FF; CRC=CRC ^ temp; for(k=0;k<8;k++) temp=crc & 0x0001; CRC=CRC >> 1; if ((temp & 0x0001)== 0x0001) CRC=CRC ^ 0xA001; *pdata++= (UBYTE) CRC & 0x00ff; temp = CRC >> 8; *pdata = (UBYTE)temp & 0x00ff; void Transmit_Data(void) volatile unsigned short ret; int i= 0,j = 0,k = 0, word_count= 0; inter; TXdata[0] = (unsigned long) NO_FFTS; TXdata[1] = (unsigned long) FFT_SIZE; TXdata[2] = 1; //Build TX data packet //FFT Size //Battery Good for(i=0;i<(fft_size/4);i++) memcpy(&txdata[i+3],&sumspectrum[i],sizeof()); for(i=0;i<5;i++) TXdata[i+67] = 0xfab4; //5 dummy values RF_calc_crc(TXdata,67); //Calc CRC16 for(k = 0;k < PACKET_BYTES/32; k++) //32 bytes per RF trans. event (8x32 bit words per tx event) Nordic_CSN_low; //enable nordic to recieve commands SPITX(W_TX_PAYLOAD); //send write payload command while (SpiaRegs.SPIFFRX.bit.RXFFINT == 0); //wait for transmission to complete

6 for(i = 0;i <= 7; i++) word_count++; SPITX(TXdata[i+j] >> 24); //send high byte SPITX(TXdata[i+j] >> 16); //send Low byte SPITX(TXdata[i+j] >> 8); //send high byte SPITX(TXdata[i+j]); //send Low byte Nordic_CSN_high; //deselct Nodic on SPI Nordic_CE_high; // pulse CE high for 10uS t start packet transmit DELAY_US(15); while (!NordicIRQ &&!Nordic_Fail_Flg) Nordic_Fail_Counter++; if (Nordic_Fail_Counter == 2001) Nordic_Fail_Flg = 1; DELAY_US(300); if ((NordicRReg(STATUS) & 0x10) Nordic_Fail_Flg) NordicTX(0xE1); //Flush TX Buffer Nordic_Fail_Flg = 0; Nordic_Fail_Counter = 0; k = (PACKET_BYTES/32)+1; NordicWReg(STATUS, 0x70); //Write Status Register to clear all flags j += 8; //increment index (counting 8 longs per transmit) DELAY_US(3000); Nordic_CE_low;

F²MC-8FX FAMILY 8-BIT MICROCONTROLLER MB95200H SERIES SPI SW REALIZATION USING GPIO APPLICATION NOTE

Fujitsu Semiconductor (Shanghai) Co., Ltd. Application Note MCU-AN-500035-E-10 F²MC-8FX FAMILY 8-BIT MICROCONTROLLER MB95200H SERIES SPI SW REALIZATION USING GPIO APPLICATION NOTE Revision History Revision