Jared Baxter / Mbed 2 deprecated Impedance_Fast_Circuitry_print_V_I

Important changes to repositories hosted on mbed.com

Mbed hosted mercurial repositories are deprecated and are due to be permanently deleted in July 2026.

To keep a copy of this software download the repository Zip archive or clone locally using Mercurial.

It is also possible to export all your personal repositories from the account settings page.

Dependencies:   mbed-dsp mbed

Fork of Impedance_Fast_Circuitry by Jared Baxter

main.cpp@78:10b2916b8f5c, 2017-06-06 (annotated)

Committer:
baxterja
Date:
Tue Jun 06 18:15:00 2017 +0000
Revision:
78:10b2916b8f5c
Parent:
77:1ee17a9e9f8b
Child:
79:5f24cfd685d8
Working Simultaneous excitation of multiple frequencies.

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"
baxterja 76:704fc58ffcd0 11 #include "print_data.h"
bmazzeo 67:ec0c58490ce6 12
baxterja 72:0b554f5026b9 13 #define PRINT_BUFFER_LENGTH 10000
baxterja 73:b059b5bdc664 14 #define GATHER_STATISTICS 1
bmazzeo 67:ec0c58490ce6 15
baxterja 74:ebc9f09fda11 16
timmey9 22:523e316cbe70 17 // for debug purposes
timmey9 18:b17ddeeb1c09 18 Serial pc(USBTX, USBRX);
timmey9 18:b17ddeeb1c09 19 DigitalOut led_red(LED_RED);
timmey9 18:b17ddeeb1c09 20 DigitalOut led_green(LED_GREEN);
timmey9 18:b17ddeeb1c09 21 DigitalOut led_blue(LED_BLUE);
bmazzeo 58:4bee89daccff 22 DigitalOut status_0(D0);
bmazzeo 58:4bee89daccff 23 DigitalOut status_1(D1);
baxterja 77:1ee17a9e9f8b 24 DigitalOut status_3(D3);
baxterja 73:b059b5bdc664 25 DigitalIn sw2(SW2);//Button 2
baxterja 73:b059b5bdc664 26 DigitalIn sw3(SW3);//Button 3
timmey9 51:43143a3fc2d7 27
timmey9 52:5a40cc58c4c2 28 // defined in dma.cpp
timmey9 45:d591d138cdeb 29 extern int len;
baxterja 73:b059b5bdc664 30 extern uint16_t static_input_array0[];//ADC 0(swaps between a0 and a1. Used to measure current)
baxterja 73:b059b5bdc664 31 extern uint16_t static_input_array1[];//ADC 1(measures the voltage between the probe and ground)
baxterja 73:b059b5bdc664 32 extern uint16_t static_output_array0[];//DAC outputs whatever wave form we want.
baxterja 73:b059b5bdc664 33 extern uint16_t sampling_status;//used to determine when adc's are done reading.
bmazzeo 57:7b8c49e1c1f6 34
baxterja 73:b059b5bdc664 35 #define INPUT_ARRAY_SIZE 32
baxterja 73:b059b5bdc664 36 #define DECIMATION_FACTOR 8
baxterja 73:b059b5bdc664 37 #define DEMODULATED_SIGNAL_LENGTH 64
baxterja 73:b059b5bdc664 38
baxterja 73:b059b5bdc664 39 float *input_50k[8];
baxterja 73:b059b5bdc664 40
baxterja 73:b059b5bdc664 41
baxterja 73:b059b5bdc664 42
baxterja 73:b059b5bdc664 43
baxterja 69:014d4bbd4e03 44 #define pre_compute_length 500
baxterja 73:b059b5bdc664 45 #define demodulation_length 125
baxterja 69:014d4bbd4e03 46 #define CarrierFrequency 200
baxterja 69:014d4bbd4e03 47 #define SAMPLEFREQUENCY 100000
baxterja 73:b059b5bdc664 48 //float i_mod_pre[demodulation_length+(INPUT_ARRAY_SIZE/DECIMATION_FACTOR)];
baxterja 73:b059b5bdc664 49 //float q_mod_pre[demodulation_length+(INPUT_ARRAY_SIZE/DECIMATION_FACTOR)];
baxterja 73:b059b5bdc664 50 uint16_t out_val_pre[pre_compute_length]; //used to write values to the dac
baxterja 69:014d4bbd4e03 51 float twopi = 3.14159265359 * 2;
baxterja 69:014d4bbd4e03 52
baxterja 69:014d4bbd4e03 53
baxterja 69:014d4bbd4e03 54 void pre_compute_tables() {
baxterja 69:014d4bbd4e03 55 // This function will precompute the cos and sin tables used in the rest of the program
baxterja 69:014d4bbd4e03 56 for(int precompute_counter = 0; precompute_counter < pre_compute_length; precompute_counter++){
baxterja 78:10b2916b8f5c 57 out_val_pre[precompute_counter] = (int) ((cos(twopi * CarrierFrequency /SAMPLEFREQUENCY * precompute_counter)+cos(twopi * 1000 /SAMPLEFREQUENCY * precompute_counter+3.14159265359)) * 1023.0 + 2048.0);//12 bit cos wave
baxterja 69:014d4bbd4e03 58 }
baxterja 73:b059b5bdc664 59
baxterja 73:b059b5bdc664 60 //float decimated_frequency = 6250;
baxterja 73:b059b5bdc664 61 //for(int precompute_counter = 0; precompute_counter < demodulation_length+(INPUT_ARRAY_SIZE/DECIMATION_FACTOR); precompute_counter++){
baxterja 73:b059b5bdc664 62 // i_mod_pre[precompute_counter] = (cos(twopi * CarrierFrequency / decimated_frequency * precompute_counter));
baxterja 73:b059b5bdc664 63 // q_mod_pre[precompute_counter] = (-sin(twopi * CarrierFrequency / decimated_frequency * precompute_counter));
baxterja 73:b059b5bdc664 64
baxterja 69:014d4bbd4e03 65 }
baxterja 69:014d4bbd4e03 66
baxterja 69:014d4bbd4e03 67
emilmont 7:65188f4a8c25 68 int main() {
baxterja 73:b059b5bdc664 69 pre_compute_tables();
baxterja 75:8bb94685c80b 70 precompute_tables();
baxterja 73:b059b5bdc664 71 //turn off all LEDs
timmey9 22:523e316cbe70 72 led_blue = 1;
timmey9 35:df40c4566826 73 led_green = 1;
timmey9 18:b17ddeeb1c09 74 led_red = 1;
timmey9 34:44cc9b76a507 75
baxterja 73:b059b5bdc664 76
baxterja 69:014d4bbd4e03 77 int DAC_COUNTER = 0;
baxterja 73:b059b5bdc664 78
baxterja 73:b059b5bdc664 79 pc.baud(230400);
baxterja 73:b059b5bdc664 80 pc.printf("Starting\r\n");
baxterja 78:10b2916b8f5c 81
baxterja 78:10b2916b8f5c 82 //Fs = 100000, FPass = 1500, FStop = 4500, -40db
baxterja 78:10b2916b8f5c 83 float Coeffs_100k[64] = {0.00368762746013400, -0.00390835182721185, -0.00352466159836192, -0.00378044968164769, -0.00434746630849834, -0.00502920744118478, -0.00570543677799210, -0.00628464650365093, -0.00668691824262464, -0.00683917139561193, -0.00667505410229485, -0.00613341508706847, -0.00516232410283893, -0.00371868951723358, -0.00177417571286934, 0.000685809876396031, 0.00365648516386919, 0.00711658039739992, 0.0110234409358280, 0.0153179248880130, 0.0199204447074274, 0.0247385052308702, 0.0296636617979935, 0.0345813441342327, 0.0393672306749833, 0.0438989152744108, 0.0480511039644129, 0.0517108728403463, 0.0547710075854812, 0.0571509837193129, 0.0587848911618005, 0.0596038010741317, 0.0596038010741317, 0.0587848911618005, 0.0571509837193129, 0.0547710075854812, 0.0517108728403463, 0.0480511039644129, 0.0438989152744108, 0.0393672306749833, 0.0345813441342327, 0.0296636617979935, 0.0247385052308702, 0.0199204447074274, 0.0153179248880130, 0.0110234409358280, 0.00711658039739992, 0.00365648516386919, 0.000685809876396031, -0.00177417571286934, -0.00371868951723358, -0.00516232410283893, -0.00613341508706847, -0.00667505410229485, -0.00683917139561193, -0.00668691824262464, -0.00628464650365093, -0.00570543677799210, -0.00502920744118478, -0.00434746630849834, -0.00378044968164769, -0.00352466159836192, -0.00390835182721185, 0.00368762746013400};
baxterja 78:10b2916b8f5c 84 //FS = 12500, Fpass = 100 Fstop 595 -50 db, picks on 1KHz signal
baxterja 78:10b2916b8f5c 85 float Coeffs_12500[64] = {-0.00222124676855946, -0.00163176345559825, -0.00214372257722720, -0.00268653504526241, -0.00323192624665395, -0.00374368158669702, -0.00417907979321931, -0.00449328006488225, -0.00463658803501384, -0.00455550760053878, -0.00419848205106894, -0.00352024663122325, -0.00247317556122392, -0.00102679426345247, 0.000845020041268567, 0.00315252023354445, 0.00589238992243332, 0.00904676286706929, 0.0125796442526745, 0.0164391331165775, 0.0205582919104753, 0.0248562683452381, 0.0292399202971496, 0.0336089813533200, 0.0378556202824368, 0.0418719268554270, 0.0455508704073759, 0.0487915537931733, 0.0515035460002020, 0.0536094934833149, 0.0550483048257919, 0.0557785148825623, 0.0557785148825623, 0.0550483048257919, 0.0536094934833149, 0.0515035460002020, 0.0487915537931733, 0.0455508704073759, 0.0418719268554270, 0.0378556202824368, 0.0336089813533200, 0.0292399202971496, 0.0248562683452381, 0.0205582919104753, 0.0164391331165775, 0.0125796442526745, 0.00904676286706929, 0.00589238992243332, 0.00315252023354445, 0.000845020041268567, -0.00102679426345247, -0.00247317556122392, -0.00352024663122325, -0.00419848205106894, -0.00455550760053878, -0.00463658803501384, -0.00449328006488225, -0.00417907979321931, -0.00374368158669702, -0.00323192624665395, -0.00268653504526241, -0.00214372257722720, -0.00163176345559825, -0.00222124676855946};
baxterja 78:10b2916b8f5c 86 //Fs = 1562.5 Fpass = 100, FStop = 195.6, null at 200 Hz
baxterja 78:10b2916b8f5c 87 float Coeffs_1563[32] = {-0.00296990567211633, 0.00784631357544163, 0.00955642274001412, 0.0105078670942049, 0.00746432577935901, -0.000715888274492355, -0.0127656342089486, -0.0248578255670040, -0.0313597093257934, -0.0264804428976321, -0.00639056527392095, 0.0289495639622991, 0.0749846381319702, 0.123239880157668, 0.163403327438059, 0.186215627611441, 0.186215627611441, 0.163403327438059, 0.123239880157668, 0.0749846381319702, 0.0289495639622991, -0.00639056527392095, -0.0264804428976321, -0.0313597093257934, -0.0248578255670040, -0.0127656342089486, -0.000715888274492355, 0.00746432577935901, 0.0105078670942049, 0.00955642274001412, 0.00784631357544163, -0.00296990567211633};
baxterja 78:10b2916b8f5c 88 //Fs = 781.25, Fpass = 60, Fstop = 120, -50 Db
baxterja 78:10b2916b8f5c 89 float Coeffs_782[32] = {-0.00423132648651131, -0.00413085595827858, -0.00212955364173648, 0.00345345707266939, 0.0105870277845968, 0.0147191914630408, 0.0108878516242339, -0.00283458314983071, -0.0224398052018669, -0.0377493805765767, -0.0358474685211045, -0.00721456868509791, 0.0483564412276129, 0.119338204671425, 0.185468453617916, 0.225354002914126, 0.225354002914126, 0.185468453617916, 0.119338204671425, 0.0483564412276129, -0.00721456868509791, -0.0358474685211045, -0.0377493805765767, -0.0224398052018669, -0.00283458314983071, 0.0108878516242339, 0.0147191914630408, 0.0105870277845968, 0.00345345707266939, -0.00212955364173648, -0.00413085595827858, -0.00423132648651131};
baxterja 76:704fc58ffcd0 90
baxterja 73:b059b5bdc664 91 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 92 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 93
baxterja 73:b059b5bdc664 94 for(int i = 0; i < 8; i++)
baxterja 77:1ee17a9e9f8b 95 input_50k[i] = new float[64];//each array represents the input of the adcs
baxterja 78:10b2916b8f5c 96
baxterja 78:10b2916b8f5c 97
baxterja 78:10b2916b8f5c 98 filters f4 = filters(4, 8, NULL, 8, 32, Coeffs_782,DEMOD_No_Demod);
baxterja 78:10b2916b8f5c 99 filters f3 = filters(4, 2, &f4, 4, 32, Coeffs_1563,DEMOD_No_Demod);
baxterja 78:10b2916b8f5c 100 filters f2 = filters(4, 8, &f3, 8, 64, Coeffs_12500,DEMOD_No_Demod);
baxterja 78:10b2916b8f5c 101 filters f1 = filters(2, 8, &f2, 64, 64, Coeffs_100k,DEMOD_200HZ);
baxterja 73:b059b5bdc664 102
baxterja 78:10b2916b8f5c 103 filters f4_b = filters(4, 8, NULL, 8, 32, Coeffs_782,DEMOD_No_Demod);
baxterja 78:10b2916b8f5c 104 filters f3_b = filters(4, 2, &f4_b, 4, 32, Coeffs_1563,DEMOD_No_Demod);
baxterja 78:10b2916b8f5c 105 filters f2_b = filters(4, 8, &f3_b, 8, 64, Coeffs_12500,DEMOD_No_Demod);
baxterja 78:10b2916b8f5c 106 filters f1_b = filters(2, 8, &f2_b, 64, 64, Coeffs_100k,DEMOD_1000HZ);
baxterja 73:b059b5bdc664 107
baxterja 78:10b2916b8f5c 108 //filters f_pre = filters(2, 2, &f1, 64, 64, Coeffs_50k,false);
baxterja 69:014d4bbd4e03 109
baxterja 73:b059b5bdc664 110 //float output_print_buffer[PRINT_BUFFER_LENGTH];//used to store the adc0 values(current measurment)
baxterja 73:b059b5bdc664 111 //float output_print_buffer2[PRINT_BUFFER_LENGTH];//used to store the adc0 values(voltage measurment)
baxterja 70:8cd7a8a2c153 112 int print_buffer_count = 0;
baxterja 70:8cd7a8a2c153 113
bmazzeo 66:72c5c24e532c 114 pdb_init(); // Initalize PDB
bmazzeo 66:72c5c24e532c 115 dac_init(); // initializes DAC
timmey9 45:d591d138cdeb 116 adc_init(); // always initialize adc before dma
bmazzeo 53:83a90a47c1fd 117 pc.printf("ADC Initialized\r\n");
baxterja 74:ebc9f09fda11 118 dma_init2(); // initializes DMAs
bmazzeo 55:2526b3317bc8 119 dma_reset(); // This clears any DMA triggers that may have gotten things into a different state
bmazzeo 67:ec0c58490ce6 120 pc.printf("Buffer Size: %i\r\n", len);
bmazzeo 54:1697dc574b96 121
timmey9 46:a015ebf4663b 122 led_green = 1;
timmey9 38:ec3b16c130d7 123
timmey9 40:bd6d8c35e822 124 pc.printf("\r\n\r\n\r\n");
timmey9 37:8bdc71f3e874 125
bmazzeo 64:bb4a4bd57681 126 pdb_start();
baxterja 70:8cd7a8a2c153 127 //while(print_buffer_count<PRINT_BUFFER_LENGTH)
baxterja 73:b059b5bdc664 128 while(!GATHER_STATISTICS||print_buffer_count<PRINT_BUFFER_LENGTH)
baxterja 73:b059b5bdc664 129 {
baxterja 77:1ee17a9e9f8b 130
baxterja 73:b059b5bdc664 131 while(sampling_status == 0)//wait until the ADCs read a new value
baxterja 73:b059b5bdc664 132 {
baxterja 73:b059b5bdc664 133 status_0 = 1;
baxterja 77:1ee17a9e9f8b 134 print_filter_data(&pc);
baxterja 75:8bb94685c80b 135 //Thread::wait(.0001);
baxterja 73:b059b5bdc664 136 }
baxterja 73:b059b5bdc664 137 sampling_status = 0;//sets sampling status to 0. DMA sets it to one once ADCs sample
baxterja 73:b059b5bdc664 138 status_0 = 0;//Tied to D0. use an O-scope to measure how much free time there is to play with.
baxterja 73:b059b5bdc664 139 status_1 = 1;//Tied to D1. use an O-scope to measure how much time the processing takes
baxterja 73:b059b5bdc664 140
baxterja 77:1ee17a9e9f8b 141 for(int i = 0; i < len; i++)
bmazzeo 61:a56cca07d4a6 142 {
baxterja 73:b059b5bdc664 143 static_output_array0[i] = out_val_pre[DAC_COUNTER];//DAC output
baxterja 73:b059b5bdc664 144 DAC_COUNTER++;//Counter to kepp track of where we are in our precomputed table
baxterja 73:b059b5bdc664 145 if (DAC_COUNTER>=pre_compute_length) {DAC_COUNTER = 0;}//wrap around the counter
baxterja 77:1ee17a9e9f8b 146 //static_output_array0[i+1] = out_val_pre[DAC_COUNTER];//DAC output
baxterja 77:1ee17a9e9f8b 147 //DAC_COUNTER++;//Counter to kepp track of where we are in our precomputed table
baxterja 77:1ee17a9e9f8b 148 //if (DAC_COUNTER>=pre_compute_length) {DAC_COUNTER = 0;}//wrap around the counter
baxterja 73:b059b5bdc664 149
baxterja 77:1ee17a9e9f8b 150 input_50k[1][i]=float(static_input_array1[i]);
baxterja 77:1ee17a9e9f8b 151 // input_50k[3][i/2]=static_input_array1[i+1];
baxterja 77:1ee17a9e9f8b 152 input_50k[0][i]=float(static_input_array0[i]);
baxterja 77:1ee17a9e9f8b 153 //input_50k[2][i/2]=static_input_array0[i+1];
baxterja 73:b059b5bdc664 154
baxterja 73:b059b5bdc664 155
baxterja 73:b059b5bdc664 156
baxterja 73:b059b5bdc664 157 }//End of for loop going throught the buffer of adc samples
baxterja 77:1ee17a9e9f8b 158 //input_50k[0] = static_input_array0;
baxterja 77:1ee17a9e9f8b 159 //input_50k[1] = static_input_array1;
baxterja 78:10b2916b8f5c 160 f1.input(input_50k,64,DEMOD_200HZ);
baxterja 78:10b2916b8f5c 161 f1_b.input(input_50k,64,DEMOD_1000HZ);
baxterja 77:1ee17a9e9f8b 162 //status_3 = 1;
baxterja 77:1ee17a9e9f8b 163 //pc.printf("Y");
baxterja 77:1ee17a9e9f8b 164 //status_3 = 0;
baxterja 73:b059b5bdc664 165
baxterja 70:8cd7a8a2c153 166
baxterja 73:b059b5bdc664 167 status_1 = 0;//turn off D1 used in deterimining how long processing is taking
baxterja 73:b059b5bdc664 168 //filter_input_array[i] = (float) (((int)static_input_array0[i]) - 0x8000);
baxterja 73:b059b5bdc664 169 //arm_fir_f32(&S, filter_input_array, filter_output_array, len);
baxterja 73:b059b5bdc664 170
baxterja 73:b059b5bdc664 171 }//end of while loop
baxterja 73:b059b5bdc664 172
baxterja 73:b059b5bdc664 173 //for(int i = 0; i<PRINT_BUFFER_LENGTH; i++)//print all the adc values measured
baxterja 73:b059b5bdc664 174 //{
baxterja 73:b059b5bdc664 175 // printf("%.1f %.1f\n\r",output_print_buffer[i],output_print_buffer2[i]);
baxterja 73:b059b5bdc664 176 //}
baxterja 73:b059b5bdc664 177
baxterja 70:8cd7a8a2c153 178
bmazzeo 61:a56cca07d4a6 179 }
bmazzeo 63:7903a33e2fd4 180