Ryan Yuyuenyongwatana / Mbed 2 deprecated Capstone

Capstone project files

Dependencies:   mbed-dsp mbed capstone_display_2

main.cpp@11:8c3b4995b05d, 2014-04-25 (annotated)

Committer:
ryanyuyu
Date:
Fri Apr 25 03:09:18 2014 +0000
Revision:
11:8c3b4995b05d
Parent:
10:ab4209a25811 
Final (For sure)

Who changed what in which revision?

UserRevisionLine numberNew contents of line
ryanyuyu 0:3aae5d23d0db 1 #include "mbed.h"
ryanyuyu 2:8ae58834937f 2 #include "FIR_f32.h"
ryanyuyu 0:3aae5d23d0db 3 #include "arm_math.h"
ryanyuyu 3:30dcfcf9412c 4 #include "display.h"
ryanyuyu 6:8441a6864784 5 #include "st7735.h"
ryanyuyu 7:fc55813f823e 6 //#include <string>
ryanyuyu 7:fc55813f823e 7 //#include <sstream>
ryanyuyu 2:8ae58834937f 8 #define f_sampling 2000 //the sampling frequency
ryanyuyu 4:9ee3ae61db7f 9 #define NumTaps 27 //the number of filter coefficients
ryanyuyu 4:9ee3ae61db7f 10 #define BlockSize 512 //the size of the buffer
ryanyuyu 9:4aa641641420 11 #define numCallibrationSteps 12 //the number of callibration steps or points
ryanyuyu 9:4aa641641420 12 #define numGainStages 4
ryanyuyu 4:9ee3ae61db7f 13 Serial pc(USBTX, USBRX); //USB serial for PC, to be removed later
ryanyuyu 4:9ee3ae61db7f 14 AnalogOut waveOut(p18); //for debugging
ryanyuyu 4:9ee3ae61db7f 15
ryanyuyu 11:8c3b4995b05d 16
ryanyuyu 11:8c3b4995b05d 17
ryanyuyu 11:8c3b4995b05d 18
ryanyuyu 11:8c3b4995b05d 19
ryanyuyu 4:9ee3ae61db7f 20 //-------------------- SPI communication
ryanyuyu 6:8441a6864784 21 SPI spi(p5, p6, p7); //MOSI, MISO, SCLK
ryanyuyu 3:30dcfcf9412c 22 DigitalOut cs(p8);
ryanyuyu 6:8441a6864784 23 DigitalIn button(p21);
ryanyuyu 4:9ee3ae61db7f 24
ryanyuyu 4:9ee3ae61db7f 25 //-------------------- LCD display
ryanyuyu 3:30dcfcf9412c 26 ST7735_LCD disp( p14, p13, p12, p10, p11); //for digital display
ryanyuyu 3:30dcfcf9412c 27 display lcd(&disp);
ryanyuyu 6:8441a6864784 28 char* newString(int length); //prototype for newString
ryanyuyu 7:fc55813f823e 29 char* outputString = newString(64);
ryanyuyu 7:fc55813f823e 30 char* strength = newString(64);
ryanyuyu 7:fc55813f823e 31 char* dist = newString(64);
ryanyuyu 2:8ae58834937f 32
ryanyuyu 4:9ee3ae61db7f 33 //-------------------- signal-related stuff
ryanyuyu 2:8ae58834937f 34 AnalogIn input(p15); //pin 15 for analog reading
ryanyuyu 2:8ae58834937f 35 float32_t waveform[BlockSize]; //array of input data
ryanyuyu 2:8ae58834937f 36 float32_t postFilterData[BlockSize]; //array of filtered data
ryanyuyu 2:8ae58834937f 37 bool fullRead; //whether the MBED has finish
ryanyuyu 2:8ae58834937f 38 bool waitForNext;
ryanyuyu 4:9ee3ae61db7f 39 int index_g; //tracks the index for the waveform array
ryanyuyu 2:8ae58834937f 40
ryanyuyu 6:8441a6864784 41 //-------------------for distance calculation and calibration
ryanyuyu 6:8441a6864784 42 bool adjusting = true; //whether the user is still adjusting the beacon's distance
ryanyuyu 11:8c3b4995b05d 43 float minThreshold = .042;
ryanyuyu 11:8c3b4995b05d 44 float maxThresholds[numGainStages] = {.400, .400, .400, .400};
ryanyuyu 8:dcc69fc6d88b 45 float average = 0;
ryanyuyu 9:4aa641641420 46 float pastAverage1 = 0;
ryanyuyu 9:4aa641641420 47 float pastAverage2 = 0;
ryanyuyu 6:8441a6864784 48 int callibrationStep;
ryanyuyu 6:8441a6864784 49 int state;
ryanyuyu 6:8441a6864784 50 int gainStage;
ryanyuyu 6:8441a6864784 51 float gainMultiplier;
ryanyuyu 11:8c3b4995b05d 52 float gainCutoffs[numGainStages] = {20.639122, 71.663605, 1486.016724, 8599.633789};
ryanyuyu 6:8441a6864784 53 //gainCutoffs = {20.0, 100.0, 1200.0, 10000.0};
ryanyuyu 4:9ee3ae61db7f 54 float gain1;
ryanyuyu 6:8441a6864784 55 float gain0;
ryanyuyu 6:8441a6864784 56 //These constants are for linear interpolation for the varius gain stage. Two linear equations per stage (piecewise)
ryanyuyu 6:8441a6864784 57 float linearSamples[numCallibrationSteps];
ryanyuyu 9:4aa641641420 58 int callibrationPoints[numCallibrationSteps] = {6, 10, 14, 14, 20, 24, 26, 36, 50, 50, 62, 78};
ryanyuyu 6:8441a6864784 59 //callibrationPoints = {6, 10, 14, 14, 20, 24, 26, 36, 50, 50, 62, 78};
ryanyuyu 6:8441a6864784 60
ryanyuyu 11:8c3b4995b05d 61 //the slopes and y-intercepts and mid voltages.
ryanyuyu 11:8c3b4995b05d 62 float mLower[numGainStages] = {-15.322362, -108.246826, -43.797886, 90.550484};
ryanyuyu 11:8c3b4995b05d 63 float mUpper[numGainStages] = {-100.010368, -485.365387, -186.721283, -223.606857};
ryanyuyu 11:8c3b4995b05d 64 float bLower[numGainStages] = {11.394491, 25.797676, 42.176929, 77.429733};
ryanyuyu 11:8c3b4995b05d 65 float bUpper[numGainStages] = {19.101967, 45.996063, 62.333790, 100.10244};
ryanyuyu 11:8c3b4995b05d 66 float mid[numGainStages] = {0.091010, 0.053560, 0.141033, 0.170399};
ryanyuyu 11:8c3b4995b05d 67 float fix = -0.75;
ryanyuyu 6:8441a6864784 68
ryanyuyu 6:8441a6864784 69 /*
ryanyuyu 6:8441a6864784 70 float m10;
ryanyuyu 6:8441a6864784 71 float b10;
ryanyuyu 6:8441a6864784 72 float mid1;
ryanyuyu 6:8441a6864784 73 float m11;
ryanyuyu 6:8441a6864784 74 float b11;
ryanyuyu 6:8441a6864784 75
ryanyuyu 6:8441a6864784 76 float m20;
ryanyuyu 6:8441a6864784 77 float b20;
ryanyuyu 6:8441a6864784 78 float mid2;
ryanyuyu 6:8441a6864784 79 float m21;
ryanyuyu 6:8441a6864784 80 float b21;
ryanyuyu 6:8441a6864784 81
ryanyuyu 6:8441a6864784 82 float m30;
ryanyuyu 6:8441a6864784 83 float b30;
ryanyuyu 6:8441a6864784 84 float mid3;
ryanyuyu 6:8441a6864784 85 float m31;
ryanyuyu 6:8441a6864784 86 float b31;
ryanyuyu 6:8441a6864784 87 */
ryanyuyu 3:30dcfcf9412c 88
ryanyuyu 4:9ee3ae61db7f 89 //------------------------the filter coefficients for FIR filter
ryanyuyu 2:8ae58834937f 90 float32_t pCoeffs[NumTaps] =
ryanyuyu 2:8ae58834937f 91 { 0.012000000000000, 0.012462263166161, -0.019562318415964, -0.026175892863747,
ryanyuyu 2:8ae58834937f 92 0.031654803781611, 0.050648026372209, -0.032547136829180, -0.070997780956819,
ryanyuyu 2:8ae58834937f 93 0.032992306874347, 0.094643188024724, -0.020568171368385, -0.106071176200193,
ryanyuyu 2:8ae58834937f 94 0.009515198320277, 0.114090808482376, 0.009515198320275, -0.106071176200193,
ryanyuyu 2:8ae58834937f 95 -0.020568171368382, 0.094643188024728, 0.032992306874351, -0.070997780956815,
ryanyuyu 2:8ae58834937f 96 -0.032547136829177, 0.050648026372211, 0.031654803781612, -0.026175892863746,
ryanyuyu 2:8ae58834937f 97 -0.019562318415964, 0.012462263166161, 0.012000000000000 };
ryanyuyu 4:9ee3ae61db7f 98 float32_t pState[NumTaps + BlockSize - 1];
ryanyuyu 3:30dcfcf9412c 99 // */
ryanyuyu 4:9ee3ae61db7f 100
ryanyuyu 4:9ee3ae61db7f 101
ryanyuyu 4:9ee3ae61db7f 102 //-----------------------IIR stuff (if needed)
ryanyuyu 4:9ee3ae61db7f 103 /*
ryanyuyu 4:9ee3ae61db7f 104 float32_t pkCoeffs[NumTaps] =
ryanyuyu 4:9ee3ae61db7f 105 {
ryanyuyu 4:9ee3ae61db7f 106 1,-2.496708288,3.17779085,-2.022333713,0.6561,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0
ryanyuyu 4:9ee3ae61db7f 107 };
ryanyuyu 4:9ee3ae61db7f 108
ryanyuyu 4:9ee3ae61db7f 109 float32_t pvCoeffs[NumTaps] =
ryanyuyu 4:9ee3ae61db7f 110 {
ryanyuyu 4:9ee3ae61db7f 111 0.0000556000,0.0002167120,0.0004326320,0.0005056930,0.0002111890,-0.0004911030,-0.0013071920,-0.0017060250,-0.0012444070,0.0000684000,0.0016603140,0.0026622100,0.0024306750,0.0009787140,-0.0009787140,-0.0024306750,-0.0026622100,-0.0016603140,-0.0000684000,0.0012444070,0.0017060250,0.0013071920,0.0004911030,-0.0002111890,-0.0005056930,-0.0004326320,-0.0002167120,-0.0000556000
ryanyuyu 4:9ee3ae61db7f 112 };
ryanyuyu 4:9ee3ae61db7f 113 float32_t pState[NumTaps + BlockSize];
ryanyuyu 4:9ee3ae61db7f 114 //*/
ryanyuyu 4:9ee3ae61db7f 115
ryanyuyu 4:9ee3ae61db7f 116
ryanyuyu 4:9ee3ae61db7f 117 //--------------------------------if needed, the 4kHz FIR filter
ryanyuyu 3:30dcfcf9412c 118 /*
ryanyuyu 3:30dcfcf9412c 119 float32_t pCoeffs[NumTaps] =
ryanyuyu 3:30dcfcf9412c 120 {
ryanyuyu 3:30dcfcf9412c 121 -0.00130297171184699, -0.00456436168827987, -0.00757978930408609, -0.00696944302000657,
ryanyuyu 3:30dcfcf9412c 122 -0.00100059082174453, 0.00812867271498616, 0.0148953048520266, 0.0137935053264369,
ryanyuyu 3:30dcfcf9412c 123 0.00350484996910501, -0.0112195199182290, -0.0216305356563913, -0.0202538386423356,
ryanyuyu 3:30dcfcf9412c 124 -0.00609419278464673, 0.0137348990478646, 0.0275645559768492, 0.0261107576153156,
ryanyuyu 3:30dcfcf9412c 125 0.00866220574766616, -0.0156131009924596, -0.0324957126350438, -0.0311514181527343,
ryanyuyu 3:30dcfcf9412c 126 -0.0110879396617141, 0.0168179120126559, 0.0362758644669149, 0.0352058948414930,
ryanyuyu 3:30dcfcf9412c 127 0.0132978095684398, -0.0172706692984796, -0.0386711719606551, -0.0379507530937637,
ryanyuyu 3:30dcfcf9412c 128 -0.0149419841919419, 0.0172996706397712, 0.0400000000000000, 0.0397279151377323,
ryanyuyu 3:30dcfcf9412c 129 0.0164353142069562, -0.0164055618588934, -0.0396949785867063, -0.0399629114640568,
ryanyuyu 3:30dcfcf9412c 130 -0.0172605211576678, 0.0149790280104299, 0.0379815311949588, 0.0386933807609119,
ryanyuyu 3:30dcfcf9412c 131 0.0172844840085185, -0.0132904115318555, -0.0352024033389307, -0.0362742608690452,
ryanyuyu 3:30dcfcf9412c 132 -0.0168170401765007, 0.0110885383139611, 0.0311518509994083, 0.0324959946809230,
ryanyuyu 3:30dcfcf9412c 133 0.0156132578212073, -0.00866213238945794, -0.0261107291487171, -0.0275645472357883,
ryanyuyu 3:30dcfcf9412c 134 -0.0137348973043660, 0.00609419268963993, 0.0202538383407381, 0.0216305354798053,
ryanyuyu 3:30dcfcf9412c 135 0.0112195198475825, -0.00350484999121515, -0.0137935053321021, -0.0148953048532365,
ryanyuyu 3:30dcfcf9412c 136 -0.00812867271519995, 0.00100059082171422, 0.00696944302000319, 0.00757978930408577,
ryanyuyu 3:30dcfcf9412c 137 0.00456436168827984, 0.00130297171184699
ryanyuyu 3:30dcfcf9412c 138 };
ryanyuyu 3:30dcfcf9412c 139 //*/
ryanyuyu 4:9ee3ae61db7f 140
ryanyuyu 2:8ae58834937f 141
ryanyuyu 2:8ae58834937f 142
ryanyuyu 0:3aae5d23d0db 143
ryanyuyu 6:8441a6864784 144 char* newString(int length) //creates an initialized string of given length
ryanyuyu 6:8441a6864784 145 {
ryanyuyu 6:8441a6864784 146 char* temp = new char[length+1];
ryanyuyu 6:8441a6864784 147 for (int i = 0; i <= length; i++) temp[i] = '\0';
ryanyuyu 6:8441a6864784 148 return temp;
ryanyuyu 6:8441a6864784 149 }
ryanyuyu 6:8441a6864784 150
ryanyuyu 7:fc55813f823e 151 /*
ryanyuyu 7:fc55813f823e 152 std::string convert(float number)
ryanyuyu 7:fc55813f823e 153 {
ryanyuyu 7:fc55813f823e 154 std::ostringstream buffer;
ryanyuyu 7:fc55813f823e 155 buffer<<number;
ryanyuyu 7:fc55813f823e 156 return buffer.str();
ryanyuyu 7:fc55813f823e 157 }
ryanyuyu 7:fc55813f823e 158 */
ryanyuyu 7:fc55813f823e 159
ryanyuyu 2:8ae58834937f 160
ryanyuyu 4:9ee3ae61db7f 161 /*
ryanyuyu 4:9ee3ae61db7f 162 This is a helper function for precision timing of Tickers
ryanyuyu 4:9ee3ae61db7f 163 */
ryanyuyu 2:8ae58834937f 164 void readPoint()
ryanyuyu 2:8ae58834937f 165 {
ryanyuyu 2:8ae58834937f 166 waitForNext = false;
ryanyuyu 2:8ae58834937f 167 }
ryanyuyu 2:8ae58834937f 168
ryanyuyu 2:8ae58834937f 169
ryanyuyu 2:8ae58834937f 170 /**
ryanyuyu 2:8ae58834937f 171 * This function reads one full set of analog data into the uC
ryanyuyu 2:8ae58834937f 172 */
ryanyuyu 2:8ae58834937f 173 void readSamples()
ryanyuyu 2:8ae58834937f 174 {
ryanyuyu 2:8ae58834937f 175 Ticker sampler; //allows for precision data reading
ryanyuyu 2:8ae58834937f 176 waitForNext = true;
ryanyuyu 2:8ae58834937f 177 sampler.attach_us(&readPoint, (int) (1000000/f_sampling) ); //read in data according the sampling freq
ryanyuyu 2:8ae58834937f 178 for (int i = 0; i < BlockSize; i++)
ryanyuyu 2:8ae58834937f 179 {
ryanyuyu 2:8ae58834937f 180 while (waitForNext); //wait until the ticker calls for the next sample
ryanyuyu 2:8ae58834937f 181 waveform[i] = input.read();
ryanyuyu 2:8ae58834937f 182 waitForNext = true;
ryanyuyu 2:8ae58834937f 183 }
ryanyuyu 2:8ae58834937f 184 sampler.detach();
ryanyuyu 2:8ae58834937f 185 }
ryanyuyu 3:30dcfcf9412c 186
ryanyuyu 4:9ee3ae61db7f 187 /**
ryanyuyu 4:9ee3ae61db7f 188 This function spits out the waveform on the analogOut pin (p18)
ryanyuyu 4:9ee3ae61db7f 189 This function will be unused in the final version, but is still usefull for debugging.
ryanyuyu 4:9ee3ae61db7f 190 @param array (float32_t *): (array of data) pointer to the data to output over the analogOut pin
ryanyuyu 4:9ee3ae61db7f 191 @return none
ryanyuyu 4:9ee3ae61db7f 192 */
ryanyuyu 4:9ee3ae61db7f 193 void outputWaveform(float32_t* array)
ryanyuyu 3:30dcfcf9412c 194 {
ryanyuyu 3:30dcfcf9412c 195 Ticker outputter;
ryanyuyu 3:30dcfcf9412c 196 waitForNext = true;
ryanyuyu 3:30dcfcf9412c 197 outputter.attach_us(&readPoint, (int) (1000000/f_sampling) ); //output data according the sampling freq
ryanyuyu 3:30dcfcf9412c 198 for (int i = 0; i < BlockSize; i++)
ryanyuyu 3:30dcfcf9412c 199 {
ryanyuyu 3:30dcfcf9412c 200 while (waitForNext); //wait until the ticker calls for the next data point
ryanyuyu 4:9ee3ae61db7f 201 waveOut.write(array[i]);
ryanyuyu 3:30dcfcf9412c 202 waitForNext = true;
ryanyuyu 3:30dcfcf9412c 203 }
ryanyuyu 3:30dcfcf9412c 204 outputter.detach();
ryanyuyu 3:30dcfcf9412c 205 }
ryanyuyu 3:30dcfcf9412c 206
ryanyuyu 4:9ee3ae61db7f 207 /*
ryanyuyu 4:9ee3ae61db7f 208 This method writes to the digital potentiometer (MCP4251)
ryanyuyu 4:9ee3ae61db7f 209 @param wiperNo (int): this is the wiper number to write to (either 0 or 1)
ryanyuyu 4:9ee3ae61db7f 210 @param kOhms (float): this is the value to set the resistance (in kilo Ohms) between the wiper and terminal B
ryanyuyu 4:9ee3ae61db7f 211 note
ryanyuyu 6:8441a6864784 212 @return: the integer command actually sent (for debugging)
ryanyuyu 4:9ee3ae61db7f 213 */
ryanyuyu 4:9ee3ae61db7f 214 int setPot(int wiperNo, float kOhms)
ryanyuyu 3:30dcfcf9412c 215 {
ryanyuyu 3:30dcfcf9412c 216 //257 steps (8 bits + 1), see section 7.0 for SPI instructions
ryanyuyu 3:30dcfcf9412c 217 float Rmax = 100000;
ryanyuyu 3:30dcfcf9412c 218 spi.frequency(2000000);
ryanyuyu 3:30dcfcf9412c 219 spi.format(16, 0); //16 bits, mode b00
ryanyuyu 3:30dcfcf9412c 220 float ratio = kOhms * 1000.0 / Rmax;
ryanyuyu 3:30dcfcf9412c 221 if (ratio > 1) ratio = 1;
ryanyuyu 3:30dcfcf9412c 222 if (ratio < 0) ratio = 0;
ryanyuyu 3:30dcfcf9412c 223 int dataBits = (int) (ratio * 0x100);
ryanyuyu 3:30dcfcf9412c 224 int command = wiperNo << 12; //setting the Address and Command bits
ryanyuyu 4:9ee3ae61db7f 225 command += dataBits; //add in the data bits (digital settings)
ryanyuyu 3:30dcfcf9412c 226 spi.write(command);
ryanyuyu 3:30dcfcf9412c 227 return command;
ryanyuyu 3:30dcfcf9412c 228 }
ryanyuyu 3:30dcfcf9412c 229
ryanyuyu 6:8441a6864784 230 /**
ryanyuyu 6:8441a6864784 231 This function uses both sides of the digital pot to produce an overall gain for the circuit. It uses side1 (post filter) before side0 (prefilter)
ryanyuyu 6:8441a6864784 232 @param gain (float): the overall gain wanted (bound by [1, 10000] inclusive)
ryanyuyu 6:8441a6864784 233 */
ryanyuyu 6:8441a6864784 234 void setGain(float gain)
ryanyuyu 6:8441a6864784 235 {
ryanyuyu 6:8441a6864784 236 if (gain < 0) return;
ryanyuyu 6:8441a6864784 237 if (gain <= 100.0) //only side1 is used
ryanyuyu 6:8441a6864784 238 {
ryanyuyu 6:8441a6864784 239 setPot(0, 1.0);
ryanyuyu 6:8441a6864784 240 setPot(1, gain);
ryanyuyu 6:8441a6864784 241 }
ryanyuyu 6:8441a6864784 242 else if (gain <= 10000)
ryanyuyu 6:8441a6864784 243 {
ryanyuyu 6:8441a6864784 244 setPot(1, 100.0);
ryanyuyu 6:8441a6864784 245 setPot(0, gain / 100.0);
ryanyuyu 6:8441a6864784 246 }
ryanyuyu 6:8441a6864784 247 else
ryanyuyu 6:8441a6864784 248 {
ryanyuyu 6:8441a6864784 249 setPot(1, 100.0);
ryanyuyu 6:8441a6864784 250 setPot(0, gain / 100.0);
ryanyuyu 6:8441a6864784 251 }
ryanyuyu 6:8441a6864784 252 }
ryanyuyu 6:8441a6864784 253
ryanyuyu 4:9ee3ae61db7f 254 /*
ryanyuyu 4:9ee3ae61db7f 255 This function calculates the RMS (root mean squared) of an array of float data.
ryanyuyu 4:9ee3ae61db7f 256 @param array (float32_t *): the array to calculate RMS from
ryanyuyu 4:9ee3ae61db7f 257 @return float_32: the resulting RMS value of the given array
ryanyuyu 4:9ee3ae61db7f 258 */
ryanyuyu 4:9ee3ae61db7f 259 float32_t rms(float32_t* array)
ryanyuyu 3:30dcfcf9412c 260 {
ryanyuyu 3:30dcfcf9412c 261 float32_t rms = 0;
ryanyuyu 3:30dcfcf9412c 262 for(int i = 0; i < BlockSize; i++)
ryanyuyu 3:30dcfcf9412c 263 {
ryanyuyu 4:9ee3ae61db7f 264 rms += array[i]*array[i];
ryanyuyu 3:30dcfcf9412c 265 }
ryanyuyu 4:9ee3ae61db7f 266 //pc.printf("Sum of squares %f\n\r", rms);
ryanyuyu 3:30dcfcf9412c 267 return sqrt(rms/BlockSize);
ryanyuyu 3:30dcfcf9412c 268 }
ryanyuyu 4:9ee3ae61db7f 269
ryanyuyu 6:8441a6864784 270
ryanyuyu 6:8441a6864784 271 /**
ryanyuyu 6:8441a6864784 272 This function will wait for a button press. It will work 250ms after being called (to reduce double reads)
ryanyuyu 6:8441a6864784 273 */
ryanyuyu 6:8441a6864784 274 void waitForButton()
ryanyuyu 4:9ee3ae61db7f 275 {
ryanyuyu 6:8441a6864784 276 wait_ms(250); //to ward off double reads or sticky buttons
ryanyuyu 6:8441a6864784 277 while(button.read() == 0) wait_ms(10); //poll button press every 10ms
ryanyuyu 6:8441a6864784 278 //char* outputString = newString(32);
ryanyuyu 6:8441a6864784 279 //outputString = "Button pressed.";
ryanyuyu 9:4aa641641420 280 lcd.clearscreen();
ryanyuyu 6:8441a6864784 281 lcd.print("Button pressed.");
ryanyuyu 9:4aa641641420 282 wait_ms(250);
ryanyuyu 9:4aa641641420 283 lcd.clearscreen();
ryanyuyu 6:8441a6864784 284 }
ryanyuyu 6:8441a6864784 285
ryanyuyu 6:8441a6864784 286
ryanyuyu 6:8441a6864784 287 /**
ryanyuyu 6:8441a6864784 288 This function takes RMS voltage and estimates the distance using linear interpolations.
ryanyuyu 6:8441a6864784 289 Each gain stage is split into a 2-piece-wise linear funtion for estimation
ryanyuyu 6:8441a6864784 290 @param value (float): the post-filter RMS value
ryanyuyu 6:8441a6864784 291 @return (float): the distance estimate in inches (6 to 84) assuming perfect alignment, or special:
ryanyuyu 6:8441a6864784 292 Special cases:
ryanyuyu 6:8441a6864784 293 -1: clipping likely, too close adjust to a lower gain stage
ryanyuyu 6:8441a6864784 294 999: cannot detect signal (too far), adjust to higher gain stage
ryanyuyu 6:8441a6864784 295 */
ryanyuyu 6:8441a6864784 296 float estimateDistance(float value)
ryanyuyu 6:8441a6864784 297 {
ryanyuyu 6:8441a6864784 298 //if outside range, then alert to try to adjust the gain settings
ryanyuyu 6:8441a6864784 299 if (value < minThreshold*1.10) return 999;
ryanyuyu 8:dcc69fc6d88b 300 if (value > maxThresholds[gainStage]*.97) return -1;
ryanyuyu 6:8441a6864784 301
ryanyuyu 6:8441a6864784 302 switch (gainStage)
ryanyuyu 6:8441a6864784 303 {
ryanyuyu 6:8441a6864784 304 case 0:
ryanyuyu 11:8c3b4995b05d 305 if (value > mid[0]) return mLower[0]*value + bLower[0] + fix;
ryanyuyu 11:8c3b4995b05d 306 else return mUpper[0]*value + bUpper[0] + fix;
ryanyuyu 6:8441a6864784 307 case 1:
ryanyuyu 11:8c3b4995b05d 308 if (value > mid[1]) return mLower[1]*value + bLower[1] + fix;
ryanyuyu 11:8c3b4995b05d 309 else return mUpper[1]*value + bUpper[1] + fix;
ryanyuyu 6:8441a6864784 310 case 2:
ryanyuyu 11:8c3b4995b05d 311 if (value > mid[2]) return mLower[2]*value + bLower[2] + fix;
ryanyuyu 11:8c3b4995b05d 312 else return mUpper[2]*value + bUpper[2] + fix;
ryanyuyu 6:8441a6864784 313 case 3:
ryanyuyu 11:8c3b4995b05d 314 if (value > mid[3]) return mLower[3]*value + bLower[3] + fix;
ryanyuyu 11:8c3b4995b05d 315 else return mUpper[3]*value + bUpper[3] + fix;
ryanyuyu 9:4aa641641420 316 //*/
ryanyuyu 6:8441a6864784 317 default:
ryanyuyu 6:8441a6864784 318 return 0;
ryanyuyu 6:8441a6864784 319 }
ryanyuyu 4:9ee3ae61db7f 320 }
ryanyuyu 4:9ee3ae61db7f 321
ryanyuyu 6:8441a6864784 322 /**
ryanyuyu 6:8441a6864784 323 This function takes in a distance estimate and tries to change the gain stage
ryanyuyu 6:8441a6864784 324 @param distance (float): the RMS from estimateDistance
ryanyuyu 6:8441a6864784 325 */
ryanyuyu 6:8441a6864784 326 void adjustGains(float distance)
ryanyuyu 4:9ee3ae61db7f 327 {
ryanyuyu 7:fc55813f823e 328 //pc.printf("GainStage = %d Distance=%f\n\r", gainStage, distance);
ryanyuyu 6:8441a6864784 329 if (distance == -1) //the special case for clipping
ryanyuyu 4:9ee3ae61db7f 330 {
ryanyuyu 7:fc55813f823e 331 //pc.printf(" Too close\n\r");
ryanyuyu 7:fc55813f823e 332 if (gainStage > 0) gainStage--;
ryanyuyu 7:fc55813f823e 333 else lcd.print("Clipping. Back up.");
ryanyuyu 4:9ee3ae61db7f 334 }
ryanyuyu 7:fc55813f823e 335 else if (distance == 999) //the special case for being too far
ryanyuyu 4:9ee3ae61db7f 336 {
ryanyuyu 7:fc55813f823e 337 //pc.printf(" Too far.\n\r");
ryanyuyu 11:8c3b4995b05d 338 if (gainStage < numGainStages-1) gainStage++;
ryanyuyu 7:fc55813f823e 339 else lcd.print("No beacon found.");
ryanyuyu 4:9ee3ae61db7f 340 }
ryanyuyu 10:ab4209a25811 341 else lcd.print("");
ryanyuyu 6:8441a6864784 342 setGain( gainCutoffs[gainStage] );
ryanyuyu 6:8441a6864784 343 //return gainStage;
ryanyuyu 4:9ee3ae61db7f 344 }
ryanyuyu 4:9ee3ae61db7f 345
ryanyuyu 6:8441a6864784 346 void enforceGainStage()
ryanyuyu 6:8441a6864784 347 {
ryanyuyu 8:dcc69fc6d88b 348 setGain( gainCutoffs[gainStage] );
ryanyuyu 6:8441a6864784 349 }
ryanyuyu 6:8441a6864784 350
ryanyuyu 6:8441a6864784 351 /**
ryanyuyu 6:8441a6864784 352 This function takes one point of callibration data.
ryanyuyu 6:8441a6864784 353 */
ryanyuyu 6:8441a6864784 354 void callibratePoint(float value)
ryanyuyu 4:9ee3ae61db7f 355 {
ryanyuyu 8:dcc69fc6d88b 356 if (callibrationStep%3 == 1) //this looks for the gain stage thresholds
ryanyuyu 6:8441a6864784 357 {
ryanyuyu 8:dcc69fc6d88b 358 if (adjusting)
ryanyuyu 8:dcc69fc6d88b 359 {
ryanyuyu 8:dcc69fc6d88b 360 //outputString = "Turn off the beacon. Press the button when done.";
ryanyuyu 8:dcc69fc6d88b 361 gainStage = callibrationStep/3;
ryanyuyu 8:dcc69fc6d88b 362 snprintf(outputString, 32, "%i in.", callibrationPoints[ callibrationStep-1 ]);
ryanyuyu 8:dcc69fc6d88b 363 lcd.calibrationdist(outputString);
ryanyuyu 8:dcc69fc6d88b 364 waitForButton();
ryanyuyu 8:dcc69fc6d88b 365 adjusting = false;
ryanyuyu 8:dcc69fc6d88b 366 state = 2;
ryanyuyu 8:dcc69fc6d88b 367 gainMultiplier = .2;
ryanyuyu 8:dcc69fc6d88b 368 gainCutoffs[ gainStage ] *= .2;
ryanyuyu 8:dcc69fc6d88b 369 enforceGainStage();
ryanyuyu 8:dcc69fc6d88b 370 }
ryanyuyu 8:dcc69fc6d88b 371 else
ryanyuyu 8:dcc69fc6d88b 372 {
ryanyuyu 9:4aa641641420 373 //pc.printf("Av=%f gainStage=%d\n\r", gainMultiplier, gainStage);
ryanyuyu 9:4aa641641420 374 if (pastAverage1*1.15 < average || pastAverage1 < minThreshold*3) //not yet maxed, so bump up gainMultiplier
ryanyuyu 8:dcc69fc6d88b 375 {
ryanyuyu 8:dcc69fc6d88b 376 gainMultiplier *= 1.2;
ryanyuyu 8:dcc69fc6d88b 377 gainCutoffs[ gainStage ] *= 1.2;
ryanyuyu 8:dcc69fc6d88b 378 enforceGainStage();
ryanyuyu 9:4aa641641420 379 pastAverage2 = pastAverage1;
ryanyuyu 9:4aa641641420 380 pastAverage1 = average;
ryanyuyu 8:dcc69fc6d88b 381 }
ryanyuyu 8:dcc69fc6d88b 382 else //move onto next callibration step
ryanyuyu 8:dcc69fc6d88b 383 {
ryanyuyu 8:dcc69fc6d88b 384 adjusting = true;
ryanyuyu 9:4aa641641420 385 linearSamples[ callibrationStep-1 ] = pastAverage2; //record the intensity from 2 stages ago
ryanyuyu 9:4aa641641420 386 maxThresholds[ gainStage ] = pastAverage1;
ryanyuyu 9:4aa641641420 387 gainCutoffs[ gainStage ] /= 1.44;
ryanyuyu 8:dcc69fc6d88b 388 enforceGainStage();
ryanyuyu 9:4aa641641420 389 pastAverage1 = minThreshold;
ryanyuyu 9:4aa641641420 390 pastAverage2 = minThreshold;
ryanyuyu 8:dcc69fc6d88b 391 callibrationStep++;
ryanyuyu 8:dcc69fc6d88b 392 }
ryanyuyu 8:dcc69fc6d88b 393 state = 1;
ryanyuyu 8:dcc69fc6d88b 394 }
ryanyuyu 8:dcc69fc6d88b 395 }
ryanyuyu 8:dcc69fc6d88b 396 else //----------regular point-------------------------------
ryanyuyu 8:dcc69fc6d88b 397 {
ryanyuyu 8:dcc69fc6d88b 398 if (adjusting)
ryanyuyu 8:dcc69fc6d88b 399 {
ryanyuyu 8:dcc69fc6d88b 400 gainStage = (callibrationStep) / 3;
ryanyuyu 8:dcc69fc6d88b 401 snprintf(outputString, 32, "%i", callibrationPoints[ callibrationStep-1 ]);
ryanyuyu 8:dcc69fc6d88b 402 lcd.calibrationdist(outputString);
ryanyuyu 8:dcc69fc6d88b 403 waitForButton();
ryanyuyu 8:dcc69fc6d88b 404 adjusting = false;
ryanyuyu 8:dcc69fc6d88b 405 state = 2;
ryanyuyu 8:dcc69fc6d88b 406 }
ryanyuyu 8:dcc69fc6d88b 407 else
ryanyuyu 8:dcc69fc6d88b 408 {
ryanyuyu 8:dcc69fc6d88b 409 enforceGainStage();
ryanyuyu 8:dcc69fc6d88b 410 linearSamples[ callibrationStep - 1] = value;
ryanyuyu 8:dcc69fc6d88b 411 callibrationStep++; //move to next callibration step
ryanyuyu 8:dcc69fc6d88b 412 //get ready for next callibration step
ryanyuyu 8:dcc69fc6d88b 413 adjusting = true;
ryanyuyu 8:dcc69fc6d88b 414 state = 1;
ryanyuyu 8:dcc69fc6d88b 415 }
ryanyuyu 6:8441a6864784 416 }
ryanyuyu 4:9ee3ae61db7f 417 }
ryanyuyu 0:3aae5d23d0db 418
ryanyuyu 0:3aae5d23d0db 419 int main() {
ryanyuyu 4:9ee3ae61db7f 420 //arm_iir_lattice_instance_f32* filter1 = new arm_iir_lattice_instance_f32();
ryanyuyu 4:9ee3ae61db7f 421 arm_fir_instance_f32* filter = new arm_fir_instance_f32();
ryanyuyu 6:8441a6864784 422 float history[10]; //history of RMS voltages.
ryanyuyu 6:8441a6864784 423
ryanyuyu 6:8441a6864784 424 state = 0; //which state of the state machine to be in, change to enum if desired
ryanyuyu 2:8ae58834937f 425
ryanyuyu 2:8ae58834937f 426 uint16_t numTaps = NumTaps;
ryanyuyu 2:8ae58834937f 427 uint32_t blockSize = BlockSize;
ryanyuyu 3:30dcfcf9412c 428 char buffer[32]; //for debugging scanf things
ryanyuyu 6:8441a6864784 429 //char* outputString = newString(30); //string to be printed to the LCD display (or other output)
ryanyuyu 6:8441a6864784 430 //char* strength = newString(32);
ryanyuyu 6:8441a6864784 431 //char* dist = newString(32);
ryanyuyu 3:30dcfcf9412c 432 float32_t estimate = 0;
ryanyuyu 6:8441a6864784 433 float RMS = 0;
ryanyuyu 6:8441a6864784 434 int index_h = 0;
ryanyuyu 2:8ae58834937f 435 while(1)
ryanyuyu 2:8ae58834937f 436 {
ryanyuyu 2:8ae58834937f 437 switch(state)
ryanyuyu 2:8ae58834937f 438 {
ryanyuyu 2:8ae58834937f 439 case 0: //initialization
ryanyuyu 5:bc45ed158abf 440 for (int i = 0; i < NumTaps; i++)
ryanyuyu 5:bc45ed158abf 441 {
ryanyuyu 6:8441a6864784 442 pCoeffs[i] *= 1.70;
ryanyuyu 5:bc45ed158abf 443 }
ryanyuyu 5:bc45ed158abf 444
ryanyuyu 2:8ae58834937f 445 arm_fir_init_f32(filter, numTaps, pCoeffs, pState, blockSize);
ryanyuyu 4:9ee3ae61db7f 446 //arm_iir_lattice_init_f32(filter1, numTaps, pkCoeffs, pvCoeffs, pState, blockSize);
ryanyuyu 2:8ae58834937f 447 //pc.printf("Pre-attachment");
ryanyuyu 3:30dcfcf9412c 448 spi.frequency(1000000);
ryanyuyu 2:8ae58834937f 449 state = 1;
ryanyuyu 6:8441a6864784 450 callibrationStep = 0;
ryanyuyu 6:8441a6864784 451 gainStage = 0;
ryanyuyu 6:8441a6864784 452 gainMultiplier = 1.0;
ryanyuyu 7:fc55813f823e 453 //pc.printf("Done with init.\n\r");
ryanyuyu 2:8ae58834937f 454 break;
ryanyuyu 2:8ae58834937f 455
ryanyuyu 6:8441a6864784 456 case 1: //callibration
ryanyuyu 7:fc55813f823e 457 //pc.printf(" Callibration step: %i\n\r", callibrationStep);
ryanyuyu 6:8441a6864784 458 if (callibrationStep == 0) //calculate the offset (beacon is off, or at infinity)
ryanyuyu 6:8441a6864784 459 {
ryanyuyu 6:8441a6864784 460 setGain( gainCutoffs[0]);
ryanyuyu 6:8441a6864784 461 if (adjusting)
ryanyuyu 6:8441a6864784 462 {
ryanyuyu 6:8441a6864784 463 //outputString = "Turn off the beacon. Press the button when done.";
ryanyuyu 6:8441a6864784 464 lcd.calibrationunl();
ryanyuyu 6:8441a6864784 465 waitForButton();
ryanyuyu 6:8441a6864784 466 adjusting = false;
ryanyuyu 6:8441a6864784 467 state = 2;
ryanyuyu 11:8c3b4995b05d 468 if (button == 1) //skip callibration and use preset stuff;
ryanyuyu 11:8c3b4995b05d 469 {
ryanyuyu 11:8c3b4995b05d 470 callibrationStep = -1;
ryanyuyu 11:8c3b4995b05d 471 }
ryanyuyu 11:8c3b4995b05d 472 else fix = 0;
ryanyuyu 6:8441a6864784 473 }
ryanyuyu 6:8441a6864784 474 else
ryanyuyu 6:8441a6864784 475 {
ryanyuyu 6:8441a6864784 476
ryanyuyu 6:8441a6864784 477 minThreshold = average; //the average RMS of background noise
ryanyuyu 8:dcc69fc6d88b 478 //maxThreshold = .400;
ryanyuyu 6:8441a6864784 479 callibrationStep = 1; //move to next callibration step
ryanyuyu 6:8441a6864784 480 //get ready for next callibration step
ryanyuyu 6:8441a6864784 481 adjusting = true;
ryanyuyu 6:8441a6864784 482 state = 1;
ryanyuyu 6:8441a6864784 483 }
ryanyuyu 8:dcc69fc6d88b 484 }
ryanyuyu 6:8441a6864784 485 else if (callibrationStep <= numCallibrationSteps)
ryanyuyu 6:8441a6864784 486 {
ryanyuyu 6:8441a6864784 487 callibratePoint(average);
ryanyuyu 6:8441a6864784 488 }
ryanyuyu 6:8441a6864784 489 else //now all the points are captured, so create the coeffs
ryanyuyu 6:8441a6864784 490 {
ryanyuyu 7:fc55813f823e 491 //pc.printf("calculating coeffs\n\r");
ryanyuyu 6:8441a6864784 492 for (int i = 0; i < numGainStages; i++)
ryanyuyu 6:8441a6864784 493 {
ryanyuyu 6:8441a6864784 494 mid[i] = linearSamples[i*3+1];
ryanyuyu 6:8441a6864784 495 mLower[i] = (callibrationPoints[i*3+1] - callibrationPoints[i*3+0]) / (linearSamples[i*3+1] - linearSamples[i*3+0]) ;
ryanyuyu 6:8441a6864784 496 mUpper[i] = (callibrationPoints[i*3+2] - callibrationPoints[i*3+1]) / (linearSamples[i*3+2] - linearSamples[i*3+1]) ;
ryanyuyu 6:8441a6864784 497 bLower[i] = callibrationPoints[i*3+0] - mLower[i]*linearSamples[i*3+0];
ryanyuyu 6:8441a6864784 498 bUpper[i] = callibrationPoints[i*3+1] - mUpper[i]*linearSamples[i*3+1];
ryanyuyu 11:8c3b4995b05d 499 pc.printf("mL=%f mU=%f bL=%f, bU=%f, mid=%f, cutoff=%f\n\r", mLower[i], mUpper[i], bLower[i], bUpper[i], mid[i], gainCutoffs[i]);
ryanyuyu 6:8441a6864784 500 }
ryanyuyu 6:8441a6864784 501 callibrationStep = -1;
ryanyuyu 6:8441a6864784 502 state = 2;
ryanyuyu 6:8441a6864784 503 gainStage = 0;
ryanyuyu 6:8441a6864784 504
ryanyuyu 6:8441a6864784 505 for (int i = 0; i < numCallibrationSteps; i++)
ryanyuyu 6:8441a6864784 506 {
ryanyuyu 11:8c3b4995b05d 507 pc.printf("linear(x)=%f callibration(y)=%d \n\r", linearSamples[i], callibrationPoints[i]);
ryanyuyu 6:8441a6864784 508 }
ryanyuyu 7:fc55813f823e 509 //pc.printf("End of callibration.\n\r");
ryanyuyu 6:8441a6864784 510 }
ryanyuyu 6:8441a6864784 511
ryanyuyu 6:8441a6864784 512 case 2: //read data, take samples
ryanyuyu 5:bc45ed158abf 513 //pc.printf("Reading data.\n\r");
ryanyuyu 2:8ae58834937f 514 readSamples();
ryanyuyu 3:30dcfcf9412c 515 state = 3;
ryanyuyu 2:8ae58834937f 516 break;
ryanyuyu 2:8ae58834937f 517 case 3: //filter?
ryanyuyu 6:8441a6864784 518 //pc.printf("RMS of waveform = %f\n\r", rms(waveform));
ryanyuyu 6:8441a6864784 519 //pc.printf("Filtering?\n\r");
ryanyuyu 2:8ae58834937f 520 arm_fir_f32(filter, waveform, postFilterData, blockSize);
ryanyuyu 4:9ee3ae61db7f 521 //arm_iir_lattice_f32(filter1, waveform, postFilterData, blockSize);
ryanyuyu 6:8441a6864784 522 RMS = rms(postFilterData);
ryanyuyu 6:8441a6864784 523 estimate = estimateDistance(RMS);
ryanyuyu 6:8441a6864784 524 if (callibrationStep == -1) state = 6; //done with callibration
ryanyuyu 6:8441a6864784 525 else state = 7; //still callibrating
ryanyuyu 2:8ae58834937f 526 break;
ryanyuyu 2:8ae58834937f 527 case 4: //FFT?
ryanyuyu 2:8ae58834937f 528 break;
ryanyuyu 2:8ae58834937f 529 case 5: //output, write to display and PWM tone
ryanyuyu 4:9ee3ae61db7f 530 /*
ryanyuyu 3:30dcfcf9412c 531 sprintf(outputString, "RMS = %f", estimate);
ryanyuyu 3:30dcfcf9412c 532 lcd.print(outputString);
ryanyuyu 3:30dcfcf9412c 533 state = 1;
ryanyuyu 4:9ee3ae61db7f 534 //*/
ryanyuyu 2:8ae58834937f 535 break;
ryanyuyu 4:9ee3ae61db7f 536 case 6: //calculate the average voltage
ryanyuyu 6:8441a6864784 537 //pc.printf("post filter RMS = %f\n\n\r", estimate);
ryanyuyu 4:9ee3ae61db7f 538 adjustGains(estimate);
ryanyuyu 6:8441a6864784 539 state = 8;
ryanyuyu 6:8441a6864784 540 break;
ryanyuyu 6:8441a6864784 541 case 7: //callibration-related, take 10pt average and record it
ryanyuyu 6:8441a6864784 542 history[index_h] = RMS;
ryanyuyu 6:8441a6864784 543 index_h++;
ryanyuyu 6:8441a6864784 544 state = 2;
ryanyuyu 6:8441a6864784 545 if (index_h >= 10) //ten-pt average done
ryanyuyu 6:8441a6864784 546 {
ryanyuyu 6:8441a6864784 547 average = 0;
ryanyuyu 6:8441a6864784 548 for (int i = 0; i < 10; i++) average+= history[i];
ryanyuyu 6:8441a6864784 549 average /= 10;
ryanyuyu 6:8441a6864784 550 //pc.printf("10-pt average of RMS = %f\n\r", average);
ryanyuyu 6:8441a6864784 551 float t = (float) average;
ryanyuyu 7:fc55813f823e 552 int n = snprintf(strength, 32," %f", t);
ryanyuyu 6:8441a6864784 553 lcd.displayStr(strength);
ryanyuyu 6:8441a6864784 554 index_h = 0;
ryanyuyu 6:8441a6864784 555 state = 1; //go back to callibration
ryanyuyu 6:8441a6864784 556 }
ryanyuyu 6:8441a6864784 557 //state is 2, unless 10pts are collected, then state is 1
ryanyuyu 6:8441a6864784 558 //continue taking and filtering data until full of 10pts
ryanyuyu 6:8441a6864784 559 break;
ryanyuyu 6:8441a6864784 560 case 8: //output
ryanyuyu 6:8441a6864784 561 //int n = sprintf(outputString, "RMS = %f, distance = %fin", RMS, estimate);
ryanyuyu 7:fc55813f823e 562 //pc.printf(" RMS=%f, Dist=%f GainStage=%d\n\r", RMS, estimate, gainStage);
ryanyuyu 7:fc55813f823e 563 //strcpy( strength, (convert(RMS) + "\0").c_str() );
ryanyuyu 7:fc55813f823e 564
ryanyuyu 7:fc55813f823e 565
ryanyuyu 7:fc55813f823e 566 //snprintf(strength, 32, " %f\0", RMS);
ryanyuyu 5:bc45ed158abf 567 /*
ryanyuyu 7:fc55813f823e 568 if (estimate == -1) dist = " Unknown (clipping)\0";
ryanyuyu 7:fc55813f823e 569 else if (estimate == 999) dist = " Unknown (no sig)\0";
ryanyuyu 7:fc55813f823e 570 else */
ryanyuyu 7:fc55813f823e 571 //strcpy( dist, (convert(estimate) + "in\0").c_str() );
ryanyuyu 7:fc55813f823e 572 snprintf(strength, 32, " %f\0", RMS);
ryanyuyu 7:fc55813f823e 573 snprintf(dist, 32, " %.1f in.\0", estimate);
ryanyuyu 7:fc55813f823e 574 //*/
ryanyuyu 7:fc55813f823e 575 //pc.printf( strength);
ryanyuyu 7:fc55813f823e 576 //pc.printf( dist);
ryanyuyu 6:8441a6864784 577 lcd.displayStr(strength);
ryanyuyu 6:8441a6864784 578 lcd.displayDist(dist);
ryanyuyu 7:fc55813f823e 579
ryanyuyu 7:fc55813f823e 580 /*
ryanyuyu 6:8441a6864784 581 if (button == 1) state = 9;
ryanyuyu 6:8441a6864784 582 else state = 2;
ryanyuyu 7:fc55813f823e 583 //*/
ryanyuyu 7:fc55813f823e 584 state = 2;
ryanyuyu 7:fc55813f823e 585 //pc.printf(" end of display\n\r");
ryanyuyu 3:30dcfcf9412c 586 break;
ryanyuyu 6:8441a6864784 587 case 9: //digital pot interfacing and calibration
ryanyuyu 6:8441a6864784 588 pc.printf("Gain?\n\r");
ryanyuyu 3:30dcfcf9412c 589 pc.scanf("%s", buffer);
ryanyuyu 3:30dcfcf9412c 590 float value = atof(buffer);
ryanyuyu 6:8441a6864784 591 setGain(value);
ryanyuyu 6:8441a6864784 592 //int side = (int) value;
ryanyuyu 6:8441a6864784 593 //float k = (value - side) * 100;
ryanyuyu 6:8441a6864784 594 //pc.printf("Command: %x Scanned:%d %f\n\r", setPot(side, k), side, k);
ryanyuyu 6:8441a6864784 595 pc.printf("Scanned:%f\n\r", value);
ryanyuyu 6:8441a6864784 596 //lcd.print("Press button to continue.");
ryanyuyu 6:8441a6864784 597 //waitForButton();
ryanyuyu 6:8441a6864784 598 state = 2;
ryanyuyu 4:9ee3ae61db7f 599 break;
ryanyuyu 6:8441a6864784 600 case 10:
ryanyuyu 4:9ee3ae61db7f 601 state = 10;
ryanyuyu 3:30dcfcf9412c 602 break;
ryanyuyu 2:8ae58834937f 603 default:
ryanyuyu 2:8ae58834937f 604 break;
ryanyuyu 2:8ae58834937f 605 }
ryanyuyu 2:8ae58834937f 606 } //end of (infinite) while loop
ryanyuyu 0:3aae5d23d0db 607 }
ryanyuyu 4:9ee3ae61db7f 608
ryanyuyu 4:9ee3ae61db7f 609
ryanyuyu 4:9ee3ae61db7f 610 //-----------------------------Unused code, but potentially useful
ryanyuyu 4:9ee3ae61db7f 611
ryanyuyu 4:9ee3ae61db7f 612 /*
ryanyuyu 4:9ee3ae61db7f 613 double sum = 0;
ryanyuyu 4:9ee3ae61db7f 614 for (int i = 0; i < BlockSize; i++) sum += postFilterData[i];
ryanyuyu 4:9ee3ae61db7f 615 double average = sum/BlockSize*3.3; //*3.3 V_ref (array stored as fractions of V_ref)
ryanyuyu 4:9ee3ae61db7f 616 pc.printf("Average = %f\n\r", average);
ryanyuyu 4:9ee3ae61db7f 617 wait_ms(500);
ryanyuyu 4:9ee3ae61db7f 618 state = 2;
ryanyuyu 4:9ee3ae61db7f 619 */
ryanyuyu 4:9ee3ae61db7f 620
ryanyuyu 4:9ee3ae61db7f 621 //pc.printf("into print\n\r");
ryanyuyu 4:9ee3ae61db7f 622 /*
ryanyuyu 4:9ee3ae61db7f 623 for (int i = 0; i < BlockSize; i++)
ryanyuyu 4:9ee3ae61db7f 624 {
ryanyuyu 4:9ee3ae61db7f 625 pc.printf("Waveform contents:%f\n\r", waveform[i]);
ryanyuyu 4:9ee3ae61db7f 626 }
ryanyuyu 4:9ee3ae61db7f 627 */
ryanyuyu 5:bc45ed158abf 628
ryanyuyu 5:bc45ed158abf 629
ryanyuyu 5:bc45ed158abf 630
ryanyuyu 6:8441a6864784 631 /*---------------peak detection
ryanyuyu 5:bc45ed158abf 632 pc.printf("Into estimation\n\r");
ryanyuyu 5:bc45ed158abf 633 int peaks = 0;
ryanyuyu 5:bc45ed158abf 634 float sum = 0.0;
ryanyuyu 5:bc45ed158abf 635 float prev, current, next;
ryanyuyu 5:bc45ed158abf 636 for (int i = 0+1; i < BlockSize-1; i++)
ryanyuyu 5:bc45ed158abf 637 {
ryanyuyu 5:bc45ed158abf 638 prev = postFilterData[i-1];
ryanyuyu 5:bc45ed158abf 639 current = postFilterData[i];
ryanyuyu 5:bc45ed158abf 640 next = postFilterData[i+1];
ryanyuyu 5:bc45ed158abf 641 if (prev < current && next < current) //local max
ryanyuyu 5:bc45ed158abf 642 {
ryanyuyu 5:bc45ed158abf 643 sum += current;
ryanyuyu 5:bc45ed158abf 644 peaks++;
ryanyuyu 5:bc45ed158abf 645 }
ryanyuyu 5:bc45ed158abf 646 }
ryanyuyu 5:bc45ed158abf 647 float average = sum/peaks;
ryanyuyu 5:bc45ed158abf 648 pc.printf("Average of peaks (scalar) = %f\n\r", average);
ryanyuyu 5:bc45ed158abf 649 state = 1;
ryanyuyu 5:bc45ed158abf 650 //*/
ryanyuyu 6:8441a6864784 651
ryanyuyu 6:8441a6864784 652 /*---------------------------//purely for testing that the digital potentiometer is working.
ryanyuyu 6:8441a6864784 653 pc.printf("Start of digital pot loop.\n\r");
ryanyuyu 6:8441a6864784 654 setPot(1,0);
ryanyuyu 6:8441a6864784 655 wait_ms(1000);
ryanyuyu 6:8441a6864784 656 setPot(1,20);
ryanyuyu 6:8441a6864784 657 wait_ms(1000);
ryanyuyu 6:8441a6864784 658 setPot(1,40);
ryanyuyu 6:8441a6864784 659 wait_ms(1000);
ryanyuyu 6:8441a6864784 660 setPot(1,50);
ryanyuyu 6:8441a6864784 661 wait_ms(1000);
ryanyuyu 6:8441a6864784 662 setPot(1, 80);
ryanyuyu 6:8441a6864784 663 wait_ms(1000);
ryanyuyu 6:8441a6864784 664 setPot(1, 100);
ryanyuyu 6:8441a6864784 665 wait_ms(1000);
ryanyuyu 6:8441a6864784 666 */
ryanyuyu 6:8441a6864784 667
ryanyuyu 11:8c3b4995b05d 668 /*
ryanyuyu 11:8c3b4995b05d 669 mLower = {-15.322362, -108.246826, -43.797886, 90.550484};
ryanyuyu 11:8c3b4995b05d 670 mUpper = {-100.010368, -485.365387, -186.721283, -223.606857};
ryanyuyu 11:8c3b4995b05d 671 bLower = {11.394491, 25.797676, 42.176929, 77.429733};
ryanyuyu 11:8c3b4995b05d 672 bUpper = {19.101967, 45.996063, 62.333790, 100.10244};
ryanyuyu 11:8c3b4995b05d 673 mid = {0.091010, 0.053560, 0.141033, 0.170399};
ryanyuyu 11:8c3b4995b05d 674 gainCutoffs = {20.639122, 71.663605, 1486.016724, 8599.633789};
ryanyuyu 11:8c3b4995b05d 675 mL=-15.322362 mU=-100.010368 bL=11.394491, bU=19.101967, mid=0.091010, cutoff=20.639122
ryanyuyu 11:8c3b4995b05d 676 mL=-108.246826 mU=-485.365387 bL=25.797676, bU=45.996063, mid=0.053560, cutoff=71.663605
ryanyuyu 11:8c3b4995b05d 677 mL=-43.797886 mU=-186.721283 bL=42.176929, bU=62.333790, mid=0.141033, cutoff=1486.016724
ryanyuyu 11:8c3b4995b05d 678 mL=-90.550484 mU=-223.606857 bL=77.429733, bU=100.102448, mid=0.170399, cutoff=8599.633789
ryanyuyu 11:8c3b4995b05d 679 linear(x)=0.352067 callibration(y)=6
ryanyuyu 11:8c3b4995b05d 680 linear(x)=0.091010 callibration(y)=10
ryanyuyu 11:8c3b4995b05d 681 linear(x)=0.051014 callibration(y)=14
ryanyuyu 11:8c3b4995b05d 682 linear(x)=0.108989 callibration(y)=14
ryanyuyu 11:8c3b4995b05d 683 linear(x)=0.053560 callibration(y)=20
ryanyuyu 11:8c3b4995b05d 684 linear(x)=0.045319 callibration(y)=24
ryanyuyu 11:8c3b4995b05d 685 linear(x)=0.369354 callibration(y)=26
ryanyuyu 11:8c3b4995b05d 686 linear(x)=0.141033 callibration(y)=36
ryanyuyu 11:8c3b4995b05d 687 linear(x)=0.066055 callibration(y)=50
ryanyuyu 11:8c3b4995b05d 688 linear(x)=0.302922 callibration(y)=50
ryanyuyu 11:8c3b4995b05d 689 linear(x)=0.170399 callibration(y)=62
ryanyuyu 11:8c3b4995b05d 690 linear(x)=0.098845 callibration(y)=78
ryanyuyu 11:8c3b4995b05d 691
ryanyuyu 11:8c3b4995b05d 692
ryanyuyu 11:8c3b4995b05d 693
ryanyuyu 7:fc55813f823e 694
ryanyuyu 7:fc55813f823e 695
ryanyuyu 7:fc55813f823e 696 /*
ryanyuyu 7:fc55813f823e 697 std::string convert(float number)
ryanyuyu 7:fc55813f823e 698 {
ryanyuyu 7:fc55813f823e 699 std::ostringstream buffer;
ryanyuyu 7:fc55813f823e 700 buffer<<number;
ryanyuyu 7:fc55813f823e 701 return buffer.str();
ryanyuyu 7:fc55813f823e 702 }
ryanyuyu 7:fc55813f823e 703
ryanyuyu 7:fc55813f823e 704
ryanyuyu 7:fc55813f823e 705
ryanyuyu 7:fc55813f823e 706
ryanyuyu 8:dcc69fc6d88b 707
ryanyuyu 7:fc55813f823e 708 */