scott kelleher / Outdoor_UPAS_v1_2_Tboard

6 sharps, 2 ads hooked up

Dependencies:   ADS1115 BME280 CronoDot SDFileSystem mbed

Fork of Outdoor_UPAS_v1_2_Tboard by Volckens Group Sensors

main.cpp@23:1ca41779b8ec, 2016-03-28 (annotated)

Committer:
caseyquinn
Date:
Mon Mar 28 02:54:17 2016 +0000
Revision:
23:1ca41779b8ec
Parent:
22:baa5a077d908
Child:
24:e274a34492cf
Tests Hbridges top two HB2 and HB4 are working. Added in gps heading and also red light for log when no gps connection and RGB light when gps connection.; UPASv1_Tboard_NUCLEO_L152RE_Hbridge_test_RN4677_GPS_pumpson_100digpot_20160327.bin

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 12:5b4f3245606a 53 DigitalIn bcs1(PC_9); //Charge complete if High. Connected but currently unused. (MCP73871) http://www.mouser.com/ds/2/268/22090a-52174.pdf
caseyquinn 12:5b4f3245606a 54 DigitalIn 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 23:1ca41779b8ec 80 DRV8830 motor1(PB_9, PB_8, 0xCA); //Not working with 0xC4 will remove R28 and try 0xCA
caseyquinn 23:1ca41779b8ec 81 DRV8830 motor2(PB_9, PB_8, 0xC8); //Works with 0xC8, not 0xCA since R8 isn't on the Tboards.
caseyquinn 23:1ca41779b8ec 82 DRV8830 motor3(PB_9, PB_8, 0xCC); //Not working with 0xCC might try replacing R15 with a 0 ohm resistor and try again.
caseyquinn 23:1ca41779b8ec 83 DRV8830 motor4(PB_9, PB_8, 0xCE); //Works!
caseyquinn 12:5b4f3245606a 84 DigitalIn hb_fault1(PA_6);
caseyquinn 12:5b4f3245606a 85 DigitalIn hb_fault2(PA_7);
caseyquinn 12:5b4f3245606a 86 DigitalIn hb_fault3(PA_5);
caseyquinn 12:5b4f3245606a 87 DigitalIn hb_fault4(PA_4);
caseyquinn 23:1ca41779b8ec 88
caseyquinn 12:5b4f3245606a 89 /////////////////////////////////////////////
caseyquinn 12:5b4f3245606a 90 //SD Card
caseyquinn 12:5b4f3245606a 91 /////////////////////////////////////////////
caseyquinn 12:5b4f3245606a 92 char filename[] = "/sd/XXXX0000LOG000000000000---------------.txt";
caseyquinn 12:5b4f3245606a 93 SDFileSystem sd(PB_5, PB_4, PB_3, PB_6, "sd");//(D4, D5, D3, D10, "sd"); // (MOSI, MISO, SCK, SEL)
caseyquinn 12:5b4f3245606a 94 DigitalIn sdCD(PA_11);
caseyquinn 14:7cdb643da356 95
caseyquinn 12:5b4f3245606a 96 /////////////////////////////////////////////
caseyquinn 12:5b4f3245606a 97 //Callbacks
caseyquinn 12:5b4f3245606a 98 /////////////////////////////////////////////
caseyquinn 9:8646fd501832 99 Ticker stop; //This is the stop callback object
caseyquinn 8:c4a8f9b67cee 100 Ticker logg; //This is the logging callback object
caseyquinn 9:8646fd501832 101 Ticker flowCtl; //This is the control loop callback object
jelord 3:122bfc998c4c 102
caseyquinn 12:5b4f3245606a 103 /////////////////////////////////////////////
caseyquinn 12:5b4f3245606a 104 //Varible Definitions
caseyquinn 12:5b4f3245606a 105 /////////////////////////////////////////////
jelord 3:122bfc998c4c 106 uint16_t serial_num = 1; // Default serial/calibration number
jelord 3:122bfc998c4c 107 int RunReady =0;
jelord 3:122bfc998c4c 108
caseyquinn 4:5d004fd997d5 109 struct tm STtime;
caseyquinn 7:29b01d5812ee 110 char timestr[32];
jelord 3:122bfc998c4c 111
caseyquinn 9:8646fd501832 112 float press;
caseyquinn 9:8646fd501832 113 float temp;
caseyquinn 9:8646fd501832 114 float rh;
jelord 3:122bfc998c4c 115
caseyquinn 9:8646fd501832 116 int uv;
caseyquinn 9:8646fd501832 117 int vis;
caseyquinn 9:8646fd501832 118 int ir;
jelord 3:122bfc998c4c 119
caseyquinn 9:8646fd501832 120 float compass;
caseyquinn 9:8646fd501832 121 float accel_x;
caseyquinn 9:8646fd501832 122 float accel_y;
caseyquinn 9:8646fd501832 123 float accel_z;
caseyquinn 9:8646fd501832 124 float accel_comp;
caseyquinn 9:8646fd501832 125 float angle_x;
caseyquinn 9:8646fd501832 126 float angle_y;
caseyquinn 9:8646fd501832 127 float angle_z;
caseyquinn 9:8646fd501832 128 float mag_x;
caseyquinn 9:8646fd501832 129 float mag_y;
caseyquinn 9:8646fd501832 130 float mag_z;
jelord 3:122bfc998c4c 131
caseyquinn 9:8646fd501832 132 int vInReading;
caseyquinn 9:8646fd501832 133 int vBlowerReading;
caseyquinn 9:8646fd501832 134 int omronDiff;
caseyquinn 9:8646fd501832 135 float omronVolt; //V
caseyquinn 9:8646fd501832 136 int omronReading;
caseyquinn 9:8646fd501832 137 float atmoRho; //g/L
jelord 3:122bfc998c4c 138
caseyquinn 9:8646fd501832 139 float massflow; //g/min
caseyquinn 9:8646fd501832 140 float volflow; //L/min
jelord 3:122bfc998c4c 141 float volflowSet = 1.0; //L/min
caseyquinn 14:7cdb643da356 142 int logInerval = 5;//seconds
jelord 3:122bfc998c4c 143 double secondsD = 0;
jelord 3:122bfc998c4c 144 double lastsecondD = 0;
caseyquinn 9:8646fd501832 145 float massflowSet;
jelord 3:122bfc998c4c 146 float deltaVflow = 0.0;
jelord 3:122bfc998c4c 147 float deltaMflow = 0.0;
caseyquinn 9:8646fd501832 148 float gainFlow;
caseyquinn 9:8646fd501832 149 float sampledVol; //L, total sampled volume
jelord 3:122bfc998c4c 150
caseyquinn 14:7cdb643da356 151 int digital_pot_setpoint = 100; //min = 0x7F, max = 0x00
caseyquinn 9:8646fd501832 152 int digital_pot_set;
caseyquinn 9:8646fd501832 153 int digital_pot_change;
jelord 3:122bfc998c4c 154 int digitalpotMax = 127;
caseyquinn 9:8646fd501832 155 int digitalpotMin = 10;
jelord 3:122bfc998c4c 156
caseyquinn 12:5b4f3245606a 157 int dutyUp;
caseyquinn 12:5b4f3245606a 158 int dutyDown;
caseyquinn 12:5b4f3245606a 159
caseyquinn 12:5b4f3245606a 160 float flat = 0;
caseyquinn 12:5b4f3245606a 161 float flon = 0;
jelord 3:122bfc998c4c 162
caseyquinn 23:1ca41779b8ec 163 bool gpsFix;
caseyquinn 12:5b4f3245606a 164 uint8_t gpssatellites = 0;
caseyquinn 23:1ca41779b8ec 165 double gpsspeed = 0.0;
caseyquinn 23:1ca41779b8ec 166 double gpslatitude = 0.0;
caseyquinn 23:1ca41779b8ec 167 double gpslongitude = 0.0;
caseyquinn 23:1ca41779b8ec 168 float gpsaltitude = 0.0;
caseyquinn 23:1ca41779b8ec 169 char gpslat = 'W';
caseyquinn 23:1ca41779b8ec 170 char gpslon = 'N';
caseyquinn 12:5b4f3245606a 171
caseyquinn 12:5b4f3245606a 172
caseyquinn 12:5b4f3245606a 173 float home_lat = 40.580508;
caseyquinn 12:5b4f3245606a 174 float home_lon = -105.081823;
caseyquinn 12:5b4f3245606a 175 float work_lat = 40.594062; //40.569136;
caseyquinn 12:5b4f3245606a 176 float work_lon = -105.075683; //-105.081966;
caseyquinn 12:5b4f3245606a 177 int location = 0;
caseyquinn 12:5b4f3245606a 178
caseyquinn 12:5b4f3245606a 179 float homeDistance = 99999;
caseyquinn 12:5b4f3245606a 180 float workDistance = 99999;
caseyquinn 12:5b4f3245606a 181
jelord 3:122bfc998c4c 182 //*************************************************//
jelord 3:122bfc998c4c 183
jelord 2:88fcbfadec6a 184 void sendData();
caseyquinn 11:aa21628a9b15 185
caseyquinn 11:aa21628a9b15 186
caseyquinn 11:aa21628a9b15 187 void pc_recv(){
caseyquinn 11:aa21628a9b15 188 while(pc.readable()){
caseyquinn 11:aa21628a9b15 189 pc.getc();
caseyquinn 11:aa21628a9b15 190 }
caseyquinn 11:aa21628a9b15 191 }
caseyquinn 11:aa21628a9b15 192
jelord 0:2cb2b2ea316f 193 static uint8_t rx_buf[20];
jelord 0:2cb2b2ea316f 194 static uint8_t rx_len=0;
jelord 1:9fbb5b665068 195 static int haltBLE = 1;
jelord 1:9fbb5b665068 196 static int transmissionValue = 0;
jelord 2:88fcbfadec6a 197 uint8_t writeData[20] = {0,};
jelord 2:88fcbfadec6a 198 static uint8_t dataLength = 0;
jelord 3:122bfc998c4c 199 static int runReady = 0;
jelord 3:122bfc998c4c 200 static uint8_t startAndEndTime[12] = {0,};
caseyquinn 5:c3252e5d45ca 201
caseyquinn 9:8646fd501832 202 //////////////////////////////////////////////////////////////
caseyquinn 9:8646fd501832 203 //BLE Functions
caseyquinn 9:8646fd501832 204 //////////////////////////////////////////////////////////////
caseyquinn 9:8646fd501832 205
caseyquinn 9:8646fd501832 206 void uartMicro(){
jelord 3:122bfc998c4c 207 if(runReady!=1){
jelord 3:122bfc998c4c 208 haltBLE = 2;
jelord 3:122bfc998c4c 209 while(microChannel.readable()){
jelord 3:122bfc998c4c 210 rx_buf[rx_len++] = microChannel.getc();
jelord 2:88fcbfadec6a 211
jelord 3:122bfc998c4c 212 //Code block to verify what is being transmitted. To function correctly, all data must terminate with \0 or \n
jelord 3:122bfc998c4c 213 if(transmissionValue==0){
jelord 3:122bfc998c4c 214
caseyquinn 4:5d004fd997d5 215 if (rx_buf[0] == 0x01)transmissionValue = 1; //rtc
jelord 3:122bfc998c4c 216 else if(rx_buf[0] == 0x02)transmissionValue = 2; //sample start and end times
jelord 3:122bfc998c4c 217 else if(rx_buf[0] == 0x03)transmissionValue = 3; //sample name
jelord 3:122bfc998c4c 218 else if(rx_buf[0] == 0x04)transmissionValue = 4; //Send Data Check
jelord 3:122bfc998c4c 219
jelord 3:122bfc998c4c 220 else if(rx_buf[0] == 0x05)transmissionValue = 5; //log interval
jelord 3:122bfc998c4c 221 else if(rx_buf[0] == 0x06)transmissionValue = 6; //Flow Rate
jelord 3:122bfc998c4c 222 else if(rx_buf[0] == 0x07)transmissionValue = 7; //Serial Number
jelord 3:122bfc998c4c 223 else if(rx_buf[0] == 0x08)transmissionValue = 8; //Run Enable
jelord 3:122bfc998c4c 224 else transmissionValue = 100; //Not useful data
jelord 3:122bfc998c4c 225 }
jelord 3:122bfc998c4c 226
jelord 3:122bfc998c4c 227 if(rx_buf[rx_len-1]=='\0' || rx_buf[rx_len-1]=='\n' || rx_buf[rx_len-1] == 0xff){
jelord 3:122bfc998c4c 228 if((transmissionValue == 1 || transmissionValue == 2 || transmissionValue == 3 || transmissionValue == 4 || transmissionValue == 5 ||
jelord 3:122bfc998c4c 229 transmissionValue == 6 || transmissionValue == 7) && rx_buf[rx_len-1] != 0xff)
jelord 3:122bfc998c4c 230 {}else{
caseyquinn 21:bb10efc5bf57 231 if(transmissionValue == 4 ) sendData();
jelord 3:122bfc998c4c 232 if(transmissionValue == 8){
jelord 3:122bfc998c4c 233 runReady = 1;
jelord 3:122bfc998c4c 234 microChannel.attach(NULL,microChannel.RxIrq);
jelord 3:122bfc998c4c 235 }
jelord 3:122bfc998c4c 236 haltBLE = 1;
jelord 3:122bfc998c4c 237 transmissionValue = 0;
jelord 3:122bfc998c4c 238 dataLength = 0;
jelord 2:88fcbfadec6a 239
jelord 3:122bfc998c4c 240 }
jelord 2:88fcbfadec6a 241 }
jelord 1:9fbb5b665068 242 }
caseyquinn 12:5b4f3245606a 243
jelord 3:122bfc998c4c 244 if(haltBLE!=1){
jelord 2:88fcbfadec6a 245
jelord 3:122bfc998c4c 246 if((transmissionValue!=100) && (dataLength!= 0)) writeData[dataLength-1] = rx_buf[0];
jelord 3:122bfc998c4c 247
jelord 3:122bfc998c4c 248 if(transmissionValue ==100){
caseyquinn 10:06fbb1c9e3bd 249 pc.putc(rx_buf[0]);
jelord 2:88fcbfadec6a 250
jelord 3:122bfc998c4c 251 }else if(transmissionValue ==1){ //process and store RTC values
jelord 3:122bfc998c4c 252
caseyquinn 7:29b01d5812ee 253 //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 254 if(dataLength==6){
caseyquinn 17:3e6dda6e6335 255 RTC_UPAS.set_time(writeData[0],writeData[1],writeData[2],writeData[3],writeData[3],writeData[4],writeData[5]);//sets chronodot RTC
caseyquinn 12:5b4f3245606a 256 ///////////////////////
caseyquinn 7:29b01d5812ee 257 //sets ST RTC
caseyquinn 12:5b4f3245606a 258 //////////////////////
caseyquinn 7:29b01d5812ee 259 STtime.tm_sec = writeData[0]; // 0-59
caseyquinn 7:29b01d5812ee 260 STtime.tm_min = writeData[1]; // 0-59
caseyquinn 7:29b01d5812ee 261 STtime.tm_hour = writeData[2]; // 0-23
caseyquinn 7:29b01d5812ee 262 STtime.tm_mday = writeData[3]; // 1-31
caseyquinn 7:29b01d5812ee 263 STtime.tm_mon = writeData[4]-1; // 0-11
caseyquinn 7:29b01d5812ee 264 STtime.tm_year = 100+writeData[5]; // year since 1900 (116 = 2016)
caseyquinn 7:29b01d5812ee 265 time_t STseconds = mktime(&STtime);
caseyquinn 12:5b4f3245606a 266 set_time(STseconds); // Set RTC time
caseyquinn 7:29b01d5812ee 267 }
jelord 3:122bfc998c4c 268
caseyquinn 12:5b4f3245606a 269 }
caseyquinn 14:7cdb643da356 270 else if(transmissionValue ==2){ //process and store sample start/end
jelord 3:122bfc998c4c 271 if(dataLength ==12)E2PROM.write(0x00015, writeData, 12);
jelord 3:122bfc998c4c 272
jelord 3:122bfc998c4c 273 }else if(transmissionValue ==3){ //process and store sample name
jelord 3:122bfc998c4c 274 if(dataLength ==8)E2PROM.write(0x00001,writeData,8);
jelord 3:122bfc998c4c 275
jelord 3:122bfc998c4c 276 }else if(transmissionValue ==5){ //process and store Log Interval
jelord 3:122bfc998c4c 277 if(dataLength ==1)E2PROM.write(0x00014,writeData,1);
jelord 2:88fcbfadec6a 278
jelord 3:122bfc998c4c 279 }else if(transmissionValue ==6){ //process and store Flow Rate
jelord 3:122bfc998c4c 280 if(dataLength ==4)E2PROM.write(0x00010,writeData,4);
jelord 3:122bfc998c4c 281
jelord 3:122bfc998c4c 282 }else if(transmissionValue ==7){ //process and store Serial Number
jelord 3:122bfc998c4c 283 if(dataLength ==2)E2PROM.write(0x00034,writeData,2);
jelord 3:122bfc998c4c 284 }
caseyquinn 14:7cdb643da356 285
jelord 3:122bfc998c4c 286 dataLength++;
jelord 1:9fbb5b665068 287 }
jelord 3:122bfc998c4c 288
jelord 3:122bfc998c4c 289 rx_len = 0;
jelord 3:122bfc998c4c 290 }else{
jelord 3:122bfc998c4c 291 while(microChannel.readable())
jelord 3:122bfc998c4c 292 uint8_t extract = microChannel.getc();
jelord 3:122bfc998c4c 293 }
jelord 2:88fcbfadec6a 294
caseyquinn 12:5b4f3245606a 295
jelord 2:88fcbfadec6a 296 }
caseyquinn 14:7cdb643da356 297
jelord 2:88fcbfadec6a 298 void sendData(){
jelord 2:88fcbfadec6a 299
caseyquinn 21:bb10efc5bf57 300 uint8_t sampleTimePassValues[13] = {0x01,0x00,0x00,0x0A,0x01,0x01,0x10,0x00,0x00,0x0A,0x01,0x01,0x10};
caseyquinn 21:bb10efc5bf57 301 uint8_t subjectLabelOriginal[9] = {0x02,0x52,0x45,0x53,0x45,0x54,0x5F,0x5F,0x5f};
caseyquinn 21:bb10efc5bf57 302 uint8_t dataLogOriginal[2] = {0x03,0x0A,};
caseyquinn 21:bb10efc5bf57 303 uint8_t flowRateOriginal[5] = {0x04,0x00,0x00,0x80,0x3F};
jelord 2:88fcbfadec6a 304 //uint8_t presetRunModeCheck[1] = {0,}; Commented and currently unused to prevent mem issues
jelord 2:88fcbfadec6a 305 E2PROM.read(0x00015, sampleTimePassValues+1, 12);
jelord 2:88fcbfadec6a 306 E2PROM.read(0x00001, subjectLabelOriginal+1,8);
jelord 2:88fcbfadec6a 307 E2PROM.read(0x00014,dataLogOriginal+1,1);
jelord 2:88fcbfadec6a 308 E2PROM.read(0x00010,flowRateOriginal+1,4);
caseyquinn 21:bb10efc5bf57 309
jelord 2:88fcbfadec6a 310
jelord 2:88fcbfadec6a 311 for(int i=0; i<13; i++){
jelord 2:88fcbfadec6a 312 microChannel.putc(sampleTimePassValues[i]);
jelord 2:88fcbfadec6a 313 }
jelord 2:88fcbfadec6a 314 wait(.25);
jelord 2:88fcbfadec6a 315
jelord 2:88fcbfadec6a 316 for(int i=0; i<9; i++){
jelord 2:88fcbfadec6a 317 microChannel.putc(subjectLabelOriginal[i]);
jelord 2:88fcbfadec6a 318 }
jelord 2:88fcbfadec6a 319 wait(.25);
jelord 2:88fcbfadec6a 320
jelord 2:88fcbfadec6a 321 for(int i=0; i<2; i++){
jelord 2:88fcbfadec6a 322 microChannel.putc(dataLogOriginal[i]);
jelord 2:88fcbfadec6a 323 }
jelord 2:88fcbfadec6a 324 wait(.25);
jelord 2:88fcbfadec6a 325
jelord 2:88fcbfadec6a 326 for(int i=0; i<5; i++){
jelord 2:88fcbfadec6a 327 microChannel.putc(flowRateOriginal[i]);
jelord 2:88fcbfadec6a 328 }
jelord 0:2cb2b2ea316f 329
jelord 2:88fcbfadec6a 330
jelord 2:88fcbfadec6a 331 }
caseyquinn 14:7cdb643da356 332
caseyquinn 12:5b4f3245606a 333 //////////////////////////////////////////////////////////////
caseyquinn 12:5b4f3245606a 334 // GPS: Degree-minute format to decimal-degrees
caseyquinn 12:5b4f3245606a 335 //////////////////////////////////////////////////////////////
caseyquinn 12:5b4f3245606a 336 double convertDegMinToDecDeg (float degMin)
caseyquinn 12:5b4f3245606a 337 {
caseyquinn 12:5b4f3245606a 338 double min = 0.0;
caseyquinn 12:5b4f3245606a 339 double decDeg = 0.0;
caseyquinn 12:5b4f3245606a 340
caseyquinn 12:5b4f3245606a 341 //get the minutes, fmod() requires double
caseyquinn 12:5b4f3245606a 342 min = fmod((double)degMin, 100.0);
caseyquinn 12:5b4f3245606a 343
caseyquinn 12:5b4f3245606a 344 //rebuild coordinates in decimal degrees
caseyquinn 12:5b4f3245606a 345 degMin = (int) ( degMin / 100 );
caseyquinn 12:5b4f3245606a 346 decDeg = degMin + ( min / 60 );
caseyquinn 12:5b4f3245606a 347
caseyquinn 12:5b4f3245606a 348 return decDeg;
caseyquinn 12:5b4f3245606a 349 }
caseyquinn 12:5b4f3245606a 350
caseyquinn 12:5b4f3245606a 351 //////////////////////////////////////////////////////////////
caseyquinn 12:5b4f3245606a 352 // GPS: Calculate distance from target location
caseyquinn 12:5b4f3245606a 353 //////////////////////////////////////////////////////////////
caseyquinn 12:5b4f3245606a 354 double GPSdistanceCalc (float tlat, float tlon)
caseyquinn 12:5b4f3245606a 355 {
caseyquinn 12:5b4f3245606a 356
caseyquinn 12:5b4f3245606a 357
caseyquinn 12:5b4f3245606a 358
caseyquinn 12:5b4f3245606a 359 float tlatrad, flatrad;
caseyquinn 12:5b4f3245606a 360 float sdlong, cdlong;
caseyquinn 12:5b4f3245606a 361 float sflat, cflat;
caseyquinn 12:5b4f3245606a 362 float stlat, ctlat;
caseyquinn 12:5b4f3245606a 363 float delta, denom;
caseyquinn 12:5b4f3245606a 364
caseyquinn 12:5b4f3245606a 365 double distance;
caseyquinn 12:5b4f3245606a 366 delta = (flon-tlon)*0.0174532925;
caseyquinn 12:5b4f3245606a 367 sdlong = sin(delta);
caseyquinn 12:5b4f3245606a 368 cdlong = cos(delta);
caseyquinn 12:5b4f3245606a 369 flatrad = (flat)*0.0174532925;
caseyquinn 12:5b4f3245606a 370 tlatrad = (tlat)*0.0174532925;
caseyquinn 12:5b4f3245606a 371 sflat = sin(flatrad);
caseyquinn 12:5b4f3245606a 372 cflat = cos(flatrad);
caseyquinn 12:5b4f3245606a 373 stlat = sin(tlatrad);
caseyquinn 12:5b4f3245606a 374 ctlat = cos(tlatrad);
caseyquinn 12:5b4f3245606a 375 delta = (cflat * stlat) - (sflat * ctlat * cdlong);
caseyquinn 12:5b4f3245606a 376 delta = pow(delta,2);
caseyquinn 12:5b4f3245606a 377 delta += pow(ctlat * sdlong,2);
caseyquinn 12:5b4f3245606a 378 delta = sqrt(delta);
caseyquinn 12:5b4f3245606a 379 denom = (sflat * stlat) + (cflat * ctlat * cdlong);
caseyquinn 12:5b4f3245606a 380 delta = atan2(delta, denom);
caseyquinn 12:5b4f3245606a 381 distance = delta * 6372795;
caseyquinn 12:5b4f3245606a 382 return distance;
caseyquinn 12:5b4f3245606a 383 }
caseyquinn 12:5b4f3245606a 384
caseyquinn 5:c3252e5d45ca 385
caseyquinn 9:8646fd501832 386 //////////////////////////////////////////////////////////////
caseyquinn 9:8646fd501832 387 //Shutdown Function
caseyquinn 9:8646fd501832 388 //////////////////////////////////////////////////////////////
jelord 3:122bfc998c4c 389 void check_stop() // this checks if it's time to stop and shutdown
jelord 3:122bfc998c4c 390 {
caseyquinn 9:8646fd501832 391 //!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!
caseyquinn 9:8646fd501832 392 //UPDATE THIS TO WORK WITH ST RTC INSTEAD
caseyquinn 9:8646fd501832 393 //!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!
caseyquinn 17:3e6dda6e6335 394
jelord 3:122bfc998c4c 395 if(RTC_UPAS.compare(startAndEndTime[6], startAndEndTime[7], startAndEndTime[8], startAndEndTime[9], startAndEndTime[10], startAndEndTime[11])) {
jelord 3:122bfc998c4c 396 pbKill = 0; // this is were we shut everything down
caseyquinn 4:5d004fd997d5 397 //pc.printf("If you're reading this something has gone very wrong.");
jelord 3:122bfc998c4c 398 }
caseyquinn 17:3e6dda6e6335 399
jelord 3:122bfc998c4c 400 }
caseyquinn 5:c3252e5d45ca 401
caseyquinn 9:8646fd501832 402 //////////////////////////////////////////////////////////////
caseyquinn 9:8646fd501832 403 //SD Logging Function
caseyquinn 9:8646fd501832 404 //////////////////////////////////////////////////////////////
jelord 3:122bfc998c4c 405 void log_data()
jelord 3:122bfc998c4c 406 {
caseyquinn 14:7cdb643da356 407
caseyquinn 23:1ca41779b8ec 408
caseyquinn 7:29b01d5812ee 409 time_t seconds = time(NULL);
caseyquinn 7:29b01d5812ee 410 strftime(timestr, 32, "%y%m%d%H%M%S", localtime(&seconds));
caseyquinn 13:455601f62aad 411
caseyquinn 17:3e6dda6e6335 412 RTC_UPAS.get_time();
caseyquinn 7:29b01d5812ee 413 press = bmesensor.getPressure();
caseyquinn 7:29b01d5812ee 414 temp = bmesensor.getTemperature()-5.0;
caseyquinn 7:29b01d5812ee 415 rh = bmesensor.getHumidity();
caseyquinn 7:29b01d5812ee 416 uv = lightsensor.getUV();
caseyquinn 14:7cdb643da356 417 movementsensor.getACCEL();
caseyquinn 14:7cdb643da356 418 movementsensor.getCOMPASS();
caseyquinn 14:7cdb643da356 419 compass = movementsensor.getCOMPASS_HEADING();
caseyquinn 14:7cdb643da356 420 accel_x = movementsensor.AccelData.x;
caseyquinn 14:7cdb643da356 421 accel_y = movementsensor.AccelData.y;
caseyquinn 14:7cdb643da356 422 accel_z = movementsensor.AccelData.z;
caseyquinn 14:7cdb643da356 423 accel_comp = pow(accel_x,(float)2)+pow(accel_y,(float)2)+pow(accel_z,(float)2)-1.0;
caseyquinn 14:7cdb643da356 424 mag_x = movementsensor.MagData.x;
caseyquinn 14:7cdb643da356 425 mag_y = movementsensor.MagData.y;
caseyquinn 14:7cdb643da356 426 mag_z = movementsensor.MagData.z;
caseyquinn 7:29b01d5812ee 427
caseyquinn 14:7cdb643da356 428 omronReading = ads.readADC_SingleEnded(0, 0xC583); // read channel 0 PGA = 2 : Full Scale Range = 2.048V
caseyquinn 14:7cdb643da356 429 omronVolt = (omronReading*4.096)/(32768*2);
caseyquinn 14:7cdb643da356 430
caseyquinn 14:7cdb643da356 431 if(omronVolt<=calibrations.omronVMin) {
caseyquinn 14:7cdb643da356 432 massflow = calibrations.omronMFMin;
caseyquinn 14:7cdb643da356 433 } else if(omronVolt>=calibrations.omronVMax) {
caseyquinn 14:7cdb643da356 434 massflow = calibrations.omronMFMax;
caseyquinn 14:7cdb643da356 435 } else {
caseyquinn 14:7cdb643da356 436 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 14:7cdb643da356 437 }
caseyquinn 14:7cdb643da356 438
caseyquinn 14:7cdb643da356 439 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 14:7cdb643da356 440 volflow = massflow/atmoRho;
caseyquinn 14:7cdb643da356 441 sampledVol = sampledVol + ((((float)logInerval)/60.0)*volflow);
caseyquinn 14:7cdb643da356 442 deltaVflow = volflow-volflowSet;
caseyquinn 14:7cdb643da356 443 massflowSet = volflowSet*atmoRho;
caseyquinn 14:7cdb643da356 444 deltaMflow = massflow-massflowSet;
caseyquinn 14:7cdb643da356 445
caseyquinn 14:7cdb643da356 446 vInReading = ads.readADC_SingleEnded(1, 0xD583); // read channel 0
caseyquinn 14:7cdb643da356 447 vBlowerReading = ads.readADC_SingleEnded(2, 0xE783); // read channel 0
caseyquinn 14:7cdb643da356 448 omronDiff = ads.readADC_Differential(0x8583); // differential channel 2-3
caseyquinn 21:bb10efc5bf57 449
caseyquinn 23:1ca41779b8ec 450 //if(gpsEN ==1){
caseyquinn 23:1ca41779b8ec 451
caseyquinn 23:1ca41779b8ec 452 if(gpsFix){
caseyquinn 23:1ca41779b8ec 453 RGB_LED.set_led(1,1,1);
caseyquinn 23:1ca41779b8ec 454 }else{
caseyquinn 23:1ca41779b8ec 455 RGB_LED.set_led(1,0,0);
caseyquinn 23:1ca41779b8ec 456 }
caseyquinn 23:1ca41779b8ec 457 gpsFix = gps.read(1);
caseyquinn 21:bb10efc5bf57 458 //RGB_LED.set_led(1,1,0);
caseyquinn 12:5b4f3245606a 459 gpsspeed = gps.speed;
caseyquinn 12:5b4f3245606a 460 gpssatellites = gps.satellites;
caseyquinn 12:5b4f3245606a 461 gpslatitude = gps.lat;
caseyquinn 12:5b4f3245606a 462 // gpslat = 'N'; //gps.lat; need to fix this (if statement?)
caseyquinn 12:5b4f3245606a 463 gpslongitude = gps.lon;
caseyquinn 12:5b4f3245606a 464 // gpslon = 'W'; //gps.lon; need to fix this (if statement?)
caseyquinn 12:5b4f3245606a 465 gpsaltitude = gps.altitude;
caseyquinn 12:5b4f3245606a 466
caseyquinn 21:bb10efc5bf57 467 /*
caseyquinn 16:577cb22cec99 468 if (abs(gpslatitude) > 0 && abs(gpslongitude) > 0) {
caseyquinn 12:5b4f3245606a 469
caseyquinn 12:5b4f3245606a 470 if(gpslat == 'S')
caseyquinn 12:5b4f3245606a 471 {
caseyquinn 12:5b4f3245606a 472 flat = convertDegMinToDecDeg (gpslatitude) * -1;
caseyquinn 12:5b4f3245606a 473 }
caseyquinn 12:5b4f3245606a 474 else
caseyquinn 12:5b4f3245606a 475 {
caseyquinn 12:5b4f3245606a 476 flat = convertDegMinToDecDeg (gpslatitude);
caseyquinn 12:5b4f3245606a 477 }
caseyquinn 12:5b4f3245606a 478
caseyquinn 12:5b4f3245606a 479 if(gpslon == 'W')
caseyquinn 12:5b4f3245606a 480 {
caseyquinn 12:5b4f3245606a 481 flon = convertDegMinToDecDeg (gpslongitude) * -1;
caseyquinn 12:5b4f3245606a 482 }
caseyquinn 12:5b4f3245606a 483 else
caseyquinn 12:5b4f3245606a 484 {
caseyquinn 12:5b4f3245606a 485 flon = convertDegMinToDecDeg (gpslongitude);
caseyquinn 12:5b4f3245606a 486 }
caseyquinn 12:5b4f3245606a 487
caseyquinn 12:5b4f3245606a 488 workDistance = GPSdistanceCalc (work_lat, work_lon);
caseyquinn 12:5b4f3245606a 489 homeDistance = GPSdistanceCalc (home_lat, home_lon);
caseyquinn 12:5b4f3245606a 490 }
caseyquinn 12:5b4f3245606a 491
caseyquinn 12:5b4f3245606a 492 if (homeDistance == 99999 && workDistance == 99999) {
caseyquinn 12:5b4f3245606a 493 // digitalWrite (work_yellow_led, HIGH);
caseyquinn 12:5b4f3245606a 494 // digitalWrite (home_green_led, HIGH);
caseyquinn 12:5b4f3245606a 495 // digitalWrite (travel_red_led, HIGH);
caseyquinn 12:5b4f3245606a 496 location = 0;
caseyquinn 12:5b4f3245606a 497 }
caseyquinn 12:5b4f3245606a 498
caseyquinn 12:5b4f3245606a 499 else if (workDistance < 30) {
caseyquinn 12:5b4f3245606a 500 // digitalWrite (work_yellow_led, HIGH);
caseyquinn 12:5b4f3245606a 501 // digitalWrite (home_green_led, LOW);
caseyquinn 12:5b4f3245606a 502 // digitalWrite (travel_red_led, LOW);
caseyquinn 12:5b4f3245606a 503 location = 1;
caseyquinn 12:5b4f3245606a 504 }
caseyquinn 12:5b4f3245606a 505
caseyquinn 12:5b4f3245606a 506 else if (homeDistance < 20) {
caseyquinn 12:5b4f3245606a 507 // digitalWrite (work_yellow_led, LOW);
caseyquinn 12:5b4f3245606a 508 // digitalWrite (home_green_led, HIGH);
caseyquinn 12:5b4f3245606a 509 // digitalWrite (travel_red_led, LOW);
caseyquinn 12:5b4f3245606a 510 location = 2;
caseyquinn 12:5b4f3245606a 511 }
caseyquinn 12:5b4f3245606a 512
caseyquinn 12:5b4f3245606a 513 else {
caseyquinn 12:5b4f3245606a 514 // digitalWrite (work_yellow_led, LOW);
caseyquinn 12:5b4f3245606a 515 // digitalWrite (home_green_led, LOW);
caseyquinn 12:5b4f3245606a 516 // digitalWrite (travel_red_led, HIGH);
caseyquinn 12:5b4f3245606a 517 location = 3;
caseyquinn 12:5b4f3245606a 518 }
caseyquinn 21:bb10efc5bf57 519
caseyquinn 23:1ca41779b8ec 520
caseyquinn 17:3e6dda6e6335 521 }
caseyquinn 23:1ca41779b8ec 522 */
caseyquinn 21:bb10efc5bf57 523
caseyquinn 7:29b01d5812ee 524 FILE *fp = fopen(filename, "a");
caseyquinn 21:bb10efc5bf57 525 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 526 fprintf(fp, "%s,", timestr);
caseyquinn 7:29b01d5812ee 527 fprintf(fp, "%1.3f,%1.3f,%2.2f,%4.2f,%2.1f,%1.3f,", omronVolt,massflow,temp,press,rh,atmoRho);
caseyquinn 7:29b01d5812ee 528 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 529 fprintf(fp, "%.1f,%.1f,%.1f,%.3f,%.3f,%.3f,%.1f,", angle_x,angle_y,angle_z,mag_x, mag_y, mag_z,compass);
caseyquinn 7:29b01d5812ee 530 fprintf(fp, "%d,%d,%d,%d,%d,%d," ,uv,omronReading, vInReading, vBlowerReading, omronDiff,gasG.getAmps());
caseyquinn 16:577cb22cec99 531 fprintf(fp, "%d,%d,%d,%1.3f,%1.3f,", gasG.getVolts(), gasG.getCharge(),digital_pot_set, deltaMflow, deltaVflow);
caseyquinn 23:1ca41779b8ec 532 fprintf(fp, "%f,%f,%06d,%06d,%f,%d,%f,%d,%f\r\n", gps.lat, gps.lon, (long)gps.date, (long)gps.utc, gpsspeed, gpssatellites, gpsaltitude, gpsFix, gps.hdop); // test and add in speed, etc that Josh added in to match the adafruit GPS
caseyquinn 7:29b01d5812ee 533 fclose(fp);
caseyquinn 7:29b01d5812ee 534 free(fp);
caseyquinn 14:7cdb643da356 535 RGB_LED.set_led(0,1,0);
caseyquinn 14:7cdb643da356 536
caseyquinn 12:5b4f3245606a 537
caseyquinn 12:5b4f3245606a 538 pc.printf("%s,", timestr);
caseyquinn 12:5b4f3245606a 539
jelord 3:122bfc998c4c 540
jelord 3:122bfc998c4c 541 }
caseyquinn 8:c4a8f9b67cee 542
caseyquinn 9:8646fd501832 543 //////////////////////////////////////////////////////////////
caseyquinn 9:8646fd501832 544 //Flow Control Function
caseyquinn 9:8646fd501832 545 //////////////////////////////////////////////////////////////
caseyquinn 8:c4a8f9b67cee 546 void flowControl()
caseyquinn 8:c4a8f9b67cee 547 {
caseyquinn 12:5b4f3245606a 548 /*
caseyquinn 8:c4a8f9b67cee 549 RGB_LED.set_led(0,1,0);
caseyquinn 8:c4a8f9b67cee 550 omronReading = ads.readADC_SingleEnded(0, 0xC583); // read channel 0 PGA = 2 : Full Scale Range = 2.048V
caseyquinn 8:c4a8f9b67cee 551 omronVolt = (omronReading*4.096)/(32768*2);
caseyquinn 8:c4a8f9b67cee 552
caseyquinn 8:c4a8f9b67cee 553 if(omronVolt<=calibrations.omronVMin) {
caseyquinn 8:c4a8f9b67cee 554 massflow = calibrations.omronMFMin;
caseyquinn 8:c4a8f9b67cee 555 } else if(omronVolt>=calibrations.omronVMax) {
caseyquinn 8:c4a8f9b67cee 556 massflow = calibrations.omronMFMax;
caseyquinn 8:c4a8f9b67cee 557 } else {
caseyquinn 8:c4a8f9b67cee 558 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 559 }
caseyquinn 8:c4a8f9b67cee 560
caseyquinn 8:c4a8f9b67cee 561 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 562 volflow = massflow/atmoRho;
caseyquinn 8:c4a8f9b67cee 563 sampledVol = sampledVol + ((((float)logInerval)/60.0)*volflow);
caseyquinn 8:c4a8f9b67cee 564 deltaVflow = volflow-volflowSet;
caseyquinn 8:c4a8f9b67cee 565 massflowSet = volflowSet*atmoRho;
caseyquinn 8:c4a8f9b67cee 566 deltaMflow = massflow-massflowSet;
caseyquinn 12:5b4f3245606a 567
caseyquinn 8:c4a8f9b67cee 568 if(abs(deltaMflow)>.025) {
caseyquinn 8:c4a8f9b67cee 569 digital_pot_change = (int)(gainFlow*deltaMflow);
caseyquinn 8:c4a8f9b67cee 570
caseyquinn 8:c4a8f9b67cee 571
caseyquinn 12:5b4f3245606a 572 if(abs(digital_pot_change)>=10) {
caseyquinn 12:5b4f3245606a 573 digital_pot_set = (int)(digital_pot_set+ (int)(1*deltaMflow));
caseyquinn 12:5b4f3245606a 574 RGB_LED.set_led(1,0,0);
caseyquinn 12:5b4f3245606a 575 } else {
caseyquinn 8:c4a8f9b67cee 576 digital_pot_set = (digital_pot_set+ digital_pot_change);
caseyquinn 12:5b4f3245606a 577 RGB_LED.set_led(1,1,0);
caseyquinn 8:c4a8f9b67cee 578 }
caseyquinn 8:c4a8f9b67cee 579
caseyquinn 12:5b4f3245606a 580 if(digital_pot_set>=digitalpotMax) {
caseyquinn 12:5b4f3245606a 581 digital_pot_set = digitalpotMax;
caseyquinn 12:5b4f3245606a 582 RGB_LED.set_led(1,0,0);
caseyquinn 12:5b4f3245606a 583 } else if(digital_pot_set<=digitalpotMin) {
caseyquinn 12:5b4f3245606a 584 digital_pot_set = digitalpotMin;
caseyquinn 12:5b4f3245606a 585 RGB_LED.set_led(1,0,0);
caseyquinn 12:5b4f3245606a 586 }
caseyquinn 8:c4a8f9b67cee 587
caseyquinn 8:c4a8f9b67cee 588 DigPot.writeRegister(digital_pot_set);
caseyquinn 12:5b4f3245606a 589
caseyquinn 8:c4a8f9b67cee 590 } else {
caseyquinn 12:5b4f3245606a 591 RGB_LED.set_led(0,1,0);
caseyquinn 8:c4a8f9b67cee 592 }
caseyquinn 12:5b4f3245606a 593
caseyquinn 12:5b4f3245606a 594 */
caseyquinn 8:c4a8f9b67cee 595 }
caseyquinn 9:8646fd501832 596 //////////////////////////////////////////////////////////////
caseyquinn 9:8646fd501832 597 //Main Function
caseyquinn 9:8646fd501832 598 //////////////////////////////////////////////////////////////
jelord 1:9fbb5b665068 599 int main(){
caseyquinn 23:1ca41779b8ec 600
caseyquinn 23:1ca41779b8ec 601 RGB_LED.set_led(0,0,1);
caseyquinn 14:7cdb643da356 602
caseyquinn 23:1ca41779b8ec 603 /*
jelord 20:30a00cd18e21 604 //CODE ADDED TO TEST EEPROM
jelord 20:30a00cd18e21 605 //////////////////////////////////////////
caseyquinn 21:bb10efc5bf57 606 uint8_t serialNumWriter [2] = {0x00,0x12};
jelord 20:30a00cd18e21 607 uint8_t putDataInMe[2] = {0x02,0x00};
jelord 20:30a00cd18e21 608 E2PROM.write(0x00034,serialNumWriter,2);
jelord 20:30a00cd18e21 609 wait(.5);
jelord 20:30a00cd18e21 610 E2PROM.read(0x00034,putDataInMe,2);
jelord 20:30a00cd18e21 611 if(putDataInMe[0] == 0x02)pumps=1;
jelord 20:30a00cd18e21 612 //////////////////////////////////////////
jelord 20:30a00cd18e21 613 //END CODE ADDED TO TEST EEPROM
caseyquinn 23:1ca41779b8ec 614
caseyquinn 14:7cdb643da356 615 RGB_LED.set_led(0,0,1);
caseyquinn 14:7cdb643da356 616 STtime.tm_sec = 10; // 0-59
caseyquinn 15:e564c8031c47 617 STtime.tm_min = 30; // 0-59
caseyquinn 19:b835bfb61e35 618 STtime.tm_hour = 13; // 0-23
caseyquinn 19:b835bfb61e35 619 STtime.tm_mday = 24; // 1-31
caseyquinn 15:e564c8031c47 620 STtime.tm_mon = 2; // 0-11
caseyquinn 15:e564c8031c47 621 STtime.tm_year = 116; // year since 1900
caseyquinn 14:7cdb643da356 622 time_t seconds = mktime(&STtime);
caseyquinn 15:e564c8031c47 623 set_time(seconds); // Set RTC time to 16 December 2013 10:05:23 UTC
caseyquinn 14:7cdb643da356 624 wait(5);
caseyquinn 7:29b01d5812ee 625
caseyquinn 23:1ca41779b8ec 626 */
caseyquinn 21:bb10efc5bf57 627
caseyquinn 16:577cb22cec99 628 motor1.getFault();
caseyquinn 23:1ca41779b8ec 629 wait(1);
caseyquinn 16:577cb22cec99 630 RGB_LED.set_led(0,0,0);
caseyquinn 16:577cb22cec99 631 motor2.getFault();
caseyquinn 23:1ca41779b8ec 632 wait(1);
caseyquinn 23:1ca41779b8ec 633 RGB_LED.set_led(0,1,0);
caseyquinn 21:bb10efc5bf57 634
caseyquinn 16:577cb22cec99 635 motor3.getFault();
caseyquinn 23:1ca41779b8ec 636 wait(1);
caseyquinn 16:577cb22cec99 637 RGB_LED.set_led(0,0,0);
caseyquinn 21:bb10efc5bf57 638
caseyquinn 16:577cb22cec99 639 motor4.getFault();
caseyquinn 23:1ca41779b8ec 640 wait(1);
caseyquinn 23:1ca41779b8ec 641 RGB_LED.set_led(0,1,0);
caseyquinn 16:577cb22cec99 642
caseyquinn 23:1ca41779b8ec 643 /*
caseyquinn 16:577cb22cec99 644 RGB_LED.set_led(1,0,0);
caseyquinn 12:5b4f3245606a 645 motor1.drive(254); //closed = 253, open = 254
caseyquinn 16:577cb22cec99 646 wait(10);
caseyquinn 12:5b4f3245606a 647 motor1.stop();
caseyquinn 16:577cb22cec99 648 RGB_LED.set_led(0,0,0);
caseyquinn 16:577cb22cec99 649
caseyquinn 16:577cb22cec99 650
caseyquinn 16:577cb22cec99 651 motor2.drive(254); //closed = 253, open = 254
caseyquinn 16:577cb22cec99 652 wait(10);
caseyquinn 12:5b4f3245606a 653 motor2.stop();
caseyquinn 16:577cb22cec99 654 RGB_LED.set_led(1,0,0);
caseyquinn 16:577cb22cec99 655
caseyquinn 16:577cb22cec99 656 motor3.drive(254); //closed = 253, open = 254
caseyquinn 16:577cb22cec99 657 wait(10);
caseyquinn 12:5b4f3245606a 658 motor3.stop();
caseyquinn 16:577cb22cec99 659 RGB_LED.set_led(0,0,0);
caseyquinn 16:577cb22cec99 660
caseyquinn 16:577cb22cec99 661
caseyquinn 16:577cb22cec99 662 motor4.drive(254); //closed = 253, open = 254
caseyquinn 16:577cb22cec99 663 wait(10);
caseyquinn 12:5b4f3245606a 664 motor4.stop();
caseyquinn 16:577cb22cec99 665 RGB_LED.set_led(0,0,1);
caseyquinn 16:577cb22cec99 666
caseyquinn 17:3e6dda6e6335 667 */
caseyquinn 13:455601f62aad 668
caseyquinn 23:1ca41779b8ec 669 motor1.drive(254); //closed = 253, open = 254
caseyquinn 23:1ca41779b8ec 670 motor2.drive(254); //closed = 253, open = 254
caseyquinn 23:1ca41779b8ec 671 motor3.drive(254); //closed = 253, open = 254
caseyquinn 23:1ca41779b8ec 672 motor4.drive(254); //closed = 253, open = 254
caseyquinn 23:1ca41779b8ec 673
caseyquinn 23:1ca41779b8ec 674
caseyquinn 23:1ca41779b8ec 675 wait(10);
caseyquinn 23:1ca41779b8ec 676 motor1.stop();
caseyquinn 23:1ca41779b8ec 677 motor2.stop();
caseyquinn 23:1ca41779b8ec 678 motor3.stop();
caseyquinn 23:1ca41779b8ec 679 motor4.stop();
caseyquinn 23:1ca41779b8ec 680
caseyquinn 23:1ca41779b8ec 681
caseyquinn 23:1ca41779b8ec 682 gpsEN = 1;
caseyquinn 23:1ca41779b8ec 683 wait(1);
caseyquinn 23:1ca41779b8ec 684 BT_SW = 1;
caseyquinn 23:1ca41779b8ec 685 wait(1);
caseyquinn 23:1ca41779b8ec 686 BT_IRST = 1;
caseyquinn 23:1ca41779b8ec 687 wait(1);
caseyquinn 23:1ca41779b8ec 688
caseyquinn 12:5b4f3245606a 689
caseyquinn 10:06fbb1c9e3bd 690 pc.baud(115200); // set what you want here depending on your terminal program speed
caseyquinn 10:06fbb1c9e3bd 691 pc.printf("\f\n\r-------------Startup-------------\n\r");
jelord 1:9fbb5b665068 692 wait(0.5);
caseyquinn 5:c3252e5d45ca 693
caseyquinn 12:5b4f3245606a 694
jelord 20:30a00cd18e21 695 uint8_t serialNumberAndType[6] = {0x50,0x53,};
caseyquinn 13:455601f62aad 696
jelord 3:122bfc998c4c 697 E2PROM.read(0x00034,serialNumberAndType+2,2);
caseyquinn 4:5d004fd997d5 698
jelord 3:122bfc998c4c 699 int tempSerialNum = serialNumberAndType[2]+serialNumberAndType[3];
jelord 3:122bfc998c4c 700 int serialNumDigits[4];
jelord 3:122bfc998c4c 701 serialNumDigits[0] = tempSerialNum / 1000 % 10;
jelord 3:122bfc998c4c 702 serialNumDigits[1] = tempSerialNum / 100 % 10;
jelord 3:122bfc998c4c 703 serialNumDigits[2] = tempSerialNum / 10 % 10;
jelord 3:122bfc998c4c 704 serialNumDigits[3] = tempSerialNum % 10;
jelord 3:122bfc998c4c 705
jelord 3:122bfc998c4c 706 serialNumberAndType[2] = serialNumDigits[0]+48;
jelord 3:122bfc998c4c 707 serialNumberAndType[3] = serialNumDigits[1]+48;
jelord 3:122bfc998c4c 708 serialNumberAndType[4] = serialNumDigits[2]+48;
jelord 3:122bfc998c4c 709 serialNumberAndType[5] = serialNumDigits[3]+48;
caseyquinn 12:5b4f3245606a 710
caseyquinn 5:c3252e5d45ca 711 RGB_LED.set_led(0,1,0);
caseyquinn 13:455601f62aad 712
caseyquinn 10:06fbb1c9e3bd 713 pc.attach(pc_recv);
jelord 1:9fbb5b665068 714 microChannel.attach(uartMicro,microChannel.RxIrq);
jelord 3:122bfc998c4c 715 microChannel.baud(115200);
jelord 1:9fbb5b665068 716 microChannel.printf("$$$");
jelord 3:122bfc998c4c 717 wait(0.5);
jelord 3:122bfc998c4c 718 microChannel.printf("SN,");
jelord 3:122bfc998c4c 719 for(int i=0;i<6;i++)microChannel.putc(serialNumberAndType[i]);
jelord 3:122bfc998c4c 720 microChannel.printf("\r");
jelord 3:122bfc998c4c 721 wait(0.5);
jelord 1:9fbb5b665068 722 microChannel.printf("A\r");
jelord 3:122bfc998c4c 723 wait(0.5);
jelord 2:88fcbfadec6a 724 microChannel.printf("---\r");
jelord 3:122bfc998c4c 725 wait(0.5);
jelord 2:88fcbfadec6a 726
caseyquinn 18:41ef98db0423 727 RGB_LED.set_led(1,1,1);
jelord 3:122bfc998c4c 728 while(runReady!=1) {
jelord 3:122bfc998c4c 729 wait(1);
caseyquinn 11:aa21628a9b15 730 pc.printf("Waiting for BLE instruction");
jelord 3:122bfc998c4c 731
jelord 3:122bfc998c4c 732 }
jelord 3:122bfc998c4c 733
caseyquinn 14:7cdb643da356 734
jelord 3:122bfc998c4c 735 E2PROM.read(0x00015, startAndEndTime, 12); //Grab start and end times from EEPROM
jelord 3:122bfc998c4c 736 RGB_LED.set_led(0,1,0);
caseyquinn 14:7cdb643da356 737
caseyquinn 7:29b01d5812ee 738 //!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!
caseyquinn 7:29b01d5812ee 739 //UPDATE THIS TO WORK WITH ST RTC INSTEAD
caseyquinn 7:29b01d5812ee 740 //!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!
caseyquinn 14:7cdb643da356 741
caseyquinn 21:bb10efc5bf57 742 BT_SW = 0;
caseyquinn 21:bb10efc5bf57 743 wait(1);
caseyquinn 21:bb10efc5bf57 744 BT_IRST = 0;
caseyquinn 21:bb10efc5bf57 745 wait(1);
caseyquinn 21:bb10efc5bf57 746
jelord 3:122bfc998c4c 747 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 748 wait(0.5);
jelord 3:122bfc998c4c 749
jelord 3:122bfc998c4c 750 RTC_UPAS.get_time();
jelord 3:122bfc998c4c 751
jelord 3:122bfc998c4c 752 }
caseyquinn 14:7cdb643da356 753
caseyquinn 14:7cdb643da356 754
jelord 3:122bfc998c4c 755
jelord 3:122bfc998c4c 756 //Get the proper serial number
jelord 3:122bfc998c4c 757 uint8_t serialBytes[2] = {0,};
jelord 3:122bfc998c4c 758 E2PROM.read(0x00034, serialBytes,2);
jelord 3:122bfc998c4c 759 serial_num = ((uint16_t)serialBytes[1] << 8) | serialBytes[0];
jelord 3:122bfc998c4c 760 calibrations.initialize(serial_num);
jelord 3:122bfc998c4c 761
jelord 3:122bfc998c4c 762 uint8_t logByte[1] = {0,};
jelord 3:122bfc998c4c 763 E2PROM.read(0x00014,logByte,1);
jelord 3:122bfc998c4c 764 logInerval = logByte[0];
jelord 3:122bfc998c4c 765
jelord 3:122bfc998c4c 766 //Use the flow rate value stored in eeprom
jelord 3:122bfc998c4c 767 uint8_t flowRateBytes[4] = {0,};
jelord 3:122bfc998c4c 768 E2PROM.read(0x00010,flowRateBytes,4);
jelord 3:122bfc998c4c 769 E2PROM.byteToFloat(flowRateBytes, &volflowSet);
jelord 3:122bfc998c4c 770
jelord 3:122bfc998c4c 771 if(volflowSet<=1.0) {
jelord 3:122bfc998c4c 772 gainFlow = 100;
jelord 3:122bfc998c4c 773 } else if(volflowSet>=2.0) {
jelord 3:122bfc998c4c 774 gainFlow = 25;
jelord 3:122bfc998c4c 775 } else {
jelord 3:122bfc998c4c 776 gainFlow = 25;
jelord 0:2cb2b2ea316f 777 }
caseyquinn 17:3e6dda6e6335 778
jelord 3:122bfc998c4c 779 RGB_LED.set_led(1,0,0);
jelord 3:122bfc998c4c 780 press = bmesensor.getPressure();
jelord 3:122bfc998c4c 781 temp = bmesensor.getTemperature();
jelord 3:122bfc998c4c 782 rh = bmesensor.getHumidity();
jelord 3:122bfc998c4c 783
jelord 3:122bfc998c4c 784 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 785 massflowSet = volflowSet*atmoRho;
jelord 3:122bfc998c4c 786
jelord 3:122bfc998c4c 787 DigPot.writeRegister(digital_pot_setpoint);
jelord 3:122bfc998c4c 788 wait(1);
caseyquinn 23:1ca41779b8ec 789 //pumps = 1;
jelord 3:122bfc998c4c 790
jelord 3:122bfc998c4c 791 uint8_t subjectLabelOriginal[8] = {0,};
caseyquinn 4:5d004fd997d5 792 E2PROM.read(0x00001, subjectLabelOriginal,8);
caseyquinn 12:5b4f3245606a 793
caseyquinn 13:455601f62aad 794
caseyquinn 12:5b4f3245606a 795
caseyquinn 21:bb10efc5bf57 796 time_t seconds = time(NULL);
caseyquinn 4:5d004fd997d5 797 strftime(timestr, 32, "%y-%m-%d-%H=%M=%S", localtime(&seconds));
caseyquinn 13:455601f62aad 798
caseyquinn 9:8646fd501832 799 //sprintf(filename, "/sd/UPAS%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 800 //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 22:baa5a077d908 801 sprintf(filename, "/sd/UPAS_TboardtestLog_%s.txt", timestr);
jelord 3:122bfc998c4c 802 FILE *fp = fopen(filename, "w");
jelord 3:122bfc998c4c 803 fclose(fp);
jelord 3:122bfc998c4c 804
caseyquinn 14:7cdb643da356 805 /*
caseyquinn 12:5b4f3245606a 806 omronReading = ads.readADC_SingleEnded(0, 0xC583); // read channel 0 PGA = 2 : Full Scale Range = 2.048V
caseyquinn 12:5b4f3245606a 807 omronVolt = (omronReading*4.096)/(32768*2);
caseyquinn 12:5b4f3245606a 808 if(omronVolt<=calibrations.omronVMin) {
caseyquinn 12:5b4f3245606a 809 massflow = calibrations.omronMFMin;
caseyquinn 12:5b4f3245606a 810 } else if(omronVolt>=calibrations.omronVMax) {
caseyquinn 12:5b4f3245606a 811 massflow = calibrations.omronMFMax;
caseyquinn 12:5b4f3245606a 812 } else {
caseyquinn 12:5b4f3245606a 813 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 814 }
caseyquinn 12:5b4f3245606a 815 deltaMflow = massflow-massflowSet;
caseyquinn 12:5b4f3245606a 816 digital_pot_set = digital_pot_setpoint;
caseyquinn 12:5b4f3245606a 817 wait(5);
caseyquinn 12:5b4f3245606a 818
caseyquinn 12:5b4f3245606a 819 //---------------------------------------------------------------------------------------------//
caseyquinn 12:5b4f3245606a 820 //Sets the flow withen +-1.5% of the desired flow rate based on mass flow
caseyquinn 12:5b4f3245606a 821
caseyquinn 12:5b4f3245606a 822 while(abs(deltaMflow)>.025) {
caseyquinn 12:5b4f3245606a 823
caseyquinn 12:5b4f3245606a 824 omronReading = ads.readADC_SingleEnded(0, 0xC583); // read channel 0 PGA = 2 : Full Scale Range = 2.048V
caseyquinn 12:5b4f3245606a 825 omronVolt = (omronReading*4.096)/(32768*2);
caseyquinn 12:5b4f3245606a 826 //Mass Flow tf from file: UPAS v2 OSU-PrimaryFlowData FullSet 2015-05-29 CQ mods.xlsx
caseyquinn 12:5b4f3245606a 827 if(omronVolt<=calibrations.omronVMin) {
caseyquinn 12:5b4f3245606a 828 massflow = calibrations.omronMFMin;
caseyquinn 12:5b4f3245606a 829 } else if(omronVolt>=calibrations.omronVMax) {
caseyquinn 12:5b4f3245606a 830 massflow = calibrations.omronMFMax;
caseyquinn 12:5b4f3245606a 831 } else {
caseyquinn 12:5b4f3245606a 832 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 833 }
caseyquinn 12:5b4f3245606a 834
caseyquinn 12:5b4f3245606a 835 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 836 volflow = massflow/atmoRho;
caseyquinn 12:5b4f3245606a 837 massflowSet = volflowSet*atmoRho;
caseyquinn 12:5b4f3245606a 838 deltaMflow = massflow-massflowSet;
caseyquinn 12:5b4f3245606a 839
caseyquinn 12:5b4f3245606a 840 digital_pot_set = (int)(digital_pot_set+(int)((gainFlow*deltaMflow)));
caseyquinn 12:5b4f3245606a 841 if(digital_pot_set>=digitalpotMax) {
caseyquinn 12:5b4f3245606a 842 digital_pot_set = digitalpotMax;
caseyquinn 12:5b4f3245606a 843 } else if(digital_pot_set<=digitalpotMin) {
caseyquinn 12:5b4f3245606a 844 digital_pot_set = digitalpotMin;
caseyquinn 12:5b4f3245606a 845 }
caseyquinn 12:5b4f3245606a 846
caseyquinn 12:5b4f3245606a 847 wait(2);
caseyquinn 12:5b4f3245606a 848 DigPot.writeRegister(digital_pot_set);
caseyquinn 12:5b4f3245606a 849 pc.printf("%d,\r\n", digital_pot_set);
caseyquinn 12:5b4f3245606a 850 wait(1);
caseyquinn 12:5b4f3245606a 851
caseyquinn 12:5b4f3245606a 852
caseyquinn 12:5b4f3245606a 853 }
caseyquinn 14:7cdb643da356 854 */
jelord 3:122bfc998c4c 855 sampledVol = 0.0;
jelord 3:122bfc998c4c 856 RGB_LED.set_led(0,1,0);
caseyquinn 14:7cdb643da356 857
caseyquinn 18:41ef98db0423 858 stop.attach(&check_stop, 9); // check if we should shut down every 9 number seconds, starting after the start.
caseyquinn 14:7cdb643da356 859 logg.attach(&log_data, logInerval);
caseyquinn 12:5b4f3245606a 860 //flowCtl.attach(&flowControl, 1);
caseyquinn 7:29b01d5812ee 861
jelord 3:122bfc998c4c 862
jelord 3:122bfc998c4c 863 //** end of initalization **//
jelord 3:122bfc998c4c 864 //---------------------------------------------------------------------------------------------//
jelord 3:122bfc998c4c 865 //---------------------------------------------------------------------------------------------//
jelord 3:122bfc998c4c 866 // Main Control Loop
jelord 3:122bfc998c4c 867
caseyquinn 7:29b01d5812ee 868 while (1) {
caseyquinn 7:29b01d5812ee 869 // Do other things...
caseyquinn 14:7cdb643da356 870 /*
caseyquinn 18:41ef98db0423 871 pumps = 1;
caseyquinn 13:455601f62aad 872 wait(5);
caseyquinn 18:41ef98db0423 873 pumps = 0;
caseyquinn 13:455601f62aad 874 wait(5);
caseyquinn 14:7cdb643da356 875 */
caseyquinn 7:29b01d5812ee 876 }
caseyquinn 7:29b01d5812ee 877
caseyquinn 8:c4a8f9b67cee 878
caseyquinn 4:5d004fd997d5 879
jelord 3:122bfc998c4c 880
jelord 0:2cb2b2ea316f 881 }