scott kelleher / Outdoor_UPAS_sharp_octet

all working version 2.0

Dependencies:   ADS1115 BME280 CronoDot SDFileSystem mbed

Fork of Outdoor_UPAS_v1_2_powerfunction by scott kelleher

main.cpp@28:42932d3b105d, 2016-04-23 (annotated)

Committer:
caseyquinn
Date:
Sat Apr 23 00:10:57 2016 +0000
Revision:
28:42932d3b105d
Parent:
27:922f53fa649c
Child:
29:fd74725294d5
Added hbridge code for Tboard RevC boards and probably some other stuff too.

Who changed what in which revision?

UserRevisionLine numberNew contents of line
jelord 0:2cb2b2ea316f 1 #include "mbed.h"
jelord 2:88fcbfadec6a 2 #include "SDFileSystem.h"
jelord 2:88fcbfadec6a 3 #include "Adafruit_ADS1015.h"
jelord 2:88fcbfadec6a 4 #include "MCP40D17.h"
jelord 2:88fcbfadec6a 5 #include "STC3100.h"
jelord 2:88fcbfadec6a 6 #include "LSM303.h"
jelord 2:88fcbfadec6a 7 #include "BME280.h"
jelord 2:88fcbfadec6a 8 #include "SI1145.h"
jelord 2:88fcbfadec6a 9 #include "NCP5623BMUTBG.h"
jelord 2:88fcbfadec6a 10 #include "CronoDot.h"
jelord 2:88fcbfadec6a 11 #include "EEPROM.h"
caseyquinn 12:5b4f3245606a 12 #include "Calibration.h"
caseyquinn 12:5b4f3245606a 13 #include "MAX_M8.h"
caseyquinn 12:5b4f3245606a 14 #include "DRV8830.h"
caseyquinn 14:7cdb643da356 15
jelord 0:2cb2b2ea316f 16
caseyquinn 12:5b4f3245606a 17 /////////////////////////////////////////////
caseyquinn 12:5b4f3245606a 18 //General Items
caseyquinn 12:5b4f3245606a 19 /////////////////////////////////////////////
caseyquinn 14:7cdb643da356 20 I2C i2c(PB_9, PB_8);//(D14, D15); SDA,SCL
caseyquinn 12:5b4f3245606a 21 Serial pc(USBTX, USBRX);
caseyquinn 18:41ef98db0423 22 DigitalOut pumps(PA_9, 0);//(D8, 0);
caseyquinn 12:5b4f3245606a 23 DigitalOut pbKill(PC_12, 1); // Digital input pin that conncect to the LTC2950 battery charger used to shutdown the UPAS
caseyquinn 13:455601f62aad 24 DigitalIn nINT(PA_15); //Connected but currently unused is a digital ouput pin from LTC2950 battery charger. http://cds.linear.com/docs/en/datasheet/295012fd.pdf
jelord 2:88fcbfadec6a 25 MCP40D17 DigPot(&i2c);
caseyquinn 12:5b4f3245606a 26 BME280 bmesensor(PB_9, PB_8);//(D14, D15);
caseyquinn 12:5b4f3245606a 27 NCP5623BMUTBG RGB_LED(PB_9, PB_8);//(D14, D15);
caseyquinn 17:3e6dda6e6335 28 CronoDot RTC_UPAS(PB_9, PB_8);//(D14, D15);
caseyquinn 12:5b4f3245606a 29 EEPROM E2PROM(PB_9, PB_8);//(D14, D15);
caseyquinn 12:5b4f3245606a 30 Calibration calibrations(1); //Default serial/calibration if there are no values for the selected option
caseyquinn 14:7cdb643da356 31
caseyquinn 12:5b4f3245606a 32
caseyquinn 12:5b4f3245606a 33 /////////////////////////////////////////////
caseyquinn 12:5b4f3245606a 34 //RN4677 BT/BLE Module
caseyquinn 12:5b4f3245606a 35 /////////////////////////////////////////////
caseyquinn 12:5b4f3245606a 36 Serial microChannel(PB_10, PB_11); // tx, rx
caseyquinn 4:5d004fd997d5 37 DigitalOut bleRTS(PB_14, 0);
caseyquinn 4:5d004fd997d5 38 DigitalOut bleCTS(PB_13, 0);
caseyquinn 12:5b4f3245606a 39 DigitalOut BT_IRST(PC_8, 0);
caseyquinn 12:5b4f3245606a 40 DigitalOut BT_SW(PA_12, 0);
caseyquinn 17:3e6dda6e6335 41
caseyquinn 13:455601f62aad 42
caseyquinn 12:5b4f3245606a 43 /////////////////////////////////////////////
caseyquinn 12:5b4f3245606a 44 //Analog to Digital Converter
caseyquinn 12:5b4f3245606a 45 /////////////////////////////////////////////
caseyquinn 12:5b4f3245606a 46 Adafruit_ADS1115 ads(&i2c);
caseyquinn 12:5b4f3245606a 47 //DigitalIn ADS_ALRT(PA_10); //Connected but currently unused. (ADS1115) http://www.ti.com/lit/ds/symlink/ads1115.pdf
caseyquinn 12:5b4f3245606a 48
caseyquinn 12:5b4f3245606a 49 /////////////////////////////////////////////
caseyquinn 12:5b4f3245606a 50 //Battery Monitoring
caseyquinn 12:5b4f3245606a 51 /////////////////////////////////////////////
caseyquinn 12:5b4f3245606a 52 STC3100 gasG(PB_9, PB_8);//(D14, D15); // http://www.st.com/web/en/resource/technical/document/datasheet/CD00219947.pdf
caseyquinn 28:42932d3b105d 53 InterruptIn bcs1(PC_9); //Charge complete if High. Connected but currently unused. (MCP73871) http://www.mouser.com/ds/2/268/22090a-52174.pdf
caseyquinn 28:42932d3b105d 54 InterruptIn bcs2(PA_8); //Batt charging if High. Connected but currently unused. (MCP73871) http://www.mouser.com/ds/2/268/22090a-52174.pdf
caseyquinn 12:5b4f3245606a 55
caseyquinn 12:5b4f3245606a 56 /////////////////////////////////////////////
caseyquinn 12:5b4f3245606a 57 //Accelerometer and Magnometer
caseyquinn 12:5b4f3245606a 58 /////////////////////////////////////////////
caseyquinn 12:5b4f3245606a 59 LSM303 movementsensor(PB_9, PB_8);//(D14, D15); // http://www.st.com/web/en/resource/technical/document/datasheet/DM00027543.pdf
caseyquinn 12:5b4f3245606a 60 //DigitalIn ACC_INT1(PC_7); //Connected but currently unused. (LSM303)
caseyquinn 12:5b4f3245606a 61 //DigitalIn ACC_INT2(PC_6); //Connected but currently unused. (LSM303)
caseyquinn 12:5b4f3245606a 62 //DigitalIn ACC_DRDY(PC_11); //Connected but currently unused. (LSM303)
jelord 0:2cb2b2ea316f 63
caseyquinn 12:5b4f3245606a 64 /////////////////////////////////////////////
caseyquinn 12:5b4f3245606a 65 //UV and Visible Light Sensor
caseyquinn 12:5b4f3245606a 66 /////////////////////////////////////////////
caseyquinn 12:5b4f3245606a 67 SI1145 lightsensor(PB_9, PB_8);//(D14, D15);
caseyquinn 12:5b4f3245606a 68 //DigitalIn UV_INT(PD_2); //Connected but currently unused nor configured (interupt). (SI1145) https://www.silabs.com/Support%20Documents/TechnicalDocs/Si1145-46-47.pdf
caseyquinn 9:8646fd501832 69
caseyquinn 12:5b4f3245606a 70 /////////////////////////////////////////////
caseyquinn 12:5b4f3245606a 71 //GPS
caseyquinn 12:5b4f3245606a 72 /////////////////////////////////////////////
caseyquinn 17:3e6dda6e6335 73 DigitalOut gpsEN(PB_15, 0);
caseyquinn 23:1ca41779b8ec 74 Max_M8 gps(PB_9, PB_8,(0x84));
caseyquinn 12:5b4f3245606a 75
caseyquinn 12:5b4f3245606a 76 /////////////////////////////////////////////
caseyquinn 12:5b4f3245606a 77 //Hbridge Valve Control
caseyquinn 12:5b4f3245606a 78 /////////////////////////////////////////////
caseyquinn 23:1ca41779b8ec 79
caseyquinn 28:42932d3b105d 80
caseyquinn 28:42932d3b105d 81 DRV8830 schoolF1(PB_9, PB_8, 0xC4); //Work/School Filter
caseyquinn 28:42932d3b105d 82 DRV8830 homeF2(PB_9, PB_8, 0xCA); //Home Filter
caseyquinn 28:42932d3b105d 83 DRV8830 transitF3(PB_9, PB_8, 0xCC); //Transit Filter
caseyquinn 28:42932d3b105d 84 DRV8830 blankF4(PB_9, PB_8, 0xCE); //Blank Filter
caseyquinn 28:42932d3b105d 85 DigitalIn hb1_school(PA_6);
caseyquinn 28:42932d3b105d 86 DigitalIn hb2_home(PA_7);
caseyquinn 28:42932d3b105d 87 DigitalIn hb3_transit(PA_5);
caseyquinn 28:42932d3b105d 88 DigitalIn hb4_blank(PA_4);
caseyquinn 28:42932d3b105d 89
caseyquinn 23:1ca41779b8ec 90
caseyquinn 12:5b4f3245606a 91 /////////////////////////////////////////////
caseyquinn 12:5b4f3245606a 92 //SD Card
caseyquinn 12:5b4f3245606a 93 /////////////////////////////////////////////
caseyquinn 12:5b4f3245606a 94 char filename[] = "/sd/XXXX0000LOG000000000000---------------.txt";
caseyquinn 12:5b4f3245606a 95 SDFileSystem sd(PB_5, PB_4, PB_3, PB_6, "sd");//(D4, D5, D3, D10, "sd"); // (MOSI, MISO, SCK, SEL)
caseyquinn 28:42932d3b105d 96 DigitalIn sdCD(PA_11, PullUp);
caseyquinn 14:7cdb643da356 97
caseyquinn 12:5b4f3245606a 98 /////////////////////////////////////////////
caseyquinn 12:5b4f3245606a 99 //Callbacks
caseyquinn 12:5b4f3245606a 100 /////////////////////////////////////////////
caseyquinn 9:8646fd501832 101 Ticker stop; //This is the stop callback object
caseyquinn 8:c4a8f9b67cee 102 Ticker logg; //This is the logging callback object
caseyquinn 9:8646fd501832 103 Ticker flowCtl; //This is the control loop callback object
jelord 3:122bfc998c4c 104
caseyquinn 12:5b4f3245606a 105 /////////////////////////////////////////////
caseyquinn 12:5b4f3245606a 106 //Varible Definitions
caseyquinn 12:5b4f3245606a 107 /////////////////////////////////////////////
jelord 3:122bfc998c4c 108 uint16_t serial_num = 1; // Default serial/calibration number
jelord 3:122bfc998c4c 109 int RunReady =0;
jelord 3:122bfc998c4c 110
caseyquinn 25:fbf7d44e7da4 111 bool ledOn = 0;
caseyquinn 25:fbf7d44e7da4 112
caseyquinn 4:5d004fd997d5 113 struct tm STtime;
caseyquinn 7:29b01d5812ee 114 char timestr[32];
jelord 3:122bfc998c4c 115
caseyquinn 9:8646fd501832 116 float press;
caseyquinn 9:8646fd501832 117 float temp;
caseyquinn 9:8646fd501832 118 float rh;
jelord 3:122bfc998c4c 119
caseyquinn 9:8646fd501832 120 int uv;
caseyquinn 9:8646fd501832 121 int vis;
caseyquinn 9:8646fd501832 122 int ir;
jelord 3:122bfc998c4c 123
caseyquinn 9:8646fd501832 124 float compass;
caseyquinn 9:8646fd501832 125 float accel_x;
caseyquinn 9:8646fd501832 126 float accel_y;
caseyquinn 9:8646fd501832 127 float accel_z;
caseyquinn 9:8646fd501832 128 float accel_comp;
caseyquinn 9:8646fd501832 129 float angle_x;
caseyquinn 9:8646fd501832 130 float angle_y;
caseyquinn 9:8646fd501832 131 float angle_z;
caseyquinn 9:8646fd501832 132 float mag_x;
caseyquinn 9:8646fd501832 133 float mag_y;
caseyquinn 9:8646fd501832 134 float mag_z;
jelord 3:122bfc998c4c 135
caseyquinn 9:8646fd501832 136 int vInReading;
caseyquinn 25:fbf7d44e7da4 137 int vInReadingLast;
caseyquinn 9:8646fd501832 138 int vBlowerReading;
caseyquinn 9:8646fd501832 139 int omronDiff;
caseyquinn 9:8646fd501832 140 float omronVolt; //V
caseyquinn 9:8646fd501832 141 int omronReading;
caseyquinn 9:8646fd501832 142 float atmoRho; //g/L
jelord 3:122bfc998c4c 143
caseyquinn 25:fbf7d44e7da4 144 int amps;
caseyquinn 25:fbf7d44e7da4 145 int bVolt;
caseyquinn 25:fbf7d44e7da4 146 int bFuel;
caseyquinn 25:fbf7d44e7da4 147 //bool pumpOn;
caseyquinn 9:8646fd501832 148 float massflow; //g/min
caseyquinn 9:8646fd501832 149 float volflow; //L/min
jelord 3:122bfc998c4c 150 float volflowSet = 1.0; //L/min
caseyquinn 14:7cdb643da356 151 int logInerval = 5;//seconds
jelord 3:122bfc998c4c 152 double secondsD = 0;
jelord 3:122bfc998c4c 153 double lastsecondD = 0;
caseyquinn 9:8646fd501832 154 float massflowSet;
jelord 3:122bfc998c4c 155 float deltaVflow = 0.0;
jelord 3:122bfc998c4c 156 float deltaMflow = 0.0;
caseyquinn 9:8646fd501832 157 float gainFlow;
caseyquinn 9:8646fd501832 158 float sampledVol; //L, total sampled volume
jelord 3:122bfc998c4c 159
caseyquinn 28:42932d3b105d 160 int digital_pot_setpoint = 100; //min = 0x7F, max = 0x00
caseyquinn 9:8646fd501832 161 int digital_pot_set;
caseyquinn 9:8646fd501832 162 int digital_pot_change;
jelord 3:122bfc998c4c 163 int digitalpotMax = 127;
caseyquinn 9:8646fd501832 164 int digitalpotMin = 10;
jelord 3:122bfc998c4c 165
caseyquinn 12:5b4f3245606a 166 int dutyUp;
caseyquinn 12:5b4f3245606a 167 int dutyDown;
caseyquinn 12:5b4f3245606a 168
caseyquinn 23:1ca41779b8ec 169 bool gpsFix;
caseyquinn 12:5b4f3245606a 170 uint8_t gpssatellites = 0;
caseyquinn 23:1ca41779b8ec 171 double gpsspeed = 0.0;
caseyquinn 28:42932d3b105d 172 double gpscourse = 0.0;
caseyquinn 23:1ca41779b8ec 173 double gpslatitude = 0.0;
caseyquinn 23:1ca41779b8ec 174 double gpslongitude = 0.0;
caseyquinn 23:1ca41779b8ec 175 float gpsaltitude = 0.0;
caseyquinn 12:5b4f3245606a 176
caseyquinn 26:6aa294d83af4 177 float home_lat = 40.00000; //40.580508;
caseyquinn 26:6aa294d83af4 178 float home_lon = -105.000000; //-105.081823;
caseyquinn 26:6aa294d83af4 179 float work_lat = 40.100000; //40.594062; //40.569136;
caseyquinn 26:6aa294d83af4 180 float work_lon = -105.100000; //-105.075683; //-105.081966;
caseyquinn 12:5b4f3245606a 181 int location = 0;
caseyquinn 12:5b4f3245606a 182
caseyquinn 12:5b4f3245606a 183 float homeDistance = 99999;
caseyquinn 12:5b4f3245606a 184 float workDistance = 99999;
caseyquinn 12:5b4f3245606a 185
jelord 3:122bfc998c4c 186 //*************************************************//
jelord 3:122bfc998c4c 187
jelord 2:88fcbfadec6a 188 void sendData();
caseyquinn 11:aa21628a9b15 189
caseyquinn 11:aa21628a9b15 190
caseyquinn 11:aa21628a9b15 191 void pc_recv(){
caseyquinn 11:aa21628a9b15 192 while(pc.readable()){
caseyquinn 11:aa21628a9b15 193 pc.getc();
caseyquinn 11:aa21628a9b15 194 }
caseyquinn 11:aa21628a9b15 195 }
caseyquinn 11:aa21628a9b15 196
jelord 0:2cb2b2ea316f 197 static uint8_t rx_buf[20];
jelord 0:2cb2b2ea316f 198 static uint8_t rx_len=0;
jelord 1:9fbb5b665068 199 static int haltBLE = 1;
jelord 1:9fbb5b665068 200 static int transmissionValue = 0;
jelord 2:88fcbfadec6a 201 uint8_t writeData[20] = {0,};
jelord 2:88fcbfadec6a 202 static uint8_t dataLength = 0;
jelord 3:122bfc998c4c 203 static int runReady = 0;
jelord 3:122bfc998c4c 204 static uint8_t startAndEndTime[12] = {0,};
caseyquinn 5:c3252e5d45ca 205
caseyquinn 9:8646fd501832 206 //////////////////////////////////////////////////////////////
caseyquinn 9:8646fd501832 207 //BLE Functions
caseyquinn 9:8646fd501832 208 //////////////////////////////////////////////////////////////
caseyquinn 9:8646fd501832 209
caseyquinn 9:8646fd501832 210 void uartMicro(){
caseyquinn 25:fbf7d44e7da4 211
jelord 3:122bfc998c4c 212 if(runReady!=1){
jelord 3:122bfc998c4c 213 haltBLE = 2;
jelord 3:122bfc998c4c 214 while(microChannel.readable()){
jelord 3:122bfc998c4c 215 rx_buf[rx_len++] = microChannel.getc();
jelord 2:88fcbfadec6a 216
jelord 3:122bfc998c4c 217 //Code block to verify what is being transmitted. To function correctly, all data must terminate with \0 or \n
jelord 3:122bfc998c4c 218 if(transmissionValue==0){
jelord 3:122bfc998c4c 219
caseyquinn 4:5d004fd997d5 220 if (rx_buf[0] == 0x01)transmissionValue = 1; //rtc
jelord 3:122bfc998c4c 221 else if(rx_buf[0] == 0x02)transmissionValue = 2; //sample start and end times
jelord 3:122bfc998c4c 222 else if(rx_buf[0] == 0x03)transmissionValue = 3; //sample name
jelord 3:122bfc998c4c 223 else if(rx_buf[0] == 0x04)transmissionValue = 4; //Send Data Check
jelord 3:122bfc998c4c 224
jelord 3:122bfc998c4c 225 else if(rx_buf[0] == 0x05)transmissionValue = 5; //log interval
jelord 3:122bfc998c4c 226 else if(rx_buf[0] == 0x06)transmissionValue = 6; //Flow Rate
jelord 3:122bfc998c4c 227 else if(rx_buf[0] == 0x07)transmissionValue = 7; //Serial Number
jelord 3:122bfc998c4c 228 else if(rx_buf[0] == 0x08)transmissionValue = 8; //Run Enable
caseyquinn 25:fbf7d44e7da4 229 else if(rx_buf[0] == 0x0A)transmissionValue = 10; //GPS Coordinates
caseyquinn 25:fbf7d44e7da4 230 //else if(rx_buf[0] == 0x30)RGB_LED.set_led(1,0,0);
jelord 3:122bfc998c4c 231 else transmissionValue = 100; //Not useful data
jelord 3:122bfc998c4c 232 }
jelord 3:122bfc998c4c 233
jelord 3:122bfc998c4c 234 if(rx_buf[rx_len-1]=='\0' || rx_buf[rx_len-1]=='\n' || rx_buf[rx_len-1] == 0xff){
jelord 3:122bfc998c4c 235 if((transmissionValue == 1 || transmissionValue == 2 || transmissionValue == 3 || transmissionValue == 4 || transmissionValue == 5 ||
caseyquinn 25:fbf7d44e7da4 236 transmissionValue == 6 || transmissionValue == 7 || transmissionValue ==10) && rx_buf[rx_len-1] != 0xff)
jelord 3:122bfc998c4c 237 {}else{
caseyquinn 21:bb10efc5bf57 238 if(transmissionValue == 4 ) sendData();
jelord 3:122bfc998c4c 239 if(transmissionValue == 8){
jelord 3:122bfc998c4c 240 runReady = 1;
jelord 3:122bfc998c4c 241 microChannel.attach(NULL,microChannel.RxIrq);
jelord 3:122bfc998c4c 242 }
jelord 3:122bfc998c4c 243 haltBLE = 1;
jelord 3:122bfc998c4c 244 transmissionValue = 0;
jelord 3:122bfc998c4c 245 dataLength = 0;
caseyquinn 25:fbf7d44e7da4 246 //if(fileWrite == 1){
caseyquinn 25:fbf7d44e7da4 247 //FILE *fp = fopen(gpsConfigFilename, "a");
caseyquinn 25:fbf7d44e7da4 248 //fprintf(fp,"HELLO");
caseyquinn 25:fbf7d44e7da4 249 //fclose(fp);
caseyquinn 25:fbf7d44e7da4 250 //free(fp);
caseyquinn 25:fbf7d44e7da4 251 //fileWrite=0;
caseyquinn 25:fbf7d44e7da4 252 //}
jelord 3:122bfc998c4c 253 }
jelord 2:88fcbfadec6a 254 }
jelord 1:9fbb5b665068 255 }
caseyquinn 12:5b4f3245606a 256
jelord 3:122bfc998c4c 257 if(haltBLE!=1){
jelord 2:88fcbfadec6a 258
jelord 3:122bfc998c4c 259 if((transmissionValue!=100) && (dataLength!= 0)) writeData[dataLength-1] = rx_buf[0];
jelord 3:122bfc998c4c 260
jelord 3:122bfc998c4c 261 if(transmissionValue ==100){
caseyquinn 10:06fbb1c9e3bd 262 pc.putc(rx_buf[0]);
jelord 2:88fcbfadec6a 263
jelord 3:122bfc998c4c 264 }else if(transmissionValue ==1){ //process and store RTC values
jelord 3:122bfc998c4c 265
caseyquinn 7:29b01d5812ee 266 //if(dataLength==6)RTC_UPAS.set_time(writeData[0],writeData[1],writeData[2],writeData[3],writeData[3],writeData[4],writeData[5]);//sets chronodot RTC
caseyquinn 7:29b01d5812ee 267 if(dataLength==6){
caseyquinn 17:3e6dda6e6335 268 RTC_UPAS.set_time(writeData[0],writeData[1],writeData[2],writeData[3],writeData[3],writeData[4],writeData[5]);//sets chronodot RTC
caseyquinn 12:5b4f3245606a 269 ///////////////////////
caseyquinn 7:29b01d5812ee 270 //sets ST RTC
caseyquinn 12:5b4f3245606a 271 //////////////////////
caseyquinn 7:29b01d5812ee 272 STtime.tm_sec = writeData[0]; // 0-59
caseyquinn 7:29b01d5812ee 273 STtime.tm_min = writeData[1]; // 0-59
caseyquinn 7:29b01d5812ee 274 STtime.tm_hour = writeData[2]; // 0-23
caseyquinn 7:29b01d5812ee 275 STtime.tm_mday = writeData[3]; // 1-31
caseyquinn 7:29b01d5812ee 276 STtime.tm_mon = writeData[4]-1; // 0-11
caseyquinn 7:29b01d5812ee 277 STtime.tm_year = 100+writeData[5]; // year since 1900 (116 = 2016)
caseyquinn 7:29b01d5812ee 278 time_t STseconds = mktime(&STtime);
caseyquinn 12:5b4f3245606a 279 set_time(STseconds); // Set RTC time
caseyquinn 7:29b01d5812ee 280 }
jelord 3:122bfc998c4c 281
caseyquinn 12:5b4f3245606a 282 }
caseyquinn 14:7cdb643da356 283 else if(transmissionValue ==2){ //process and store sample start/end
jelord 3:122bfc998c4c 284 if(dataLength ==12)E2PROM.write(0x00015, writeData, 12);
jelord 3:122bfc998c4c 285
jelord 3:122bfc998c4c 286 }else if(transmissionValue ==3){ //process and store sample name
jelord 3:122bfc998c4c 287 if(dataLength ==8)E2PROM.write(0x00001,writeData,8);
jelord 3:122bfc998c4c 288
jelord 3:122bfc998c4c 289 }else if(transmissionValue ==5){ //process and store Log Interval
jelord 3:122bfc998c4c 290 if(dataLength ==1)E2PROM.write(0x00014,writeData,1);
jelord 2:88fcbfadec6a 291
jelord 3:122bfc998c4c 292 }else if(transmissionValue ==6){ //process and store Flow Rate
jelord 3:122bfc998c4c 293 if(dataLength ==4)E2PROM.write(0x00010,writeData,4);
jelord 3:122bfc998c4c 294
jelord 3:122bfc998c4c 295 }else if(transmissionValue ==7){ //process and store Serial Number
jelord 3:122bfc998c4c 296 if(dataLength ==2)E2PROM.write(0x00034,writeData,2);
caseyquinn 25:fbf7d44e7da4 297 }else if (transmissionValue == 10){
caseyquinn 25:fbf7d44e7da4 298 if(dataLength == 16)E2PROM.write(0x00050,writeData,16);
jelord 3:122bfc998c4c 299 }
caseyquinn 25:fbf7d44e7da4 300
jelord 3:122bfc998c4c 301 dataLength++;
jelord 1:9fbb5b665068 302 }
jelord 3:122bfc998c4c 303
jelord 3:122bfc998c4c 304 rx_len = 0;
jelord 3:122bfc998c4c 305 }else{
jelord 3:122bfc998c4c 306 while(microChannel.readable())
jelord 3:122bfc998c4c 307 uint8_t extract = microChannel.getc();
jelord 3:122bfc998c4c 308 }
jelord 2:88fcbfadec6a 309
caseyquinn 12:5b4f3245606a 310
jelord 2:88fcbfadec6a 311 }
caseyquinn 14:7cdb643da356 312
jelord 2:88fcbfadec6a 313 void sendData(){
jelord 2:88fcbfadec6a 314
caseyquinn 27:922f53fa649c 315 //First byte is designator for the App
caseyquinn 21:bb10efc5bf57 316 uint8_t sampleTimePassValues[13] = {0x01,0x00,0x00,0x0A,0x01,0x01,0x10,0x00,0x00,0x0A,0x01,0x01,0x10};
caseyquinn 21:bb10efc5bf57 317 uint8_t subjectLabelOriginal[9] = {0x02,0x52,0x45,0x53,0x45,0x54,0x5F,0x5F,0x5f};
caseyquinn 21:bb10efc5bf57 318 uint8_t dataLogOriginal[2] = {0x03,0x0A,};
caseyquinn 21:bb10efc5bf57 319 uint8_t flowRateOriginal[5] = {0x04,0x00,0x00,0x80,0x3F};
caseyquinn 25:fbf7d44e7da4 320 uint8_t latLongSchoolOriginal[17] = {0x0A,0x00,0x00,0x80,0x3F,0x00,0x00,0x80,0x3F,0x00,0x00,0x80,0x3F,0x00,0x00,0x80,0x3F};
caseyquinn 25:fbf7d44e7da4 321 // Latitude School EEPROM = 0x50-0x53
caseyquinn 25:fbf7d44e7da4 322 // Longitude School EEPROM = 0x54-0x57
caseyquinn 25:fbf7d44e7da4 323 // Latitude Home EEPROM = 0x58-0x5B
caseyquinn 25:fbf7d44e7da4 324 // Longitude Home EEPROM = 0x5C-0x5F
caseyquinn 25:fbf7d44e7da4 325 uint8_t NEW_EEPROM_CHECK[1] = {0,}; //THIS IS USED TO ENSURE COOPERATION WITH MOBILE APPS
caseyquinn 25:fbf7d44e7da4 326
caseyquinn 25:fbf7d44e7da4 327 //NEW EEPROM Check bit = 0x75
caseyquinn 25:fbf7d44e7da4 328 E2PROM.read(0x00075,NEW_EEPROM_CHECK,1);
caseyquinn 25:fbf7d44e7da4 329
caseyquinn 25:fbf7d44e7da4 330 if(NEW_EEPROM_CHECK[0] == 0x0A){
caseyquinn 25:fbf7d44e7da4 331 E2PROM.read(0x00015, sampleTimePassValues+1, 12);
caseyquinn 25:fbf7d44e7da4 332 E2PROM.read(0x00001, subjectLabelOriginal+1,8);
caseyquinn 25:fbf7d44e7da4 333 E2PROM.read(0x00014,dataLogOriginal+1,1);
caseyquinn 25:fbf7d44e7da4 334 E2PROM.read(0x00010,flowRateOriginal+1,4);
caseyquinn 25:fbf7d44e7da4 335 E2PROM.read(0x00050,latLongSchoolOriginal+1,16);
caseyquinn 25:fbf7d44e7da4 336 }else{
caseyquinn 25:fbf7d44e7da4 337 NEW_EEPROM_CHECK[0] = 0x0A;
caseyquinn 25:fbf7d44e7da4 338 E2PROM.write(0x00075,NEW_EEPROM_CHECK,1);
caseyquinn 25:fbf7d44e7da4 339 E2PROM.write(0x00015, sampleTimePassValues+1, 12);
caseyquinn 25:fbf7d44e7da4 340 E2PROM.write(0x00001, subjectLabelOriginal+1,8);
caseyquinn 25:fbf7d44e7da4 341 E2PROM.write(0x00014,dataLogOriginal+1,1);
caseyquinn 25:fbf7d44e7da4 342 E2PROM.write(0x00010,flowRateOriginal+1,4);
caseyquinn 25:fbf7d44e7da4 343 E2PROM.write(0x00050,latLongSchoolOriginal+1,16);
caseyquinn 25:fbf7d44e7da4 344 }
caseyquinn 21:bb10efc5bf57 345
jelord 2:88fcbfadec6a 346
jelord 2:88fcbfadec6a 347 for(int i=0; i<13; i++){
jelord 2:88fcbfadec6a 348 microChannel.putc(sampleTimePassValues[i]);
jelord 2:88fcbfadec6a 349 }
jelord 2:88fcbfadec6a 350 wait(.25);
jelord 2:88fcbfadec6a 351
jelord 2:88fcbfadec6a 352 for(int i=0; i<9; i++){
jelord 2:88fcbfadec6a 353 microChannel.putc(subjectLabelOriginal[i]);
jelord 2:88fcbfadec6a 354 }
jelord 2:88fcbfadec6a 355 wait(.25);
jelord 2:88fcbfadec6a 356
jelord 2:88fcbfadec6a 357 for(int i=0; i<2; i++){
jelord 2:88fcbfadec6a 358 microChannel.putc(dataLogOriginal[i]);
jelord 2:88fcbfadec6a 359 }
jelord 2:88fcbfadec6a 360 wait(.25);
jelord 2:88fcbfadec6a 361
jelord 2:88fcbfadec6a 362 for(int i=0; i<5; i++){
jelord 2:88fcbfadec6a 363 microChannel.putc(flowRateOriginal[i]);
caseyquinn 25:fbf7d44e7da4 364 }
caseyquinn 25:fbf7d44e7da4 365 wait(.25);
caseyquinn 25:fbf7d44e7da4 366
caseyquinn 25:fbf7d44e7da4 367 for(int i=0;i<17;i++){
caseyquinn 25:fbf7d44e7da4 368 microChannel.putc(latLongSchoolOriginal[i]);
jelord 2:88fcbfadec6a 369 }
jelord 0:2cb2b2ea316f 370
jelord 2:88fcbfadec6a 371
caseyquinn 25:fbf7d44e7da4 372 }
caseyquinn 14:7cdb643da356 373
caseyquinn 12:5b4f3245606a 374 //////////////////////////////////////////////////////////////
caseyquinn 12:5b4f3245606a 375 // GPS: Calculate distance from target location
caseyquinn 12:5b4f3245606a 376 //////////////////////////////////////////////////////////////
caseyquinn 12:5b4f3245606a 377 double GPSdistanceCalc (float tlat, float tlon)
caseyquinn 12:5b4f3245606a 378 {
caseyquinn 12:5b4f3245606a 379
caseyquinn 12:5b4f3245606a 380 float tlatrad, flatrad;
caseyquinn 12:5b4f3245606a 381 float sdlong, cdlong;
caseyquinn 12:5b4f3245606a 382 float sflat, cflat;
caseyquinn 12:5b4f3245606a 383 float stlat, ctlat;
caseyquinn 12:5b4f3245606a 384 float delta, denom;
caseyquinn 12:5b4f3245606a 385
caseyquinn 12:5b4f3245606a 386 double distance;
caseyquinn 27:922f53fa649c 387 delta = (gpslongitude-tlon)*0.0174532925;
caseyquinn 12:5b4f3245606a 388 sdlong = sin(delta);
caseyquinn 12:5b4f3245606a 389 cdlong = cos(delta);
caseyquinn 27:922f53fa649c 390 flatrad = (gpslatitude)*0.0174532925;
caseyquinn 12:5b4f3245606a 391 tlatrad = (tlat)*0.0174532925;
caseyquinn 12:5b4f3245606a 392 sflat = sin(flatrad);
caseyquinn 12:5b4f3245606a 393 cflat = cos(flatrad);
caseyquinn 12:5b4f3245606a 394 stlat = sin(tlatrad);
caseyquinn 12:5b4f3245606a 395 ctlat = cos(tlatrad);
caseyquinn 12:5b4f3245606a 396 delta = (cflat * stlat) - (sflat * ctlat * cdlong);
caseyquinn 12:5b4f3245606a 397 delta = pow(delta,2);
caseyquinn 12:5b4f3245606a 398 delta += pow(ctlat * sdlong,2);
caseyquinn 12:5b4f3245606a 399 delta = sqrt(delta);
caseyquinn 12:5b4f3245606a 400 denom = (sflat * stlat) + (cflat * ctlat * cdlong);
caseyquinn 12:5b4f3245606a 401 delta = atan2(delta, denom);
caseyquinn 12:5b4f3245606a 402 distance = delta * 6372795;
caseyquinn 12:5b4f3245606a 403 return distance;
caseyquinn 12:5b4f3245606a 404 }
caseyquinn 12:5b4f3245606a 405
caseyquinn 5:c3252e5d45ca 406
caseyquinn 9:8646fd501832 407 //////////////////////////////////////////////////////////////
caseyquinn 9:8646fd501832 408 //Shutdown Function
caseyquinn 9:8646fd501832 409 //////////////////////////////////////////////////////////////
jelord 3:122bfc998c4c 410 void check_stop() // this checks if it's time to stop and shutdown
jelord 3:122bfc998c4c 411 {
caseyquinn 9:8646fd501832 412 //!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!
caseyquinn 9:8646fd501832 413 //UPDATE THIS TO WORK WITH ST RTC INSTEAD
caseyquinn 9:8646fd501832 414 //!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!
caseyquinn 17:3e6dda6e6335 415
jelord 3:122bfc998c4c 416 if(RTC_UPAS.compare(startAndEndTime[6], startAndEndTime[7], startAndEndTime[8], startAndEndTime[9], startAndEndTime[10], startAndEndTime[11])) {
jelord 3:122bfc998c4c 417 pbKill = 0; // this is were we shut everything down
caseyquinn 4:5d004fd997d5 418 //pc.printf("If you're reading this something has gone very wrong.");
jelord 3:122bfc998c4c 419 }
caseyquinn 17:3e6dda6e6335 420
jelord 3:122bfc998c4c 421 }
caseyquinn 5:c3252e5d45ca 422
caseyquinn 9:8646fd501832 423 //////////////////////////////////////////////////////////////
caseyquinn 9:8646fd501832 424 //SD Logging Function
caseyquinn 9:8646fd501832 425 //////////////////////////////////////////////////////////////
jelord 3:122bfc998c4c 426 void log_data()
jelord 3:122bfc998c4c 427 {
caseyquinn 28:42932d3b105d 428 //Get time and set RTC
caseyquinn 28:42932d3b105d 429 ///////////////////////////
caseyquinn 7:29b01d5812ee 430 time_t seconds = time(NULL);
caseyquinn 7:29b01d5812ee 431 strftime(timestr, 32, "%y%m%d%H%M%S", localtime(&seconds));
caseyquinn 17:3e6dda6e6335 432 RTC_UPAS.get_time();
caseyquinn 25:fbf7d44e7da4 433
caseyquinn 28:42932d3b105d 434 //Get Sensor Data except GPS
caseyquinn 28:42932d3b105d 435 ////////////////////////////
caseyquinn 7:29b01d5812ee 436 press = bmesensor.getPressure();
caseyquinn 7:29b01d5812ee 437 temp = bmesensor.getTemperature()-5.0;
caseyquinn 7:29b01d5812ee 438 rh = bmesensor.getHumidity();
caseyquinn 7:29b01d5812ee 439 uv = lightsensor.getUV();
caseyquinn 14:7cdb643da356 440 movementsensor.getACCEL();
caseyquinn 14:7cdb643da356 441 movementsensor.getCOMPASS();
caseyquinn 14:7cdb643da356 442 compass = movementsensor.getCOMPASS_HEADING();
caseyquinn 14:7cdb643da356 443 accel_x = movementsensor.AccelData.x;
caseyquinn 14:7cdb643da356 444 accel_y = movementsensor.AccelData.y;
caseyquinn 14:7cdb643da356 445 accel_z = movementsensor.AccelData.z;
caseyquinn 14:7cdb643da356 446 accel_comp = pow(accel_x,(float)2)+pow(accel_y,(float)2)+pow(accel_z,(float)2)-1.0;
caseyquinn 14:7cdb643da356 447 mag_x = movementsensor.MagData.x;
caseyquinn 14:7cdb643da356 448 mag_y = movementsensor.MagData.y;
caseyquinn 14:7cdb643da356 449 mag_z = movementsensor.MagData.z;
caseyquinn 25:fbf7d44e7da4 450 vInReadingLast = vInReading;
caseyquinn 25:fbf7d44e7da4 451 vInReading = ads.readADC_SingleEnded(1, 0xD583); // read channel 0
caseyquinn 25:fbf7d44e7da4 452 amps = gasG.getAmps();
caseyquinn 25:fbf7d44e7da4 453 bVolt = gasG.getVolts();
caseyquinn 25:fbf7d44e7da4 454 bFuel = gasG.getCharge();
caseyquinn 25:fbf7d44e7da4 455
caseyquinn 28:42932d3b105d 456 //Check for fully charged battery
caseyquinn 28:42932d3b105d 457 if(bVolt > 1750 && amps > 8191) {
caseyquinn 28:42932d3b105d 458 RGB_LED.set_led(0,1,0);
caseyquinn 28:42932d3b105d 459 //Check for battery with ~2 hours left of runtime at 2lpm or if after 8pm to remind user to plug in sampler
caseyquinn 28:42932d3b105d 460 }else if(amps > 8191 && (RTC_UPAS.hour >=20 || bVolt < 1500)) {
caseyquinn 28:42932d3b105d 461 if(ledOn) {
caseyquinn 28:42932d3b105d 462 RGB_LED.set_led(0,0,0);
caseyquinn 28:42932d3b105d 463 ledOn = 0;
caseyquinn 28:42932d3b105d 464 }else {
caseyquinn 28:42932d3b105d 465 RGB_LED.set_led(1,0,0);
caseyquinn 28:42932d3b105d 466 ledOn = 1;
caseyquinn 28:42932d3b105d 467 }
caseyquinn 28:42932d3b105d 468 //No LED on when not low battery and not fully charged
caseyquinn 28:42932d3b105d 469 }else{
caseyquinn 28:42932d3b105d 470 RGB_LED.set_led(0,0,0);
caseyquinn 28:42932d3b105d 471 }
caseyquinn 28:42932d3b105d 472
caseyquinn 28:42932d3b105d 473
caseyquinn 28:42932d3b105d 474 // Get GPS Data
caseyquinn 28:42932d3b105d 475 //////////////////////////////
caseyquinn 28:42932d3b105d 476 //if(gpsEN ==1){
caseyquinn 28:42932d3b105d 477
caseyquinn 28:42932d3b105d 478 gpsFix = gps.read(1);
caseyquinn 28:42932d3b105d 479 gpsspeed = gps.speed;
caseyquinn 28:42932d3b105d 480 //gpscourse = gps.course;
caseyquinn 28:42932d3b105d 481 gpssatellites = gps.satellites;
caseyquinn 28:42932d3b105d 482 gpslatitude = gps.lat;
caseyquinn 28:42932d3b105d 483 gpslongitude = gps.lon;
caseyquinn 28:42932d3b105d 484 gpsaltitude = gps.altitude;
caseyquinn 28:42932d3b105d 485
caseyquinn 28:42932d3b105d 486 if(gpsFix){
caseyquinn 28:42932d3b105d 487 workDistance = GPSdistanceCalc (work_lat, work_lon);
caseyquinn 28:42932d3b105d 488 homeDistance = GPSdistanceCalc (home_lat, home_lon);
caseyquinn 28:42932d3b105d 489
caseyquinn 28:42932d3b105d 490 if(workDistance < 50) {
caseyquinn 28:42932d3b105d 491 location = 1;
caseyquinn 28:42932d3b105d 492 //RGB_LED.set_led(0,1,1);
caseyquinn 28:42932d3b105d 493 }else if(homeDistance < 50) { // 25 or 30 m instead?
caseyquinn 28:42932d3b105d 494 location = 2;
caseyquinn 28:42932d3b105d 495 //RGB_LED.set_led(1,0,1);
caseyquinn 28:42932d3b105d 496 }else{
caseyquinn 28:42932d3b105d 497 location = 3;
caseyquinn 28:42932d3b105d 498 //RGB_LED.set_led(1,1,1);
caseyquinn 28:42932d3b105d 499 }
caseyquinn 28:42932d3b105d 500
caseyquinn 28:42932d3b105d 501 }else if(homeDistance == 99999 && workDistance == 99999){
caseyquinn 28:42932d3b105d 502 location = 0;
caseyquinn 28:42932d3b105d 503 RGB_LED.set_led(1,1,0);
caseyquinn 28:42932d3b105d 504 }
caseyquinn 28:42932d3b105d 505
caseyquinn 28:42932d3b105d 506 //}
caseyquinn 28:42932d3b105d 507
caseyquinn 28:42932d3b105d 508 //Check for 3.3V rail cut out and turn off pumps in this event
caseyquinn 28:42932d3b105d 509 if(vInReading > 5950 && amps > 8191) {
caseyquinn 28:42932d3b105d 510 //pumps = 0;
caseyquinn 28:42932d3b105d 511 wait(1);
caseyquinn 28:42932d3b105d 512 //Turn pumps back on once the sampler is plugged in and charging after pumps shutoff and 3.3V rail drops out
caseyquinn 28:42932d3b105d 513 } else if(pumps == 0 && amps < 8191) {
caseyquinn 28:42932d3b105d 514
caseyquinn 28:42932d3b105d 515 // If pumps are plugged in the next morning assume the sampler is at school if after 8 if no GPSfix is available
caseyquinn 28:42932d3b105d 516 if(gpsFix == 0 && RTC_UPAS.hour>8){
caseyquinn 28:42932d3b105d 517 gpslatitude = work_lat; // specific to Rivendell Study. In case student forgets to plug in and teachers catch this. Assume if plugged in after 8 and no GPS signal will change to proper valve. Hopefully...
caseyquinn 28:42932d3b105d 518 gpslongitude = work_lon; // specific to Rivendell Study. In case student forgets to plug in and teachers catch this. Assume if plugged in after 8 and no GPS signal will change to proper valve. Hopefully...
caseyquinn 28:42932d3b105d 519 }
caseyquinn 28:42932d3b105d 520 //Adjust valves to ensure everything is in proper place before pumps restart
caseyquinn 28:42932d3b105d 521 /*
caseyquinn 28:42932d3b105d 522 schoolF1.getFault();
caseyquinn 28:42932d3b105d 523 homeF2.getFault();
caseyquinn 28:42932d3b105d 524 transitF3.getFault();
caseyquinn 28:42932d3b105d 525 blankF4.getFault();
caseyquinn 28:42932d3b105d 526
caseyquinn 28:42932d3b105d 527 schoolF1.drive(254); //closed = 253, open = 254
caseyquinn 28:42932d3b105d 528 homeF2.drive(253); //closed = 253, open = 254
caseyquinn 28:42932d3b105d 529 transitF3.drive(253); //closed = 253, open = 254
caseyquinn 28:42932d3b105d 530 blankF4.drive(253); //closed = 253, open = 254
caseyquinn 28:42932d3b105d 531 wait(1);
caseyquinn 28:42932d3b105d 532 schoolF1.stop();
caseyquinn 28:42932d3b105d 533 homeF2.stop();
caseyquinn 28:42932d3b105d 534 transitF3.stop();
caseyquinn 28:42932d3b105d 535 blankF4.stop();
caseyquinn 28:42932d3b105d 536 */
caseyquinn 28:42932d3b105d 537 //pumps = 1;
caseyquinn 28:42932d3b105d 538
caseyquinn 28:42932d3b105d 539 }
caseyquinn 28:42932d3b105d 540
caseyquinn 28:42932d3b105d 541
caseyquinn 14:7cdb643da356 542
caseyquinn 25:fbf7d44e7da4 543 if(pumps == 1){
caseyquinn 25:fbf7d44e7da4 544 omronReading = ads.readADC_SingleEnded(0, 0xC583); // read channel 0 PGA = 2 : Full Scale Range = 2.048V
caseyquinn 25:fbf7d44e7da4 545 omronVolt = (omronReading*4.096)/(32768*2);
caseyquinn 25:fbf7d44e7da4 546
caseyquinn 25:fbf7d44e7da4 547 if(omronVolt<=calibrations.omronVMin) {
caseyquinn 25:fbf7d44e7da4 548 massflow = calibrations.omronMFMin;
caseyquinn 25:fbf7d44e7da4 549 } else if(omronVolt>=calibrations.omronVMax) {
caseyquinn 25:fbf7d44e7da4 550 massflow = calibrations.omronMFMax;
caseyquinn 25:fbf7d44e7da4 551 } else {
caseyquinn 25:fbf7d44e7da4 552 massflow = calibrations.MF4*pow(omronVolt,(float)4)+calibrations.MF3*pow(omronVolt,(float)3)+calibrations.MF2*pow(omronVolt,(float)2)+calibrations.MF1*omronVolt+calibrations.MF0;
caseyquinn 25:fbf7d44e7da4 553 }
caseyquinn 25:fbf7d44e7da4 554
caseyquinn 25:fbf7d44e7da4 555 atmoRho = ((press-((6.1078*pow((float)10,(float)((7.5*temp)/(237.3+temp))))*(rh/100)))*100)/(287.0531*(temp+273.15))+((6.1078*pow((float)10,(float)((7.5*temp)/(237.3+temp))))*(rh/100)*100)/(461.4964*(temp+273.15));
caseyquinn 25:fbf7d44e7da4 556 volflow = massflow/atmoRho;
caseyquinn 25:fbf7d44e7da4 557 sampledVol = sampledVol + ((((float)logInerval)/60.0)*volflow);
caseyquinn 25:fbf7d44e7da4 558 deltaVflow = volflow-volflowSet;
caseyquinn 25:fbf7d44e7da4 559 massflowSet = volflowSet*atmoRho;
caseyquinn 25:fbf7d44e7da4 560 deltaMflow = massflow-massflowSet;
caseyquinn 25:fbf7d44e7da4 561
caseyquinn 25:fbf7d44e7da4 562 vBlowerReading = ads.readADC_SingleEnded(2, 0xE783); // read channel 0
caseyquinn 25:fbf7d44e7da4 563 omronDiff = ads.readADC_Differential(0x8583); // differential channel 2-3
caseyquinn 14:7cdb643da356 564 }
caseyquinn 14:7cdb643da356 565
caseyquinn 27:922f53fa649c 566
caseyquinn 21:bb10efc5bf57 567
caseyquinn 7:29b01d5812ee 568 FILE *fp = fopen(filename, "a");
caseyquinn 21:bb10efc5bf57 569 fprintf(fp, "%02d,%02d,%02d,%02d,%02d,%02d,",RTC_UPAS.year, RTC_UPAS.month,RTC_UPAS.date,RTC_UPAS.hour,RTC_UPAS.minutes,RTC_UPAS.seconds);
caseyquinn 7:29b01d5812ee 570 fprintf(fp, "%s,", timestr);
caseyquinn 7:29b01d5812ee 571 fprintf(fp, "%1.3f,%1.3f,%2.2f,%4.2f,%2.1f,%1.3f,", omronVolt,massflow,temp,press,rh,atmoRho);
caseyquinn 7:29b01d5812ee 572 fprintf(fp, "%1.3f,%5.1f,%1.1f,%1.1f,%1.1f,%1.1f,", volflow, sampledVol, accel_x, accel_y, accel_z, accel_comp);
caseyquinn 7:29b01d5812ee 573 fprintf(fp, "%.1f,%.1f,%.1f,%.3f,%.3f,%.3f,%.1f,", angle_x,angle_y,angle_z,mag_x, mag_y, mag_z,compass);
caseyquinn 25:fbf7d44e7da4 574 fprintf(fp, "%d,%d,%d,%d,%d,%d," ,uv,omronReading, vInReading, vBlowerReading, omronDiff,amps);
caseyquinn 25:fbf7d44e7da4 575 fprintf(fp, "%d,%d,%d,%1.3f,%1.3f,", bVolt, bFuel,digital_pot_set, deltaMflow, deltaVflow);
caseyquinn 27:922f53fa649c 576 fprintf(fp, "%f,%f,%06d,%06d,", gpslatitude, gpslongitude, (long)gps.date, (long)gps.utc);
caseyquinn 28:42932d3b105d 577 //fprintf(fp, "%f,%d,%f,%f,%d,", gpsspeed, gpssatellites, gpscourse, gpsaltitude, gpsFix);
caseyquinn 28:42932d3b105d 578 fprintf(fp, "%f,%d,%f,%d,", gpsspeed, gpssatellites, gpsaltitude, gpsFix);
caseyquinn 27:922f53fa649c 579 fprintf(fp, "%f,%f,%d,%d\r\n", homeDistance, workDistance, location, pumps == 1); // test and add in speed, etc that Josh added in to match the adafruit GPS
caseyquinn 7:29b01d5812ee 580 fclose(fp);
caseyquinn 7:29b01d5812ee 581 free(fp);
caseyquinn 25:fbf7d44e7da4 582
caseyquinn 25:fbf7d44e7da4 583
caseyquinn 14:7cdb643da356 584
caseyquinn 12:5b4f3245606a 585
caseyquinn 25:fbf7d44e7da4 586
caseyquinn 12:5b4f3245606a 587
jelord 3:122bfc998c4c 588
jelord 3:122bfc998c4c 589 }
caseyquinn 8:c4a8f9b67cee 590
caseyquinn 9:8646fd501832 591 //////////////////////////////////////////////////////////////
caseyquinn 9:8646fd501832 592 //Flow Control Function
caseyquinn 9:8646fd501832 593 //////////////////////////////////////////////////////////////
caseyquinn 8:c4a8f9b67cee 594 void flowControl()
caseyquinn 8:c4a8f9b67cee 595 {
caseyquinn 25:fbf7d44e7da4 596
caseyquinn 25:fbf7d44e7da4 597 //RGB_LED.set_led(0,1,0);
caseyquinn 8:c4a8f9b67cee 598 omronReading = ads.readADC_SingleEnded(0, 0xC583); // read channel 0 PGA = 2 : Full Scale Range = 2.048V
caseyquinn 8:c4a8f9b67cee 599 omronVolt = (omronReading*4.096)/(32768*2);
caseyquinn 8:c4a8f9b67cee 600
caseyquinn 8:c4a8f9b67cee 601 if(omronVolt<=calibrations.omronVMin) {
caseyquinn 8:c4a8f9b67cee 602 massflow = calibrations.omronMFMin;
caseyquinn 8:c4a8f9b67cee 603 } else if(omronVolt>=calibrations.omronVMax) {
caseyquinn 8:c4a8f9b67cee 604 massflow = calibrations.omronMFMax;
caseyquinn 8:c4a8f9b67cee 605 } else {
caseyquinn 8:c4a8f9b67cee 606 massflow = calibrations.MF4*pow(omronVolt,(float)4)+calibrations.MF3*pow(omronVolt,(float)3)+calibrations.MF2*pow(omronVolt,(float)2)+calibrations.MF1*omronVolt+calibrations.MF0;
caseyquinn 8:c4a8f9b67cee 607 }
caseyquinn 8:c4a8f9b67cee 608
caseyquinn 8:c4a8f9b67cee 609 atmoRho = ((press-((6.1078*pow((float)10,(float)((7.5*temp)/(237.3+temp))))*(rh/100)))*100)/(287.0531*(temp+273.15))+((6.1078*pow((float)10,(float)((7.5*temp)/(237.3+temp))))*(rh/100)*100)/(461.4964*(temp+273.15));
caseyquinn 8:c4a8f9b67cee 610 volflow = massflow/atmoRho;
caseyquinn 8:c4a8f9b67cee 611 sampledVol = sampledVol + ((((float)logInerval)/60.0)*volflow);
caseyquinn 8:c4a8f9b67cee 612 deltaVflow = volflow-volflowSet;
caseyquinn 8:c4a8f9b67cee 613 massflowSet = volflowSet*atmoRho;
caseyquinn 8:c4a8f9b67cee 614 deltaMflow = massflow-massflowSet;
caseyquinn 12:5b4f3245606a 615
caseyquinn 8:c4a8f9b67cee 616 if(abs(deltaMflow)>.025) {
caseyquinn 8:c4a8f9b67cee 617 digital_pot_change = (int)(gainFlow*deltaMflow);
caseyquinn 8:c4a8f9b67cee 618
caseyquinn 8:c4a8f9b67cee 619
caseyquinn 12:5b4f3245606a 620 if(abs(digital_pot_change)>=10) {
caseyquinn 12:5b4f3245606a 621 digital_pot_set = (int)(digital_pot_set+ (int)(1*deltaMflow));
caseyquinn 25:fbf7d44e7da4 622 //RGB_LED.set_led(1,0,0);
caseyquinn 12:5b4f3245606a 623 } else {
caseyquinn 8:c4a8f9b67cee 624 digital_pot_set = (digital_pot_set+ digital_pot_change);
caseyquinn 25:fbf7d44e7da4 625 //RGB_LED.set_led(1,1,0);
caseyquinn 8:c4a8f9b67cee 626 }
caseyquinn 8:c4a8f9b67cee 627
caseyquinn 12:5b4f3245606a 628 if(digital_pot_set>=digitalpotMax) {
caseyquinn 12:5b4f3245606a 629 digital_pot_set = digitalpotMax;
caseyquinn 25:fbf7d44e7da4 630 //RGB_LED.set_led(1,0,0);
caseyquinn 12:5b4f3245606a 631 } else if(digital_pot_set<=digitalpotMin) {
caseyquinn 12:5b4f3245606a 632 digital_pot_set = digitalpotMin;
caseyquinn 25:fbf7d44e7da4 633 //RGB_LED.set_led(1,0,0);
caseyquinn 12:5b4f3245606a 634 }
caseyquinn 8:c4a8f9b67cee 635
caseyquinn 8:c4a8f9b67cee 636 DigPot.writeRegister(digital_pot_set);
caseyquinn 12:5b4f3245606a 637
caseyquinn 8:c4a8f9b67cee 638 } else {
caseyquinn 25:fbf7d44e7da4 639 //RGB_LED.set_led(0,1,0);
caseyquinn 8:c4a8f9b67cee 640 }
caseyquinn 12:5b4f3245606a 641
caseyquinn 25:fbf7d44e7da4 642
caseyquinn 8:c4a8f9b67cee 643 }
caseyquinn 9:8646fd501832 644 //////////////////////////////////////////////////////////////
caseyquinn 9:8646fd501832 645 //Main Function
caseyquinn 9:8646fd501832 646 //////////////////////////////////////////////////////////////
jelord 1:9fbb5b665068 647 int main(){
caseyquinn 27:922f53fa649c 648
caseyquinn 23:1ca41779b8ec 649 RGB_LED.set_led(0,0,1);
caseyquinn 28:42932d3b105d 650
caseyquinn 28:42932d3b105d 651 /*
caseyquinn 27:922f53fa649c 652 while(1){
caseyquinn 27:922f53fa649c 653 if(sdCD == 0){
caseyquinn 27:922f53fa649c 654 RGB_LED.set_led(0,1,0);
caseyquinn 27:922f53fa649c 655 }else{
caseyquinn 27:922f53fa649c 656 RGB_LED.set_led(1,0,0);
caseyquinn 27:922f53fa649c 657 }
caseyquinn 27:922f53fa649c 658
caseyquinn 27:922f53fa649c 659 wait(10);
caseyquinn 27:922f53fa649c 660 }
caseyquinn 27:922f53fa649c 661 */
caseyquinn 13:455601f62aad 662
caseyquinn 28:42932d3b105d 663 schoolF1.getFault();
caseyquinn 28:42932d3b105d 664 homeF2.getFault();
caseyquinn 28:42932d3b105d 665 transitF3.getFault();
caseyquinn 28:42932d3b105d 666 blankF4.getFault();
caseyquinn 23:1ca41779b8ec 667
caseyquinn 28:42932d3b105d 668 schoolF1.drive(253); //closed = 253, open = 254
caseyquinn 28:42932d3b105d 669 homeF2.drive(253); //closed = 253, open = 254
caseyquinn 28:42932d3b105d 670 transitF3.drive(254); //closed = 253, open = 254
caseyquinn 28:42932d3b105d 671 blankF4.drive(253); //closed = 253, open = 254
caseyquinn 28:42932d3b105d 672
caseyquinn 28:42932d3b105d 673 wait(1);
caseyquinn 28:42932d3b105d 674 schoolF1.stop();
caseyquinn 28:42932d3b105d 675 homeF2.stop();
caseyquinn 28:42932d3b105d 676 transitF3.stop();
caseyquinn 28:42932d3b105d 677 blankF4.stop();
caseyquinn 23:1ca41779b8ec 678
caseyquinn 23:1ca41779b8ec 679
caseyquinn 23:1ca41779b8ec 680
caseyquinn 23:1ca41779b8ec 681 gpsEN = 1;
caseyquinn 23:1ca41779b8ec 682 wait(1);
caseyquinn 23:1ca41779b8ec 683 BT_SW = 1;
caseyquinn 23:1ca41779b8ec 684 wait(1);
caseyquinn 23:1ca41779b8ec 685 BT_IRST = 1;
caseyquinn 23:1ca41779b8ec 686 wait(1);
caseyquinn 23:1ca41779b8ec 687
caseyquinn 12:5b4f3245606a 688
caseyquinn 10:06fbb1c9e3bd 689 pc.baud(115200); // set what you want here depending on your terminal program speed
caseyquinn 10:06fbb1c9e3bd 690 pc.printf("\f\n\r-------------Startup-------------\n\r");
jelord 1:9fbb5b665068 691 wait(0.5);
caseyquinn 5:c3252e5d45ca 692
caseyquinn 26:6aa294d83af4 693 uint8_t serialNumberAndType[6] = {0x50,0x53,}; //ex) PS0018 // 0x50,0x53 <- ASCII 80 + 83 (PS) //0x4d,0x53 <- ASCII + 83 (MS)
caseyquinn 13:455601f62aad 694
jelord 3:122bfc998c4c 695 E2PROM.read(0x00034,serialNumberAndType+2,2);
caseyquinn 26:6aa294d83af4 696
jelord 3:122bfc998c4c 697 int tempSerialNum = serialNumberAndType[2]+serialNumberAndType[3];
jelord 3:122bfc998c4c 698 int serialNumDigits[4];
jelord 3:122bfc998c4c 699 serialNumDigits[0] = tempSerialNum / 1000 % 10;
jelord 3:122bfc998c4c 700 serialNumDigits[1] = tempSerialNum / 100 % 10;
jelord 3:122bfc998c4c 701 serialNumDigits[2] = tempSerialNum / 10 % 10;
jelord 3:122bfc998c4c 702 serialNumDigits[3] = tempSerialNum % 10;
jelord 3:122bfc998c4c 703
jelord 3:122bfc998c4c 704 serialNumberAndType[2] = serialNumDigits[0]+48;
jelord 3:122bfc998c4c 705 serialNumberAndType[3] = serialNumDigits[1]+48;
jelord 3:122bfc998c4c 706 serialNumberAndType[4] = serialNumDigits[2]+48;
jelord 3:122bfc998c4c 707 serialNumberAndType[5] = serialNumDigits[3]+48;
caseyquinn 12:5b4f3245606a 708
caseyquinn 26:6aa294d83af4 709
caseyquinn 5:c3252e5d45ca 710 RGB_LED.set_led(0,1,0);
caseyquinn 13:455601f62aad 711
caseyquinn 10:06fbb1c9e3bd 712 pc.attach(pc_recv);
jelord 1:9fbb5b665068 713 microChannel.attach(uartMicro,microChannel.RxIrq);
jelord 3:122bfc998c4c 714 microChannel.baud(115200);
jelord 1:9fbb5b665068 715 microChannel.printf("$$$");
jelord 3:122bfc998c4c 716 wait(0.5);
jelord 3:122bfc998c4c 717 microChannel.printf("SN,");
jelord 3:122bfc998c4c 718 for(int i=0;i<6;i++)microChannel.putc(serialNumberAndType[i]);
jelord 3:122bfc998c4c 719 microChannel.printf("\r");
jelord 3:122bfc998c4c 720 wait(0.5);
jelord 1:9fbb5b665068 721 microChannel.printf("A\r");
jelord 3:122bfc998c4c 722 wait(0.5);
jelord 2:88fcbfadec6a 723 microChannel.printf("---\r");
jelord 3:122bfc998c4c 724 wait(0.5);
jelord 2:88fcbfadec6a 725
caseyquinn 18:41ef98db0423 726 RGB_LED.set_led(1,1,1);
jelord 3:122bfc998c4c 727 while(runReady!=1) {
jelord 3:122bfc998c4c 728 wait(1);
caseyquinn 26:6aa294d83af4 729 pc.printf("Waiting for BLE instruction\r\n");
jelord 3:122bfc998c4c 730
jelord 3:122bfc998c4c 731 }
jelord 3:122bfc998c4c 732
caseyquinn 14:7cdb643da356 733
jelord 3:122bfc998c4c 734 E2PROM.read(0x00015, startAndEndTime, 12); //Grab start and end times from EEPROM
jelord 3:122bfc998c4c 735 RGB_LED.set_led(0,1,0);
caseyquinn 14:7cdb643da356 736
caseyquinn 26:6aa294d83af4 737
caseyquinn 26:6aa294d83af4 738 //Pull MicroEnviornment Lat/Lons from EEPROM
caseyquinn 26:6aa294d83af4 739 // Latitude School EEPROM = 0x50-0x53
caseyquinn 26:6aa294d83af4 740 // Longitude School EEPROM = 0x54-0x57
caseyquinn 26:6aa294d83af4 741 // Latitude Home EEPROM = 0x58-0x5B
caseyquinn 26:6aa294d83af4 742 // Longitude Home EEPROM = 0x5C-0x5F
caseyquinn 26:6aa294d83af4 743
caseyquinn 26:6aa294d83af4 744 uint8_t workLat[4] = {0,};
caseyquinn 26:6aa294d83af4 745 E2PROM.read(0x00050,workLat,4);
caseyquinn 26:6aa294d83af4 746 E2PROM.byteToFloat(workLat, &work_lat);
caseyquinn 26:6aa294d83af4 747
caseyquinn 26:6aa294d83af4 748 uint8_t workLon[4] = {0,};
caseyquinn 26:6aa294d83af4 749 E2PROM.read(0x00054,workLon,4);
caseyquinn 26:6aa294d83af4 750 E2PROM.byteToFloat(workLon, &work_lon);
caseyquinn 26:6aa294d83af4 751
caseyquinn 26:6aa294d83af4 752 uint8_t homeLat[4] = {0,};
caseyquinn 26:6aa294d83af4 753 E2PROM.read(0x00058,homeLat,4);
caseyquinn 26:6aa294d83af4 754 E2PROM.byteToFloat(homeLat, &home_lat);
caseyquinn 26:6aa294d83af4 755
caseyquinn 26:6aa294d83af4 756 uint8_t homeLon[4] = {0,};
caseyquinn 26:6aa294d83af4 757 E2PROM.read(0x0005C,homeLon,4);
caseyquinn 26:6aa294d83af4 758 E2PROM.byteToFloat(homeLon, &home_lon);
caseyquinn 26:6aa294d83af4 759
caseyquinn 26:6aa294d83af4 760 pc.printf("%f,%f\r\n%f,%f\r\n", home_lat, home_lon, work_lat, work_lon);
caseyquinn 26:6aa294d83af4 761
caseyquinn 7:29b01d5812ee 762 //!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!
caseyquinn 7:29b01d5812ee 763 //UPDATE THIS TO WORK WITH ST RTC INSTEAD
caseyquinn 7:29b01d5812ee 764 //!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!
caseyquinn 14:7cdb643da356 765
caseyquinn 21:bb10efc5bf57 766 BT_SW = 0;
caseyquinn 21:bb10efc5bf57 767 wait(1);
caseyquinn 21:bb10efc5bf57 768 BT_IRST = 0;
caseyquinn 21:bb10efc5bf57 769 wait(1);
caseyquinn 21:bb10efc5bf57 770
jelord 3:122bfc998c4c 771 while(!RTC_UPAS.compare(startAndEndTime[0], startAndEndTime[1], startAndEndTime[2], startAndEndTime[3], startAndEndTime[4], startAndEndTime[5])) { // this while waits for the start time by looping until the start time
jelord 3:122bfc998c4c 772 wait(0.5);
jelord 3:122bfc998c4c 773
jelord 3:122bfc998c4c 774 RTC_UPAS.get_time();
jelord 3:122bfc998c4c 775
jelord 3:122bfc998c4c 776 }
caseyquinn 14:7cdb643da356 777
caseyquinn 14:7cdb643da356 778
jelord 3:122bfc998c4c 779
jelord 3:122bfc998c4c 780 //Get the proper serial number
jelord 3:122bfc998c4c 781 uint8_t serialBytes[2] = {0,};
jelord 3:122bfc998c4c 782 E2PROM.read(0x00034, serialBytes,2);
jelord 3:122bfc998c4c 783 serial_num = ((uint16_t)serialBytes[1] << 8) | serialBytes[0];
jelord 3:122bfc998c4c 784 calibrations.initialize(serial_num);
jelord 3:122bfc998c4c 785
jelord 3:122bfc998c4c 786 uint8_t logByte[1] = {0,};
jelord 3:122bfc998c4c 787 E2PROM.read(0x00014,logByte,1);
jelord 3:122bfc998c4c 788 logInerval = logByte[0];
jelord 3:122bfc998c4c 789
jelord 3:122bfc998c4c 790 //Use the flow rate value stored in eeprom
jelord 3:122bfc998c4c 791 uint8_t flowRateBytes[4] = {0,};
jelord 3:122bfc998c4c 792 E2PROM.read(0x00010,flowRateBytes,4);
jelord 3:122bfc998c4c 793 E2PROM.byteToFloat(flowRateBytes, &volflowSet);
jelord 3:122bfc998c4c 794
jelord 3:122bfc998c4c 795 if(volflowSet<=1.0) {
jelord 3:122bfc998c4c 796 gainFlow = 100;
jelord 3:122bfc998c4c 797 } else if(volflowSet>=2.0) {
jelord 3:122bfc998c4c 798 gainFlow = 25;
jelord 3:122bfc998c4c 799 } else {
jelord 3:122bfc998c4c 800 gainFlow = 25;
jelord 0:2cb2b2ea316f 801 }
caseyquinn 17:3e6dda6e6335 802
jelord 3:122bfc998c4c 803 RGB_LED.set_led(1,0,0);
jelord 3:122bfc998c4c 804 press = bmesensor.getPressure();
jelord 3:122bfc998c4c 805 temp = bmesensor.getTemperature();
jelord 3:122bfc998c4c 806 rh = bmesensor.getHumidity();
jelord 3:122bfc998c4c 807
jelord 3:122bfc998c4c 808 atmoRho = ((press-((6.1078*pow((float)10,(float)((7.5*temp)/(237.3+temp))))*(rh/100)))*100)/(287.0531*(temp+273.15))+((6.1078*pow((float)10,(float)((7.5*temp)/(237.3+temp))))*(rh/100)*100)/(461.4964*(temp+273.15));
jelord 3:122bfc998c4c 809 massflowSet = volflowSet*atmoRho;
jelord 3:122bfc998c4c 810
jelord 3:122bfc998c4c 811 DigPot.writeRegister(digital_pot_setpoint);
jelord 3:122bfc998c4c 812 wait(1);
caseyquinn 28:42932d3b105d 813 pumps = 1;
caseyquinn 25:fbf7d44e7da4 814 //pumpOn = 1;
jelord 3:122bfc998c4c 815
jelord 3:122bfc998c4c 816 uint8_t subjectLabelOriginal[8] = {0,};
caseyquinn 4:5d004fd997d5 817 E2PROM.read(0x00001, subjectLabelOriginal,8);
caseyquinn 12:5b4f3245606a 818
caseyquinn 13:455601f62aad 819
caseyquinn 12:5b4f3245606a 820
caseyquinn 21:bb10efc5bf57 821 time_t seconds = time(NULL);
caseyquinn 4:5d004fd997d5 822 strftime(timestr, 32, "%y-%m-%d-%H=%M=%S", localtime(&seconds));
caseyquinn 13:455601f62aad 823
caseyquinn 25:fbf7d44e7da4 824 sprintf(filename, "/sd/AMAS%04dLOG_%02d-%02d-%02d_%02d=%02d=%02d_%c%c%c%c%c%c%c%c.txt",serial_num,RTC_UPAS.year,RTC_UPAS.month,RTC_UPAS.date,RTC_UPAS.hour,RTC_UPAS.minutes,RTC_UPAS.seconds,subjectLabelOriginal[0],subjectLabelOriginal[1],subjectLabelOriginal[2],subjectLabelOriginal[3],subjectLabelOriginal[4],subjectLabelOriginal[5],subjectLabelOriginal[6],subjectLabelOriginal[7]);
caseyquinn 22:baa5a077d908 825 //sprintf(filename, "/sd/UPAS_TboardtestLog_%s_%c%c%c%c%c%c%c%c.txt", timestr,subjectLabelOriginal[0],subjectLabelOriginal[1],subjectLabelOriginal[2],subjectLabelOriginal[3],subjectLabelOriginal[4],subjectLabelOriginal[5],subjectLabelOriginal[6],subjectLabelOriginal[7]);
caseyquinn 25:fbf7d44e7da4 826 //sprintf(filename, "/sd/UPAS_TboardtestLog_%s.txt", timestr);
jelord 3:122bfc998c4c 827 FILE *fp = fopen(filename, "w");
jelord 3:122bfc998c4c 828 fclose(fp);
jelord 3:122bfc998c4c 829
caseyquinn 25:fbf7d44e7da4 830
caseyquinn 12:5b4f3245606a 831 omronReading = ads.readADC_SingleEnded(0, 0xC583); // read channel 0 PGA = 2 : Full Scale Range = 2.048V
caseyquinn 12:5b4f3245606a 832 omronVolt = (omronReading*4.096)/(32768*2);
caseyquinn 12:5b4f3245606a 833 if(omronVolt<=calibrations.omronVMin) {
caseyquinn 12:5b4f3245606a 834 massflow = calibrations.omronMFMin;
caseyquinn 12:5b4f3245606a 835 } else if(omronVolt>=calibrations.omronVMax) {
caseyquinn 12:5b4f3245606a 836 massflow = calibrations.omronMFMax;
caseyquinn 12:5b4f3245606a 837 } else {
caseyquinn 12:5b4f3245606a 838 massflow = calibrations.MF4*pow(omronVolt,(float)4)+calibrations.MF3*pow(omronVolt,(float)3)+calibrations.MF2*pow(omronVolt,(float)2)+calibrations.MF1*omronVolt+calibrations.MF0;
caseyquinn 12:5b4f3245606a 839 }
caseyquinn 12:5b4f3245606a 840 deltaMflow = massflow-massflowSet;
caseyquinn 12:5b4f3245606a 841 digital_pot_set = digital_pot_setpoint;
caseyquinn 12:5b4f3245606a 842 wait(5);
caseyquinn 12:5b4f3245606a 843
caseyquinn 12:5b4f3245606a 844 //---------------------------------------------------------------------------------------------//
caseyquinn 12:5b4f3245606a 845 //Sets the flow withen +-1.5% of the desired flow rate based on mass flow
caseyquinn 25:fbf7d44e7da4 846 /*
caseyquinn 12:5b4f3245606a 847 while(abs(deltaMflow)>.025) {
caseyquinn 12:5b4f3245606a 848
caseyquinn 12:5b4f3245606a 849 omronReading = ads.readADC_SingleEnded(0, 0xC583); // read channel 0 PGA = 2 : Full Scale Range = 2.048V
caseyquinn 12:5b4f3245606a 850 omronVolt = (omronReading*4.096)/(32768*2);
caseyquinn 12:5b4f3245606a 851 //Mass Flow tf from file: UPAS v2 OSU-PrimaryFlowData FullSet 2015-05-29 CQ mods.xlsx
caseyquinn 12:5b4f3245606a 852 if(omronVolt<=calibrations.omronVMin) {
caseyquinn 12:5b4f3245606a 853 massflow = calibrations.omronMFMin;
caseyquinn 12:5b4f3245606a 854 } else if(omronVolt>=calibrations.omronVMax) {
caseyquinn 12:5b4f3245606a 855 massflow = calibrations.omronMFMax;
caseyquinn 12:5b4f3245606a 856 } else {
caseyquinn 12:5b4f3245606a 857 massflow = calibrations.MF4*pow(omronVolt,(float)4)+calibrations.MF3*pow(omronVolt,(float)3)+calibrations.MF2*pow(omronVolt,(float)2)+calibrations.MF1*omronVolt+calibrations.MF0;
caseyquinn 12:5b4f3245606a 858 }
caseyquinn 12:5b4f3245606a 859
caseyquinn 12:5b4f3245606a 860 atmoRho = ((press-((6.1078*pow((float)10,(float)((7.5*temp)/(237.3+temp))))*(rh/100)))*100)/(287.0531*(temp+273.15))+((6.1078*pow((float)10,(float)((7.5*temp)/(237.3+temp))))*(rh/100)*100)/(461.4964*(temp+273.15));
caseyquinn 12:5b4f3245606a 861 volflow = massflow/atmoRho;
caseyquinn 12:5b4f3245606a 862 massflowSet = volflowSet*atmoRho;
caseyquinn 12:5b4f3245606a 863 deltaMflow = massflow-massflowSet;
caseyquinn 12:5b4f3245606a 864
caseyquinn 12:5b4f3245606a 865 digital_pot_set = (int)(digital_pot_set+(int)((gainFlow*deltaMflow)));
caseyquinn 12:5b4f3245606a 866 if(digital_pot_set>=digitalpotMax) {
caseyquinn 12:5b4f3245606a 867 digital_pot_set = digitalpotMax;
caseyquinn 12:5b4f3245606a 868 } else if(digital_pot_set<=digitalpotMin) {
caseyquinn 12:5b4f3245606a 869 digital_pot_set = digitalpotMin;
caseyquinn 12:5b4f3245606a 870 }
caseyquinn 12:5b4f3245606a 871
caseyquinn 12:5b4f3245606a 872 wait(2);
caseyquinn 12:5b4f3245606a 873 DigPot.writeRegister(digital_pot_set);
caseyquinn 12:5b4f3245606a 874 pc.printf("%d,\r\n", digital_pot_set);
caseyquinn 12:5b4f3245606a 875 wait(1);
caseyquinn 12:5b4f3245606a 876
caseyquinn 12:5b4f3245606a 877
caseyquinn 12:5b4f3245606a 878 }
caseyquinn 25:fbf7d44e7da4 879
caseyquinn 14:7cdb643da356 880 */
jelord 3:122bfc998c4c 881 sampledVol = 0.0;
jelord 3:122bfc998c4c 882 RGB_LED.set_led(0,1,0);
caseyquinn 25:fbf7d44e7da4 883 wait(1);
caseyquinn 25:fbf7d44e7da4 884 RGB_LED.set_led(0,0,0);
caseyquinn 14:7cdb643da356 885
caseyquinn 18:41ef98db0423 886 stop.attach(&check_stop, 9); // check if we should shut down every 9 number seconds, starting after the start.
caseyquinn 14:7cdb643da356 887 logg.attach(&log_data, logInerval);
caseyquinn 25:fbf7d44e7da4 888 //flowCtl.attach(&flowControl, 3);
caseyquinn 7:29b01d5812ee 889
jelord 3:122bfc998c4c 890
jelord 3:122bfc998c4c 891 //** end of initalization **//
jelord 3:122bfc998c4c 892 //---------------------------------------------------------------------------------------------//
jelord 3:122bfc998c4c 893 //---------------------------------------------------------------------------------------------//
jelord 3:122bfc998c4c 894 // Main Control Loop
jelord 3:122bfc998c4c 895
caseyquinn 7:29b01d5812ee 896 while (1) {
caseyquinn 7:29b01d5812ee 897 // Do other things...
caseyquinn 14:7cdb643da356 898 /*
caseyquinn 18:41ef98db0423 899 pumps = 1;
caseyquinn 13:455601f62aad 900 wait(5);
caseyquinn 18:41ef98db0423 901 pumps = 0;
caseyquinn 13:455601f62aad 902 wait(5);
caseyquinn 14:7cdb643da356 903 */
caseyquinn 7:29b01d5812ee 904 }
caseyquinn 7:29b01d5812ee 905
caseyquinn 8:c4a8f9b67cee 906
caseyquinn 4:5d004fd997d5 907
jelord 3:122bfc998c4c 908
jelord 0:2cb2b2ea316f 909 }