Working code for pc app 12/01/2018 commit
Dependencies: mbed MS5607 mbed-dsp
Fork of Turrentine_Code by
main.cpp
- Committer:
- intrinseca
- Date:
- 2018-01-12
- Revision:
- 1:ab3dacbfcde6
- Parent:
- 0:2c6d81be69d8
- Child:
- 2:3d3e21c907e4
File content as of revision 1:ab3dacbfcde6:
#include "mbed.h" #define M_PI 3.14159265358979323846 #define N_SAMPLES 500 //mbed class def Serial pc(USBTX, USBRX); // tx, rx SPI spi(p5, p6, p7); // mosi, miso, sclk DigitalOut cs(p8); PwmOut motorOn(p26); Timer t; //variable instaniation unsigned short calData[6]; char buffer16[3]; short int serbuffer[2]; char tempBuffer[4]; unsigned int temp = 0; char pressBuffer[4]; unsigned int press = 0; unsigned int pData[N_SAMPLES]; float spData[N_SAMPLES]; unsigned int tData[N_SAMPLES]; const char cb1 = 0xA2; const char cb2 = 0xA4; const char cb3 = 0xA6; const char cb4 = 0xA8; const char cb5 = 0xAA; const char cb6 = 0xAC; const char * commarr[6] = {&cb1, &cb2, &cb3, &cb4, &cb5, &cb6}; const char D1conv256 = 0x40; const char D1conv512 = 0x42; const char D2conv4096 = 0x58; const char D2conv512 = 0x52; const char readADC = 0x00; float duty = 1; int round(float number) { return (number >= 0) ? (int)(number + 0.5) : (int)(number - 0.5); } //calculate temperature int calcT(unsigned int Tval, unsigned short consts[6]) { int dT = Tval - consts[4]*(2<<7); int T = 2000 + dT*consts[5]/(2<<22); printf("Temp: %d C\n", T); return T; } //calculate 1st order temperature compensated pressure int calcP(unsigned int Tval, unsigned int Pval, unsigned short consts[6]) { int dT = Tval - consts[4]*(2<<7); long long int off = (long long)consts[1]*(2<<16) + ((long long)consts[3] *(long long)dT)/(2<<5); long long int sens = (long long)consts[0]*(2<<15) + ((long long)consts[2] *(long long)dT)/(2<<6); int P = (Pval *(sens/(2<<20)) - off)/(2<<14); //printf("Pressure %d Pa\n\r", P); return P; } int main() { printf("Turrentine\n"); pc.baud(115200); motorOn = 0; motorOn.period_ms(10); // Chip must be deselected cs = 1; // Setup the spi for 8 bit data, high steady state clock, // second edge capture, with a 1MHz clock rate spi.format(8,3); spi.frequency(500000); spi.set_default_write_value(0x00); // Select the device by seting chip select low cs = 0; // Send 0x1E Command to reset the chip spi.write(0x1E); cs = 1; wait_ms(100); cs = 1; printf("Read cal data\n"); //read cal data values from device into program for (char i=0; i<6; i++) { //spi read sequence cs= 0; spi.write(commarr[i], 1, buffer16, 3); //time for SPI to write into data buffers wait_ms(10); cs=1; //Put data into 16bit unsigned int in calData array calData[i] = buffer16[1]<<8 | buffer16[2]; } printf("Start loop\n"); //display calibration values to check against datasheet //program loop while(1) { //read temerature value cs = 0; spi.write(&D2conv4096, 1, buffer16, 1); wait_ms(10); cs = 1; cs = 0; spi.write(&readADC, 1, tempBuffer, 4); cs = 1; //read pressure value /*cs = 0; spi.write(&D1conv512, 1, buffer16, 1); wait_ms(2); cs = 1; cs = 0; spi.write(&readADC, 1, pressBuffer, 4); cs = 1;*/ //write values from buffers to program variables temp = tempBuffer[1]<<16 | tempBuffer[2]<<8 | tempBuffer[3]; //press = pressBuffer[1]<<16 | pressBuffer[2]<<8 | pressBuffer[3]; printf("Pump On\n"); //turn pump on motorOn.write(duty); //dummy samples to wait for sensor response to stabilise int a =0; while(a < 10000) { cs = 0; spi.write(&D1conv256, 1, buffer16, 1); wait_us(500); cs = 1; cs = 0; spi.write(&readADC, 1, pressBuffer, 4); cs = 1; a++; } printf("Start Measurement\n"); //double cumsum = 0; t.reset(); t.start(); //loop values for (int x = 0; x < N_SAMPLES; x++) { cs = 0; spi.write(&D1conv256, 1, buffer16, 1); wait_us(500); cs = 1; cs = 0; if (x > 0) { pData[x-1] = pressBuffer[1]<<16 | pressBuffer[2]<<8 | pressBuffer[3]; //cumsum = cumsum + pData[x-1]; } spi.write(&readADC, 1, pressBuffer, 4); tData[x] = t.read_us(); cs = 1; } pData[N_SAMPLES - 1] = pressBuffer[1]<<16 | pressBuffer[2]<<8 | pressBuffer[3]; //stop motor and timer t.stop(); motorOn.write(0); printf("Stop Measurement\n"); //calc temperature calcT(temp, calData); long long sum = 0; //float avg = calcP(temp, cumsum/(nsample-1), calData); //printf("avg %f\n\r", avg); //output date to PC printf("C1: %hu\nC2: %hu\nC3: %hu\nC4: %hu\nC5: %hu\nC6: %hu\n", calData[0], calData[1], calData[2], calData[3], calData[4], calData[5]); for(int i = 0; i < N_SAMPLES; i++) { printf("%04d: %d\n", i, pData[i]); } /* //for crossing detection bool cflag1 = (avg > pData[0]); bool cflag2 = (avg > pData[1]); int numcross = 0; int lastcrosspoint = 0; unsigned int crosstart; unsigned int crossend; float freq = 0; //smooth data array 20 sample size for (int y=0; y< nsample-1; y++) { if (9< y && y <nsample-10) { sum = 0; for (int z=0; z<20; z++) { sum = sum + pData[y-10+z]; } spData[y] = (float) calcP(temp, sum/20, calData); //detect avg crossings for frequency calc if (y>10) { cflag2 = (avg > spData[y]); cflag1 = (avg > spData[y-1]); if (cflag1 != cflag2) { if(lastcrosspoint<=(y-10)) { numcross++; lastcrosspoint = y; if (numcross == 1) { crosstart = tData[y]; } crossend = tData[y]; } } } //calc pressure & display list //printf("%d\t%d\t%d\n\r", tData[y], calcP(temp, spData[y], calData), calcP(temp, pData[y], calData)); printf("%d\t%f\n\r", tData[y],spData[y]); } else if (10> y || y >nsample-10) { spData[y] = (float) calcP(temp, pData[y], calData); } } printf("numcross = %d\n\r", numcross); printf("crosstart = %d\n\r", crosstart); printf("crossend = %d\n\r", crossend); freq = (1e6 *numcross)/(2*(crossend - crosstart)); printf("frequency = %f\n\r", freq); for (int z=0; z< nsample-1; z++) { spData[z] = spData[z] -avg; } printf("Repeat Blockage Test?\n\rPress Enter to continue\n\r"); while(1) { if (pc.getc() != 0) { break; } } */ } }