Jared Baxter / Mbed 2 deprecated Impedance_Fast_Circuitry

Impedance Fast Circuitry Software

Dependencies:   mbed-dsp mbed

Fork of DSP_200kHz by Mazzeo Research Group

main.cpp@75:8bb94685c80b, 2017-06-02 (annotated)

Committer:
baxterja
Date:
Fri Jun 02 21:10:22 2017 +0000
Revision:
75:8bb94685c80b
Parent:
74:ebc9f09fda11
Child:
76:704fc58ffcd0
Added better demodulation options

Who changed what in which revision?

UserRevisionLine numberNew contents of line
donatien 0:bb128f0e952f 1 #include "mbed.h"
timmey9 22:523e316cbe70 2
timmey9 52:5a40cc58c4c2 3 // Sampling
bmazzeo 53:83a90a47c1fd 4 #include "DMA_sampling/adc.h"
bmazzeo 54:1697dc574b96 5 #include "DMA_sampling/dac.h"
bmazzeo 55:2526b3317bc8 6 #include "DMA_sampling/pdb.h"
baxterja 73:b059b5bdc664 7 #include "Jareds_DSP/filters_jared.h"
baxterja 75:8bb94685c80b 8 #include "Jareds_DSP/demodulate.h"
bmazzeo 67:ec0c58490ce6 9 // DSP
bmazzeo 67:ec0c58490ce6 10 #include "dsp.h"
bmazzeo 67:ec0c58490ce6 11
baxterja 72:0b554f5026b9 12 #define PRINT_BUFFER_LENGTH 10000
baxterja 73:b059b5bdc664 13 #define GATHER_STATISTICS 1
bmazzeo 67:ec0c58490ce6 14
baxterja 74:ebc9f09fda11 15
timmey9 22:523e316cbe70 16 // for debug purposes
timmey9 18:b17ddeeb1c09 17 Serial pc(USBTX, USBRX);
timmey9 18:b17ddeeb1c09 18 DigitalOut led_red(LED_RED);
timmey9 18:b17ddeeb1c09 19 DigitalOut led_green(LED_GREEN);
timmey9 18:b17ddeeb1c09 20 DigitalOut led_blue(LED_BLUE);
bmazzeo 58:4bee89daccff 21 DigitalOut status_0(D0);
bmazzeo 58:4bee89daccff 22 DigitalOut status_1(D1);
baxterja 73:b059b5bdc664 23 DigitalIn sw2(SW2);//Button 2
baxterja 73:b059b5bdc664 24 DigitalIn sw3(SW3);//Button 3
timmey9 51:43143a3fc2d7 25
timmey9 52:5a40cc58c4c2 26 // defined in dma.cpp
timmey9 45:d591d138cdeb 27 extern int len;
baxterja 73:b059b5bdc664 28 extern uint16_t static_input_array0[];//ADC 0(swaps between a0 and a1. Used to measure current)
baxterja 73:b059b5bdc664 29 extern uint16_t static_input_array1[];//ADC 1(measures the voltage between the probe and ground)
baxterja 73:b059b5bdc664 30 extern uint16_t static_output_array0[];//DAC outputs whatever wave form we want.
baxterja 73:b059b5bdc664 31 extern uint16_t sampling_status;//used to determine when adc's are done reading.
bmazzeo 57:7b8c49e1c1f6 32
baxterja 73:b059b5bdc664 33 #define INPUT_ARRAY_SIZE 32
baxterja 73:b059b5bdc664 34 #define DECIMATION_FACTOR 8
baxterja 73:b059b5bdc664 35 #define DEMODULATED_SIGNAL_LENGTH 64
baxterja 73:b059b5bdc664 36
baxterja 73:b059b5bdc664 37 float *input_50k[8];
baxterja 73:b059b5bdc664 38
baxterja 73:b059b5bdc664 39
baxterja 73:b059b5bdc664 40
baxterja 73:b059b5bdc664 41
baxterja 69:014d4bbd4e03 42 #define pre_compute_length 500
baxterja 73:b059b5bdc664 43 #define demodulation_length 125
baxterja 69:014d4bbd4e03 44 #define CarrierFrequency 200
baxterja 69:014d4bbd4e03 45 #define SAMPLEFREQUENCY 100000
baxterja 73:b059b5bdc664 46 //float i_mod_pre[demodulation_length+(INPUT_ARRAY_SIZE/DECIMATION_FACTOR)];
baxterja 73:b059b5bdc664 47 //float q_mod_pre[demodulation_length+(INPUT_ARRAY_SIZE/DECIMATION_FACTOR)];
baxterja 73:b059b5bdc664 48 uint16_t out_val_pre[pre_compute_length]; //used to write values to the dac
baxterja 69:014d4bbd4e03 49 float twopi = 3.14159265359 * 2;
baxterja 69:014d4bbd4e03 50
baxterja 69:014d4bbd4e03 51
baxterja 69:014d4bbd4e03 52 void pre_compute_tables() {
baxterja 69:014d4bbd4e03 53 // This function will precompute the cos and sin tables used in the rest of the program
baxterja 69:014d4bbd4e03 54 for(int precompute_counter = 0; precompute_counter < pre_compute_length; precompute_counter++){
baxterja 73:b059b5bdc664 55 out_val_pre[precompute_counter] = (int) (cos(twopi * CarrierFrequency /SAMPLEFREQUENCY * precompute_counter) * 2046.0 + 2048.0);//12 bit cos wave
baxterja 69:014d4bbd4e03 56 }
baxterja 73:b059b5bdc664 57
baxterja 73:b059b5bdc664 58 //float decimated_frequency = 6250;
baxterja 73:b059b5bdc664 59 //for(int precompute_counter = 0; precompute_counter < demodulation_length+(INPUT_ARRAY_SIZE/DECIMATION_FACTOR); precompute_counter++){
baxterja 73:b059b5bdc664 60 // i_mod_pre[precompute_counter] = (cos(twopi * CarrierFrequency / decimated_frequency * precompute_counter));
baxterja 73:b059b5bdc664 61 // q_mod_pre[precompute_counter] = (-sin(twopi * CarrierFrequency / decimated_frequency * precompute_counter));
baxterja 73:b059b5bdc664 62
baxterja 69:014d4bbd4e03 63 }
baxterja 69:014d4bbd4e03 64
baxterja 69:014d4bbd4e03 65
emilmont 7:65188f4a8c25 66 int main() {
baxterja 73:b059b5bdc664 67 pre_compute_tables();
baxterja 75:8bb94685c80b 68 precompute_tables();
baxterja 73:b059b5bdc664 69 //turn off all LEDs
timmey9 22:523e316cbe70 70 led_blue = 1;
timmey9 35:df40c4566826 71 led_green = 1;
timmey9 18:b17ddeeb1c09 72 led_red = 1;
timmey9 34:44cc9b76a507 73
baxterja 73:b059b5bdc664 74
baxterja 69:014d4bbd4e03 75 int DAC_COUNTER = 0;
baxterja 73:b059b5bdc664 76
baxterja 73:b059b5bdc664 77 pc.baud(230400);
baxterja 73:b059b5bdc664 78 pc.printf("Starting\r\n");
baxterja 73:b059b5bdc664 79 float Coeffs[20] = {0.0328368433284673, 0.0237706090075265, 0.0309894695180997, 0.0385253568846695, 0.0459996974310349, 0.0530165318016261, 0.0591943866845610, 0.0641755708098907, 0.0676960677594849, 0.0694621149975389, 0.0694621149975389, 0.0676960677594849, 0.0641755708098907, 0.0591943866845610, 0.0530165318016261, 0.0459996974310349, 0.0385253568846695, 0.0309894695180997, 0.0237706090075265, 0.0328368433284673};
baxterja 73:b059b5bdc664 80 float Coeffs2[20] = {-0.00506451294187997, -0.00824932319607346, -0.00986370066237912, -0.00518913235010027, 0.00950858650162284, 0.0357083149022659, 0.0711557142019980, 0.109659494661247, 0.142586101123340, 0.161603335553589, 0.161603335553589, 0.142586101123340, 0.109659494661247, 0.0711557142019980, 0.0357083149022659, 0.00950858650162284, -0.00518913235010027, -0.00986370066237912, -0.00824932319607346, -0.00506451294187997};
baxterja 73:b059b5bdc664 81
baxterja 73:b059b5bdc664 82
baxterja 73:b059b5bdc664 83 for(int i = 0; i < 8; i++)
baxterja 73:b059b5bdc664 84 input_50k[i] = new float[32];//each array represents the input of the adcs
baxterja 73:b059b5bdc664 85
baxterja 73:b059b5bdc664 86 filters f3 = filters(8, 8, NULL, 8, 20, Coeffs2,false);
baxterja 73:b059b5bdc664 87
baxterja 73:b059b5bdc664 88 //6250->781
baxterja 73:b059b5bdc664 89 filters f2 = filters(8, 8, &f3, 8, 20, Coeffs,false);
baxterja 73:b059b5bdc664 90
baxterja 73:b059b5bdc664 91 //50,000->6250
baxterja 73:b059b5bdc664 92 filters f1 = filters(4, 8, &f2, 32, 20, Coeffs,true);
baxterja 69:014d4bbd4e03 93
baxterja 69:014d4bbd4e03 94
baxterja 73:b059b5bdc664 95 //float output_print_buffer[PRINT_BUFFER_LENGTH];//used to store the adc0 values(current measurment)
baxterja 73:b059b5bdc664 96 //float output_print_buffer2[PRINT_BUFFER_LENGTH];//used to store the adc0 values(voltage measurment)
baxterja 70:8cd7a8a2c153 97 int print_buffer_count = 0;
baxterja 70:8cd7a8a2c153 98
bmazzeo 66:72c5c24e532c 99 pdb_init(); // Initalize PDB
bmazzeo 66:72c5c24e532c 100 dac_init(); // initializes DAC
timmey9 45:d591d138cdeb 101 adc_init(); // always initialize adc before dma
bmazzeo 53:83a90a47c1fd 102 pc.printf("ADC Initialized\r\n");
baxterja 74:ebc9f09fda11 103 dma_init2(); // initializes DMAs
bmazzeo 55:2526b3317bc8 104 dma_reset(); // This clears any DMA triggers that may have gotten things into a different state
bmazzeo 67:ec0c58490ce6 105 pc.printf("Buffer Size: %i\r\n", len);
bmazzeo 54:1697dc574b96 106
timmey9 46:a015ebf4663b 107 led_green = 1;
timmey9 38:ec3b16c130d7 108
timmey9 40:bd6d8c35e822 109 pc.printf("\r\n\r\n\r\n");
timmey9 37:8bdc71f3e874 110
bmazzeo 64:bb4a4bd57681 111 pdb_start();
baxterja 70:8cd7a8a2c153 112 //while(print_buffer_count<PRINT_BUFFER_LENGTH)
baxterja 73:b059b5bdc664 113 while(!GATHER_STATISTICS||print_buffer_count<PRINT_BUFFER_LENGTH)
baxterja 73:b059b5bdc664 114 {
baxterja 73:b059b5bdc664 115 while(sampling_status == 0)//wait until the ADCs read a new value
baxterja 73:b059b5bdc664 116 {
baxterja 73:b059b5bdc664 117 status_0 = 1;
baxterja 75:8bb94685c80b 118 //Thread::wait(.0001);
baxterja 73:b059b5bdc664 119 }
baxterja 73:b059b5bdc664 120 sampling_status = 0;//sets sampling status to 0. DMA sets it to one once ADCs sample
baxterja 73:b059b5bdc664 121 status_0 = 0;//Tied to D0. use an O-scope to measure how much free time there is to play with.
baxterja 73:b059b5bdc664 122 status_1 = 1;//Tied to D1. use an O-scope to measure how much time the processing takes
baxterja 73:b059b5bdc664 123
baxterja 73:b059b5bdc664 124 for(int i = 0; i < len; i+=2)
bmazzeo 61:a56cca07d4a6 125 {
baxterja 73:b059b5bdc664 126 static_output_array0[i] = out_val_pre[DAC_COUNTER];//DAC output
baxterja 73:b059b5bdc664 127 DAC_COUNTER++;//Counter to kepp track of where we are in our precomputed table
baxterja 73:b059b5bdc664 128 if (DAC_COUNTER>=pre_compute_length) {DAC_COUNTER = 0;}//wrap around the counter
baxterja 73:b059b5bdc664 129 static_output_array0[i+1] = out_val_pre[DAC_COUNTER];//DAC output
baxterja 73:b059b5bdc664 130 DAC_COUNTER++;//Counter to kepp track of where we are in our precomputed table
baxterja 73:b059b5bdc664 131 if (DAC_COUNTER>=pre_compute_length) {DAC_COUNTER = 0;}//wrap around the counter
baxterja 73:b059b5bdc664 132
baxterja 73:b059b5bdc664 133 input_50k[1][i/2]=static_input_array1[i];
baxterja 73:b059b5bdc664 134 input_50k[3][i/2]=static_input_array1[i+1];
baxterja 73:b059b5bdc664 135 input_50k[0][i/2]=static_input_array0[i];
baxterja 73:b059b5bdc664 136 input_50k[2][i/2]=static_input_array0[i+1];
baxterja 73:b059b5bdc664 137
baxterja 73:b059b5bdc664 138
baxterja 73:b059b5bdc664 139
baxterja 73:b059b5bdc664 140 }//End of for loop going throught the buffer of adc samples
baxterja 73:b059b5bdc664 141 f1.input(input_50k,32);
baxterja 70:8cd7a8a2c153 142
baxterja 73:b059b5bdc664 143
baxterja 73:b059b5bdc664 144
baxterja 70:8cd7a8a2c153 145
baxterja 73:b059b5bdc664 146 status_1 = 0;//turn off D1 used in deterimining how long processing is taking
baxterja 73:b059b5bdc664 147 //filter_input_array[i] = (float) (((int)static_input_array0[i]) - 0x8000);
baxterja 73:b059b5bdc664 148 //arm_fir_f32(&S, filter_input_array, filter_output_array, len);
baxterja 73:b059b5bdc664 149
baxterja 73:b059b5bdc664 150 }//end of while loop
baxterja 73:b059b5bdc664 151
baxterja 73:b059b5bdc664 152 //for(int i = 0; i<PRINT_BUFFER_LENGTH; i++)//print all the adc values measured
baxterja 73:b059b5bdc664 153 //{
baxterja 73:b059b5bdc664 154 // printf("%.1f %.1f\n\r",output_print_buffer[i],output_print_buffer2[i]);
baxterja 73:b059b5bdc664 155 //}
baxterja 73:b059b5bdc664 156
baxterja 70:8cd7a8a2c153 157
bmazzeo 61:a56cca07d4a6 158 }
bmazzeo 63:7903a33e2fd4 159