scott kelleher / Outdoor_UPAS_v1_2_powerfunction

attempt to fix posible power issues with the sharp

Dependencies:   ADS1115 BME280 CronoDot SDFileSystem mbed

Fork of Outdoor_UPAS_v1_2_Tboard by scott kelleher

main.cpp@38:65ae9771f1e3, 2016-04-29 (annotated)

Committer:
jelord
Date:
Fri Apr 29 20:28:05 2016 +0000
Revision:
38:65ae9771f1e3
Parent:
37:6c2dca195871
Child:
39:f1ebecfb32ca
Child:
41:737f967d707c
now has code for bt duty cycle and cartridge id setting

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 36:2e344db70d35 81 DRV8830 schoolF1(PB_9, PB_8, 0xC4); //Work/School Filter A HB1
caseyquinn 36:2e344db70d35 82 DRV8830 homeF2(PB_9, PB_8, 0xCA); //Home Filter B HB2
caseyquinn 36:2e344db70d35 83 DRV8830 transitF3(PB_9, PB_8, 0xCC); //Transit Filter C HB3
caseyquinn 36:2e344db70d35 84 DRV8830 blankF4(PB_9, PB_8, 0xCE); //Blank Filter D HB4
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 36:2e344db70d35 116
caseyquinn 9:8646fd501832 117 float press;
caseyquinn 9:8646fd501832 118 float temp;
caseyquinn 9:8646fd501832 119 float rh;
jelord 3:122bfc998c4c 120
caseyquinn 9:8646fd501832 121 int uv;
caseyquinn 9:8646fd501832 122 int vis;
caseyquinn 9:8646fd501832 123 int ir;
jelord 3:122bfc998c4c 124
caseyquinn 9:8646fd501832 125 float compass;
caseyquinn 9:8646fd501832 126 float accel_x;
caseyquinn 9:8646fd501832 127 float accel_y;
caseyquinn 9:8646fd501832 128 float accel_z;
caseyquinn 9:8646fd501832 129 float accel_comp;
caseyquinn 9:8646fd501832 130 float angle_x;
caseyquinn 9:8646fd501832 131 float angle_y;
caseyquinn 9:8646fd501832 132 float angle_z;
caseyquinn 9:8646fd501832 133 float mag_x;
caseyquinn 9:8646fd501832 134 float mag_y;
caseyquinn 9:8646fd501832 135 float mag_z;
jelord 3:122bfc998c4c 136
caseyquinn 9:8646fd501832 137 int vInReading;
caseyquinn 25:fbf7d44e7da4 138 int vInReadingLast;
caseyquinn 9:8646fd501832 139 int vBlowerReading;
caseyquinn 9:8646fd501832 140 int omronDiff;
caseyquinn 9:8646fd501832 141 float omronVolt; //V
caseyquinn 9:8646fd501832 142 int omronReading;
caseyquinn 9:8646fd501832 143 float atmoRho; //g/L
jelord 3:122bfc998c4c 144
caseyquinn 25:fbf7d44e7da4 145 int amps;
caseyquinn 25:fbf7d44e7da4 146 int bVolt;
caseyquinn 25:fbf7d44e7da4 147 int bFuel;
caseyquinn 25:fbf7d44e7da4 148 //bool pumpOn;
caseyquinn 9:8646fd501832 149 float massflow; //g/min
caseyquinn 9:8646fd501832 150 float volflow; //L/min
jelord 3:122bfc998c4c 151 float volflowSet = 1.0; //L/min
caseyquinn 14:7cdb643da356 152 int logInerval = 5;//seconds
jelord 3:122bfc998c4c 153 double secondsD = 0;
jelord 3:122bfc998c4c 154 double lastsecondD = 0;
caseyquinn 9:8646fd501832 155 float massflowSet;
jelord 3:122bfc998c4c 156 float deltaVflow = 0.0;
jelord 3:122bfc998c4c 157 float deltaMflow = 0.0;
caseyquinn 9:8646fd501832 158 float gainFlow;
caseyquinn 9:8646fd501832 159 float sampledVol; //L, total sampled volume
jelord 3:122bfc998c4c 160
caseyquinn 29:fd74725294d5 161 int digital_pot_setpoint = 30; //min = 0x7F, max = 0x00
caseyquinn 9:8646fd501832 162 int digital_pot_set;
caseyquinn 9:8646fd501832 163 int digital_pot_change;
jelord 3:122bfc998c4c 164 int digitalpotMax = 127;
caseyquinn 9:8646fd501832 165 int digitalpotMin = 10;
jelord 3:122bfc998c4c 166
caseyquinn 12:5b4f3245606a 167 int dutyUp;
caseyquinn 12:5b4f3245606a 168 int dutyDown;
caseyquinn 12:5b4f3245606a 169
caseyquinn 23:1ca41779b8ec 170 bool gpsFix;
caseyquinn 12:5b4f3245606a 171 uint8_t gpssatellites = 0;
caseyquinn 23:1ca41779b8ec 172 double gpsspeed = 0.0;
caseyquinn 28:42932d3b105d 173 double gpscourse = 0.0;
caseyquinn 23:1ca41779b8ec 174 double gpslatitude = 0.0;
caseyquinn 23:1ca41779b8ec 175 double gpslongitude = 0.0;
caseyquinn 23:1ca41779b8ec 176 float gpsaltitude = 0.0;
caseyquinn 12:5b4f3245606a 177
caseyquinn 26:6aa294d83af4 178 float home_lat = 40.00000; //40.580508;
caseyquinn 26:6aa294d83af4 179 float home_lon = -105.000000; //-105.081823;
caseyquinn 36:2e344db70d35 180 float home_lat2 = 40.00000; //40.580508;
caseyquinn 36:2e344db70d35 181 float home_lon2 = -105.000000; //-105.081823;
caseyquinn 26:6aa294d83af4 182 float work_lat = 40.100000; //40.594062; //40.569136;
caseyquinn 26:6aa294d83af4 183 float work_lon = -105.100000; //-105.075683; //-105.081966;
caseyquinn 12:5b4f3245606a 184 int location = 0;
caseyquinn 12:5b4f3245606a 185
caseyquinn 12:5b4f3245606a 186 float homeDistance = 99999;
caseyquinn 36:2e344db70d35 187 float home2Distance = 99999;
caseyquinn 12:5b4f3245606a 188 float workDistance = 99999;
caseyquinn 12:5b4f3245606a 189
jelord 3:122bfc998c4c 190 //*************************************************//
jelord 3:122bfc998c4c 191
jelord 2:88fcbfadec6a 192 void sendData();
caseyquinn 11:aa21628a9b15 193
caseyquinn 11:aa21628a9b15 194
caseyquinn 11:aa21628a9b15 195 void pc_recv(){
caseyquinn 11:aa21628a9b15 196 while(pc.readable()){
caseyquinn 11:aa21628a9b15 197 pc.getc();
caseyquinn 11:aa21628a9b15 198 }
caseyquinn 11:aa21628a9b15 199 }
caseyquinn 11:aa21628a9b15 200
jelord 0:2cb2b2ea316f 201 static uint8_t rx_buf[20];
jelord 0:2cb2b2ea316f 202 static uint8_t rx_len=0;
jelord 1:9fbb5b665068 203 static int haltBLE = 1;
jelord 1:9fbb5b665068 204 static int transmissionValue = 0;
jelord 2:88fcbfadec6a 205 uint8_t writeData[20] = {0,};
jelord 2:88fcbfadec6a 206 static uint8_t dataLength = 0;
jelord 3:122bfc998c4c 207 static int runReady = 0;
jelord 3:122bfc998c4c 208 static uint8_t startAndEndTime[12] = {0,};
caseyquinn 5:c3252e5d45ca 209
caseyquinn 9:8646fd501832 210 //////////////////////////////////////////////////////////////
caseyquinn 9:8646fd501832 211 //BLE Functions
caseyquinn 9:8646fd501832 212 //////////////////////////////////////////////////////////////
caseyquinn 9:8646fd501832 213
caseyquinn 9:8646fd501832 214 void uartMicro(){
caseyquinn 25:fbf7d44e7da4 215
jelord 3:122bfc998c4c 216 if(runReady!=1){
jelord 3:122bfc998c4c 217 haltBLE = 2;
jelord 3:122bfc998c4c 218 while(microChannel.readable()){
jelord 3:122bfc998c4c 219 rx_buf[rx_len++] = microChannel.getc();
jelord 2:88fcbfadec6a 220
jelord 3:122bfc998c4c 221 //Code block to verify what is being transmitted. To function correctly, all data must terminate with \0 or \n
jelord 3:122bfc998c4c 222 if(transmissionValue==0){
jelord 3:122bfc998c4c 223
caseyquinn 4:5d004fd997d5 224 if (rx_buf[0] == 0x01)transmissionValue = 1; //rtc
jelord 3:122bfc998c4c 225 else if(rx_buf[0] == 0x02)transmissionValue = 2; //sample start and end times
jelord 3:122bfc998c4c 226 else if(rx_buf[0] == 0x03)transmissionValue = 3; //sample name
jelord 3:122bfc998c4c 227 else if(rx_buf[0] == 0x04)transmissionValue = 4; //Send Data Check
jelord 3:122bfc998c4c 228
jelord 3:122bfc998c4c 229 else if(rx_buf[0] == 0x05)transmissionValue = 5; //log interval
jelord 3:122bfc998c4c 230 else if(rx_buf[0] == 0x06)transmissionValue = 6; //Flow Rate
jelord 3:122bfc998c4c 231 else if(rx_buf[0] == 0x07)transmissionValue = 7; //Serial Number
jelord 3:122bfc998c4c 232 else if(rx_buf[0] == 0x08)transmissionValue = 8; //Run Enable
caseyquinn 25:fbf7d44e7da4 233 else if(rx_buf[0] == 0x0A)transmissionValue = 10; //GPS Coordinates
jelord 33:03d0e7f5ef0a 234 else if(rx_buf[0] == 0x0B)transmissionValue = 11; //GPS Coordinates (Second Set)
jelord 38:65ae9771f1e3 235 else if(rx_buf[0] == 0x0C)transmissionValue = 12; //Cartridge ID
jelord 38:65ae9771f1e3 236 else if(rx_buf[0] == 0x0D)transmissionValue = 13; //Duty Cycle
jelord 38:65ae9771f1e3 237 //else if (rx_buf[0] == 0x0F)transmissionValue = 15; //BT TRANSFER TEST
caseyquinn 25:fbf7d44e7da4 238 //else if(rx_buf[0] == 0x30)RGB_LED.set_led(1,0,0);
jelord 3:122bfc998c4c 239 else transmissionValue = 100; //Not useful data
jelord 3:122bfc998c4c 240 }
jelord 3:122bfc998c4c 241
jelord 38:65ae9771f1e3 242 if(rx_buf[rx_len-1]=='\0' || rx_buf[rx_len-1]=='\n' || rx_buf[rx_len-1] == 0xff || transmissionValue==15){
jelord 3:122bfc998c4c 243 if((transmissionValue == 1 || transmissionValue == 2 || transmissionValue == 3 || transmissionValue == 4 || transmissionValue == 5 ||
jelord 38:65ae9771f1e3 244 transmissionValue == 6 || transmissionValue == 7 || transmissionValue ==10 || transmissionValue ==11 || transmissionValue ==12) && rx_buf[rx_len-1] != 0xff)
jelord 3:122bfc998c4c 245 {}else{
caseyquinn 21:bb10efc5bf57 246 if(transmissionValue == 4 ) sendData();
jelord 38:65ae9771f1e3 247 //if(transmissionValue == 15) sdReader.read_file(fileTest,0);
jelord 3:122bfc998c4c 248 if(transmissionValue == 8){
jelord 3:122bfc998c4c 249 runReady = 1;
jelord 3:122bfc998c4c 250 microChannel.attach(NULL,microChannel.RxIrq);
jelord 3:122bfc998c4c 251 }
jelord 3:122bfc998c4c 252 haltBLE = 1;
jelord 3:122bfc998c4c 253 transmissionValue = 0;
jelord 3:122bfc998c4c 254 dataLength = 0;
caseyquinn 25:fbf7d44e7da4 255 //if(fileWrite == 1){
caseyquinn 25:fbf7d44e7da4 256 //FILE *fp = fopen(gpsConfigFilename, "a");
caseyquinn 25:fbf7d44e7da4 257 //fprintf(fp,"HELLO");
caseyquinn 25:fbf7d44e7da4 258 //fclose(fp);
caseyquinn 25:fbf7d44e7da4 259 //free(fp);
caseyquinn 25:fbf7d44e7da4 260 //fileWrite=0;
caseyquinn 25:fbf7d44e7da4 261 //}
jelord 3:122bfc998c4c 262 }
jelord 2:88fcbfadec6a 263 }
jelord 1:9fbb5b665068 264 }
caseyquinn 12:5b4f3245606a 265
jelord 3:122bfc998c4c 266 if(haltBLE!=1){
jelord 2:88fcbfadec6a 267
jelord 3:122bfc998c4c 268 if((transmissionValue!=100) && (dataLength!= 0)) writeData[dataLength-1] = rx_buf[0];
jelord 3:122bfc998c4c 269
jelord 3:122bfc998c4c 270 if(transmissionValue ==100){
caseyquinn 10:06fbb1c9e3bd 271 pc.putc(rx_buf[0]);
jelord 2:88fcbfadec6a 272
jelord 3:122bfc998c4c 273 }else if(transmissionValue ==1){ //process and store RTC values
jelord 3:122bfc998c4c 274
caseyquinn 7:29b01d5812ee 275 //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 276 if(dataLength==6){
caseyquinn 17:3e6dda6e6335 277 RTC_UPAS.set_time(writeData[0],writeData[1],writeData[2],writeData[3],writeData[3],writeData[4],writeData[5]);//sets chronodot RTC
caseyquinn 12:5b4f3245606a 278 ///////////////////////
caseyquinn 7:29b01d5812ee 279 //sets ST RTC
caseyquinn 12:5b4f3245606a 280 //////////////////////
caseyquinn 7:29b01d5812ee 281 STtime.tm_sec = writeData[0]; // 0-59
caseyquinn 7:29b01d5812ee 282 STtime.tm_min = writeData[1]; // 0-59
caseyquinn 7:29b01d5812ee 283 STtime.tm_hour = writeData[2]; // 0-23
caseyquinn 7:29b01d5812ee 284 STtime.tm_mday = writeData[3]; // 1-31
caseyquinn 7:29b01d5812ee 285 STtime.tm_mon = writeData[4]-1; // 0-11
caseyquinn 7:29b01d5812ee 286 STtime.tm_year = 100+writeData[5]; // year since 1900 (116 = 2016)
caseyquinn 7:29b01d5812ee 287 time_t STseconds = mktime(&STtime);
caseyquinn 12:5b4f3245606a 288 set_time(STseconds); // Set RTC time
caseyquinn 7:29b01d5812ee 289 }
jelord 3:122bfc998c4c 290
caseyquinn 12:5b4f3245606a 291 }
caseyquinn 14:7cdb643da356 292 else if(transmissionValue ==2){ //process and store sample start/end
jelord 3:122bfc998c4c 293 if(dataLength ==12)E2PROM.write(0x00015, writeData, 12);
jelord 3:122bfc998c4c 294
jelord 3:122bfc998c4c 295 }else if(transmissionValue ==3){ //process and store sample name
jelord 3:122bfc998c4c 296 if(dataLength ==8)E2PROM.write(0x00001,writeData,8);
jelord 3:122bfc998c4c 297
jelord 3:122bfc998c4c 298 }else if(transmissionValue ==5){ //process and store Log Interval
jelord 3:122bfc998c4c 299 if(dataLength ==1)E2PROM.write(0x00014,writeData,1);
jelord 2:88fcbfadec6a 300
jelord 3:122bfc998c4c 301 }else if(transmissionValue ==6){ //process and store Flow Rate
jelord 3:122bfc998c4c 302 if(dataLength ==4)E2PROM.write(0x00010,writeData,4);
jelord 3:122bfc998c4c 303
jelord 3:122bfc998c4c 304 }else if(transmissionValue ==7){ //process and store Serial Number
jelord 3:122bfc998c4c 305 if(dataLength ==2)E2PROM.write(0x00034,writeData,2);
caseyquinn 25:fbf7d44e7da4 306 }else if (transmissionValue == 10){
caseyquinn 25:fbf7d44e7da4 307 if(dataLength == 16)E2PROM.write(0x00050,writeData,16);
jelord 33:03d0e7f5ef0a 308 }else if (transmissionValue == 11){
jelord 33:03d0e7f5ef0a 309 if(dataLength == 8)E2PROM.write(0x00060,writeData,8);
jelord 38:65ae9771f1e3 310 }else if (transmissionValue == 12){
jelord 38:65ae9771f1e3 311 if(dataLength == 3)E2PROM.write(0x00070,writeData,3);
jelord 38:65ae9771f1e3 312 }else if (transmissionValue == 13){
jelord 38:65ae9771f1e3 313 if(dataLength == 3)E2PROM.write(0x00076,writeData,3);
jelord 3:122bfc998c4c 314 }
caseyquinn 25:fbf7d44e7da4 315
jelord 3:122bfc998c4c 316 dataLength++;
jelord 1:9fbb5b665068 317 }
jelord 3:122bfc998c4c 318
jelord 3:122bfc998c4c 319 rx_len = 0;
jelord 3:122bfc998c4c 320 }else{
jelord 3:122bfc998c4c 321 while(microChannel.readable())
jelord 3:122bfc998c4c 322 uint8_t extract = microChannel.getc();
jelord 3:122bfc998c4c 323 }
jelord 2:88fcbfadec6a 324
caseyquinn 12:5b4f3245606a 325
jelord 2:88fcbfadec6a 326 }
caseyquinn 14:7cdb643da356 327
jelord 2:88fcbfadec6a 328 void sendData(){
jelord 2:88fcbfadec6a 329
caseyquinn 27:922f53fa649c 330 //First byte is designator for the App
caseyquinn 21:bb10efc5bf57 331 uint8_t sampleTimePassValues[13] = {0x01,0x00,0x00,0x0A,0x01,0x01,0x10,0x00,0x00,0x0A,0x01,0x01,0x10};
caseyquinn 21:bb10efc5bf57 332 uint8_t subjectLabelOriginal[9] = {0x02,0x52,0x45,0x53,0x45,0x54,0x5F,0x5F,0x5f};
caseyquinn 21:bb10efc5bf57 333 uint8_t dataLogOriginal[2] = {0x03,0x0A,};
caseyquinn 21:bb10efc5bf57 334 uint8_t flowRateOriginal[5] = {0x04,0x00,0x00,0x80,0x3F};
caseyquinn 29:fd74725294d5 335 uint8_t serialBytes[3] = {0x07,0x00,0x00};
caseyquinn 25:fbf7d44e7da4 336 uint8_t latLongSchoolOriginal[17] = {0x0A,0x00,0x00,0x80,0x3F,0x00,0x00,0x80,0x3F,0x00,0x00,0x80,0x3F,0x00,0x00,0x80,0x3F};
jelord 33:03d0e7f5ef0a 337 uint8_t latLongHome2[9] = {0x0B,0x00,0x00,0x80,0x3F,0x00,0x00,0x80,0x3F};
jelord 38:65ae9771f1e3 338 uint8_t cartridgeIDOriginal[4] = {0x0C,0x48,0x48,0x48};
jelord 38:65ae9771f1e3 339 uint8_t dutyCycleOriginal[4] = {0x0D,0x31,0x30,0x30};
caseyquinn 25:fbf7d44e7da4 340 // Latitude School EEPROM = 0x50-0x53
caseyquinn 25:fbf7d44e7da4 341 // Longitude School EEPROM = 0x54-0x57
caseyquinn 25:fbf7d44e7da4 342 // Latitude Home EEPROM = 0x58-0x5B
caseyquinn 25:fbf7d44e7da4 343 // Longitude Home EEPROM = 0x5C-0x5F
caseyquinn 25:fbf7d44e7da4 344 uint8_t NEW_EEPROM_CHECK[1] = {0,}; //THIS IS USED TO ENSURE COOPERATION WITH MOBILE APPS
jelord 33:03d0e7f5ef0a 345 uint8_t TERMINATE_BYTE[1] = {0xff,}; //used for compatibility with android app
caseyquinn 25:fbf7d44e7da4 346
caseyquinn 25:fbf7d44e7da4 347 //NEW EEPROM Check bit = 0x75
caseyquinn 25:fbf7d44e7da4 348 E2PROM.read(0x00075,NEW_EEPROM_CHECK,1);
caseyquinn 25:fbf7d44e7da4 349
jelord 38:65ae9771f1e3 350 if(NEW_EEPROM_CHECK[0] == 0x0C){
caseyquinn 25:fbf7d44e7da4 351 E2PROM.read(0x00015, sampleTimePassValues+1, 12);
caseyquinn 25:fbf7d44e7da4 352 E2PROM.read(0x00001, subjectLabelOriginal+1,8);
caseyquinn 25:fbf7d44e7da4 353 E2PROM.read(0x00014,dataLogOriginal+1,1);
caseyquinn 25:fbf7d44e7da4 354 E2PROM.read(0x00010,flowRateOriginal+1,4);
caseyquinn 29:fd74725294d5 355 E2PROM.read(0x00034,serialBytes+1,2);
caseyquinn 25:fbf7d44e7da4 356 E2PROM.read(0x00050,latLongSchoolOriginal+1,16);
jelord 33:03d0e7f5ef0a 357 E2PROM.read(0x00060,latLongHome2+1,8);
jelord 38:65ae9771f1e3 358 E2PROM.read(0x00070,cartridgeIDOriginal+1,3);
jelord 38:65ae9771f1e3 359 E2PROM.read(0x00076,dutyCycleOriginal+1,3);
jelord 38:65ae9771f1e3 360
caseyquinn 25:fbf7d44e7da4 361 }else{
jelord 38:65ae9771f1e3 362 NEW_EEPROM_CHECK[0] = 0x0C;
caseyquinn 25:fbf7d44e7da4 363 E2PROM.write(0x00075,NEW_EEPROM_CHECK,1);
caseyquinn 25:fbf7d44e7da4 364 E2PROM.write(0x00015, sampleTimePassValues+1, 12);
caseyquinn 25:fbf7d44e7da4 365 E2PROM.write(0x00001, subjectLabelOriginal+1,8);
caseyquinn 25:fbf7d44e7da4 366 E2PROM.write(0x00014,dataLogOriginal+1,1);
caseyquinn 25:fbf7d44e7da4 367 E2PROM.write(0x00010,flowRateOriginal+1,4);
caseyquinn 29:fd74725294d5 368 E2PROM.write(0x00034,serialBytes+1,2);
caseyquinn 25:fbf7d44e7da4 369 E2PROM.write(0x00050,latLongSchoolOriginal+1,16);
jelord 33:03d0e7f5ef0a 370 E2PROM.write(0x00060,latLongHome2+1,8);
jelord 38:65ae9771f1e3 371 E2PROM.write(0x00070,cartridgeIDOriginal+1,3);
jelord 38:65ae9771f1e3 372 E2PROM.write(0x00076,dutyCycleOriginal+1,3);
caseyquinn 25:fbf7d44e7da4 373 }
caseyquinn 21:bb10efc5bf57 374
jelord 2:88fcbfadec6a 375
jelord 2:88fcbfadec6a 376 for(int i=0; i<13; i++){
jelord 2:88fcbfadec6a 377 microChannel.putc(sampleTimePassValues[i]);
jelord 2:88fcbfadec6a 378 }
jelord 33:03d0e7f5ef0a 379 wait(.15);
jelord 2:88fcbfadec6a 380
jelord 2:88fcbfadec6a 381 for(int i=0; i<9; i++){
jelord 2:88fcbfadec6a 382 microChannel.putc(subjectLabelOriginal[i]);
jelord 2:88fcbfadec6a 383 }
jelord 33:03d0e7f5ef0a 384 wait(.15);
jelord 2:88fcbfadec6a 385
jelord 2:88fcbfadec6a 386 for(int i=0; i<2; i++){
jelord 2:88fcbfadec6a 387 microChannel.putc(dataLogOriginal[i]);
jelord 2:88fcbfadec6a 388 }
jelord 33:03d0e7f5ef0a 389 wait(.15);
jelord 2:88fcbfadec6a 390
jelord 2:88fcbfadec6a 391 for(int i=0; i<5; i++){
jelord 2:88fcbfadec6a 392 microChannel.putc(flowRateOriginal[i]);
caseyquinn 25:fbf7d44e7da4 393 }
jelord 33:03d0e7f5ef0a 394 wait(.15);
caseyquinn 25:fbf7d44e7da4 395
caseyquinn 25:fbf7d44e7da4 396 for(int i=0;i<17;i++){
caseyquinn 25:fbf7d44e7da4 397 microChannel.putc(latLongSchoolOriginal[i]);
jelord 2:88fcbfadec6a 398 }
jelord 33:03d0e7f5ef0a 399 wait(.15);
jelord 33:03d0e7f5ef0a 400
jelord 33:03d0e7f5ef0a 401 for(int i=0;i<9;i++){
jelord 33:03d0e7f5ef0a 402 microChannel.putc(latLongHome2[i]);
jelord 33:03d0e7f5ef0a 403 }
jelord 33:03d0e7f5ef0a 404 wait(.15);
jelord 38:65ae9771f1e3 405 for(int i=0;i<4;i++){
jelord 38:65ae9771f1e3 406 microChannel.putc(cartridgeIDOriginal[i]);
jelord 38:65ae9771f1e3 407 }
jelord 38:65ae9771f1e3 408 wait(.15);
jelord 38:65ae9771f1e3 409 for(int i=0;i<4;i++){
jelord 38:65ae9771f1e3 410 microChannel.putc(dutyCycleOriginal[i]);
jelord 38:65ae9771f1e3 411 }
jelord 38:65ae9771f1e3 412 wait(.15);
jelord 33:03d0e7f5ef0a 413 microChannel.putc(TERMINATE_BYTE[0]);
jelord 0:2cb2b2ea316f 414
jelord 2:88fcbfadec6a 415
caseyquinn 25:fbf7d44e7da4 416 }
caseyquinn 14:7cdb643da356 417
caseyquinn 12:5b4f3245606a 418 //////////////////////////////////////////////////////////////
caseyquinn 12:5b4f3245606a 419 // GPS: Calculate distance from target location
caseyquinn 12:5b4f3245606a 420 //////////////////////////////////////////////////////////////
caseyquinn 12:5b4f3245606a 421 double GPSdistanceCalc (float tlat, float tlon)
caseyquinn 12:5b4f3245606a 422 {
caseyquinn 12:5b4f3245606a 423
caseyquinn 12:5b4f3245606a 424 float tlatrad, flatrad;
caseyquinn 12:5b4f3245606a 425 float sdlong, cdlong;
caseyquinn 12:5b4f3245606a 426 float sflat, cflat;
caseyquinn 12:5b4f3245606a 427 float stlat, ctlat;
caseyquinn 12:5b4f3245606a 428 float delta, denom;
caseyquinn 12:5b4f3245606a 429
caseyquinn 12:5b4f3245606a 430 double distance;
caseyquinn 27:922f53fa649c 431 delta = (gpslongitude-tlon)*0.0174532925;
caseyquinn 12:5b4f3245606a 432 sdlong = sin(delta);
caseyquinn 12:5b4f3245606a 433 cdlong = cos(delta);
caseyquinn 27:922f53fa649c 434 flatrad = (gpslatitude)*0.0174532925;
caseyquinn 12:5b4f3245606a 435 tlatrad = (tlat)*0.0174532925;
caseyquinn 12:5b4f3245606a 436 sflat = sin(flatrad);
caseyquinn 12:5b4f3245606a 437 cflat = cos(flatrad);
caseyquinn 12:5b4f3245606a 438 stlat = sin(tlatrad);
caseyquinn 12:5b4f3245606a 439 ctlat = cos(tlatrad);
caseyquinn 12:5b4f3245606a 440 delta = (cflat * stlat) - (sflat * ctlat * cdlong);
caseyquinn 12:5b4f3245606a 441 delta = pow(delta,2);
caseyquinn 12:5b4f3245606a 442 delta += pow(ctlat * sdlong,2);
caseyquinn 12:5b4f3245606a 443 delta = sqrt(delta);
caseyquinn 12:5b4f3245606a 444 denom = (sflat * stlat) + (cflat * ctlat * cdlong);
caseyquinn 12:5b4f3245606a 445 delta = atan2(delta, denom);
caseyquinn 12:5b4f3245606a 446 distance = delta * 6372795;
caseyquinn 12:5b4f3245606a 447 return distance;
caseyquinn 12:5b4f3245606a 448 }
caseyquinn 12:5b4f3245606a 449
caseyquinn 5:c3252e5d45ca 450
caseyquinn 9:8646fd501832 451 //////////////////////////////////////////////////////////////
caseyquinn 9:8646fd501832 452 //Shutdown Function
caseyquinn 9:8646fd501832 453 //////////////////////////////////////////////////////////////
jelord 3:122bfc998c4c 454 void check_stop() // this checks if it's time to stop and shutdown
jelord 3:122bfc998c4c 455 {
caseyquinn 9:8646fd501832 456 //!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!
caseyquinn 9:8646fd501832 457 //UPDATE THIS TO WORK WITH ST RTC INSTEAD
caseyquinn 9:8646fd501832 458 //!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!
caseyquinn 17:3e6dda6e6335 459
jelord 3:122bfc998c4c 460 if(RTC_UPAS.compare(startAndEndTime[6], startAndEndTime[7], startAndEndTime[8], startAndEndTime[9], startAndEndTime[10], startAndEndTime[11])) {
jelord 3:122bfc998c4c 461 pbKill = 0; // this is were we shut everything down
caseyquinn 4:5d004fd997d5 462 //pc.printf("If you're reading this something has gone very wrong.");
jelord 3:122bfc998c4c 463 }
caseyquinn 17:3e6dda6e6335 464
jelord 3:122bfc998c4c 465 }
caseyquinn 5:c3252e5d45ca 466
caseyquinn 9:8646fd501832 467 //////////////////////////////////////////////////////////////
caseyquinn 9:8646fd501832 468 //SD Logging Function
caseyquinn 9:8646fd501832 469 //////////////////////////////////////////////////////////////
jelord 3:122bfc998c4c 470 void log_data()
jelord 3:122bfc998c4c 471 {
caseyquinn 28:42932d3b105d 472 //Get time and set RTC
caseyquinn 28:42932d3b105d 473 ///////////////////////////
caseyquinn 7:29b01d5812ee 474 time_t seconds = time(NULL);
caseyquinn 36:2e344db70d35 475 //strftime(timestr, 32, "%y%m%d%H%M%S", localtime(&seconds));
caseyquinn 36:2e344db70d35 476 //strftime(hrstr, 32, "%H", localtime(&seconds));
caseyquinn 17:3e6dda6e6335 477 RTC_UPAS.get_time();
caseyquinn 25:fbf7d44e7da4 478
caseyquinn 36:2e344db70d35 479
caseyquinn 36:2e344db70d35 480
caseyquinn 28:42932d3b105d 481 //Get Sensor Data except GPS
caseyquinn 28:42932d3b105d 482 ////////////////////////////
caseyquinn 7:29b01d5812ee 483 press = bmesensor.getPressure();
caseyquinn 7:29b01d5812ee 484 temp = bmesensor.getTemperature()-5.0;
caseyquinn 7:29b01d5812ee 485 rh = bmesensor.getHumidity();
caseyquinn 7:29b01d5812ee 486 uv = lightsensor.getUV();
caseyquinn 14:7cdb643da356 487 movementsensor.getACCEL();
caseyquinn 14:7cdb643da356 488 movementsensor.getCOMPASS();
caseyquinn 14:7cdb643da356 489 compass = movementsensor.getCOMPASS_HEADING();
caseyquinn 14:7cdb643da356 490 accel_x = movementsensor.AccelData.x;
caseyquinn 14:7cdb643da356 491 accel_y = movementsensor.AccelData.y;
caseyquinn 14:7cdb643da356 492 accel_z = movementsensor.AccelData.z;
caseyquinn 14:7cdb643da356 493 accel_comp = pow(accel_x,(float)2)+pow(accel_y,(float)2)+pow(accel_z,(float)2)-1.0;
caseyquinn 14:7cdb643da356 494 mag_x = movementsensor.MagData.x;
caseyquinn 14:7cdb643da356 495 mag_y = movementsensor.MagData.y;
caseyquinn 14:7cdb643da356 496 mag_z = movementsensor.MagData.z;
caseyquinn 25:fbf7d44e7da4 497 vInReadingLast = vInReading;
caseyquinn 25:fbf7d44e7da4 498 vInReading = ads.readADC_SingleEnded(1, 0xD583); // read channel 0
caseyquinn 25:fbf7d44e7da4 499 amps = gasG.getAmps();
caseyquinn 25:fbf7d44e7da4 500 bVolt = gasG.getVolts();
caseyquinn 25:fbf7d44e7da4 501 bFuel = gasG.getCharge();
caseyquinn 35:e0bdd6389a75 502
caseyquinn 28:42932d3b105d 503 //Check for fully charged battery
caseyquinn 28:42932d3b105d 504 if(bVolt > 1750 && amps > 8191) {
caseyquinn 36:2e344db70d35 505 RGB_LED.set_led(0,0,0);
caseyquinn 36:2e344db70d35 506 //RGB_LED.set_led(0,1,0);
caseyquinn 28:42932d3b105d 507 //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 508 }else if(amps > 8191 && (RTC_UPAS.hour >=20 || bVolt < 1500)) {
caseyquinn 28:42932d3b105d 509 if(ledOn) {
caseyquinn 28:42932d3b105d 510 RGB_LED.set_led(0,0,0);
caseyquinn 28:42932d3b105d 511 ledOn = 0;
caseyquinn 28:42932d3b105d 512 }else {
caseyquinn 28:42932d3b105d 513 RGB_LED.set_led(1,0,0);
caseyquinn 28:42932d3b105d 514 ledOn = 1;
caseyquinn 28:42932d3b105d 515 }
caseyquinn 28:42932d3b105d 516 //No LED on when not low battery and not fully charged
caseyquinn 28:42932d3b105d 517 }else{
caseyquinn 28:42932d3b105d 518 RGB_LED.set_led(0,0,0);
caseyquinn 28:42932d3b105d 519 }
caseyquinn 28:42932d3b105d 520
caseyquinn 35:e0bdd6389a75 521
caseyquinn 28:42932d3b105d 522 // Get GPS Data
caseyquinn 28:42932d3b105d 523 //////////////////////////////
caseyquinn 28:42932d3b105d 524 //if(gpsEN ==1){
caseyquinn 28:42932d3b105d 525
caseyquinn 28:42932d3b105d 526 gpsFix = gps.read(1);
caseyquinn 28:42932d3b105d 527 gpsspeed = gps.speed;
caseyquinn 28:42932d3b105d 528 //gpscourse = gps.course;
caseyquinn 28:42932d3b105d 529 gpssatellites = gps.satellites;
caseyquinn 28:42932d3b105d 530 gpslatitude = gps.lat;
caseyquinn 28:42932d3b105d 531 gpslongitude = gps.lon;
caseyquinn 28:42932d3b105d 532 gpsaltitude = gps.altitude;
caseyquinn 28:42932d3b105d 533
caseyquinn 28:42932d3b105d 534 if(gpsFix){
caseyquinn 36:2e344db70d35 535
caseyquinn 36:2e344db70d35 536
caseyquinn 28:42932d3b105d 537 workDistance = GPSdistanceCalc (work_lat, work_lon);
caseyquinn 28:42932d3b105d 538 homeDistance = GPSdistanceCalc (home_lat, home_lon);
caseyquinn 36:2e344db70d35 539 home2Distance = GPSdistanceCalc (home_lat2, home_lon2);
caseyquinn 36:2e344db70d35 540
caseyquinn 29:fd74725294d5 541 RGB_LED.set_led(0,0,0);
caseyquinn 28:42932d3b105d 542
caseyquinn 36:2e344db70d35 543 if(workDistance < 100) {
caseyquinn 36:2e344db70d35 544 if(sampledVol < 2){
caseyquinn 36:2e344db70d35 545 pumps = 1;
caseyquinn 36:2e344db70d35 546 }
caseyquinn 36:2e344db70d35 547
caseyquinn 37:6c2dca195871 548 if(location != 1){
caseyquinn 28:42932d3b105d 549 location = 1;
caseyquinn 36:2e344db70d35 550
caseyquinn 36:2e344db70d35 551 schoolF1.getFault();
caseyquinn 36:2e344db70d35 552 homeF2.getFault();
caseyquinn 36:2e344db70d35 553 transitF3.getFault();
caseyquinn 36:2e344db70d35 554 blankF4.getFault();
caseyquinn 36:2e344db70d35 555
caseyquinn 36:2e344db70d35 556 schoolF1.drive(254); //closed = 253, open = 254
caseyquinn 36:2e344db70d35 557 homeF2.drive(253); //closed = 253, open = 254
caseyquinn 36:2e344db70d35 558 transitF3.drive(253); //closed = 253, open = 254
caseyquinn 36:2e344db70d35 559 blankF4.drive(253); //closed = 253, open = 254
caseyquinn 36:2e344db70d35 560 wait(1);
caseyquinn 36:2e344db70d35 561 schoolF1.stop();
caseyquinn 36:2e344db70d35 562 homeF2.stop();
caseyquinn 36:2e344db70d35 563 transitF3.stop();
caseyquinn 36:2e344db70d35 564 blankF4.stop();
caseyquinn 28:42932d3b105d 565 //RGB_LED.set_led(0,1,1);
caseyquinn 37:6c2dca195871 566 }
caseyquinn 36:2e344db70d35 567
caseyquinn 36:2e344db70d35 568 }else if(homeDistance < 100 || home2Distance < 100) { // 25 or 30 m instead?
caseyquinn 37:6c2dca195871 569
caseyquinn 37:6c2dca195871 570 if(location != 2){
caseyquinn 28:42932d3b105d 571 location = 2;
caseyquinn 36:2e344db70d35 572
caseyquinn 36:2e344db70d35 573 schoolF1.getFault();
caseyquinn 36:2e344db70d35 574 homeF2.getFault();
caseyquinn 36:2e344db70d35 575 transitF3.getFault();
caseyquinn 36:2e344db70d35 576 blankF4.getFault();
caseyquinn 36:2e344db70d35 577
caseyquinn 36:2e344db70d35 578 schoolF1.drive(253); //closed = 253, open = 254
caseyquinn 36:2e344db70d35 579 homeF2.drive(254); //closed = 253, open = 254
caseyquinn 36:2e344db70d35 580 transitF3.drive(253); //closed = 253, open = 254
caseyquinn 36:2e344db70d35 581 blankF4.drive(253); //closed = 253, open = 254
caseyquinn 36:2e344db70d35 582 wait(1);
caseyquinn 36:2e344db70d35 583 schoolF1.stop();
caseyquinn 36:2e344db70d35 584 homeF2.stop();
caseyquinn 36:2e344db70d35 585 transitF3.stop();
caseyquinn 36:2e344db70d35 586 blankF4.stop();
caseyquinn 36:2e344db70d35 587
caseyquinn 28:42932d3b105d 588 //RGB_LED.set_led(1,0,1);
caseyquinn 37:6c2dca195871 589 }
caseyquinn 36:2e344db70d35 590
caseyquinn 28:42932d3b105d 591 }else{
caseyquinn 37:6c2dca195871 592 if(location != 3){
caseyquinn 28:42932d3b105d 593 location = 3;
caseyquinn 36:2e344db70d35 594
caseyquinn 36:2e344db70d35 595 schoolF1.getFault();
caseyquinn 36:2e344db70d35 596 homeF2.getFault();
caseyquinn 36:2e344db70d35 597 transitF3.getFault();
caseyquinn 36:2e344db70d35 598 blankF4.getFault();
caseyquinn 36:2e344db70d35 599
caseyquinn 36:2e344db70d35 600 schoolF1.drive(253); //closed = 253, open = 254
caseyquinn 36:2e344db70d35 601 homeF2.drive(253); //closed = 253, open = 254
caseyquinn 36:2e344db70d35 602 transitF3.drive(254); //closed = 253, open = 254
caseyquinn 36:2e344db70d35 603 blankF4.drive(253); //closed = 253, open = 254
caseyquinn 36:2e344db70d35 604 wait(1);
caseyquinn 36:2e344db70d35 605 schoolF1.stop();
caseyquinn 36:2e344db70d35 606 homeF2.stop();
caseyquinn 36:2e344db70d35 607 transitF3.stop();
caseyquinn 36:2e344db70d35 608 blankF4.stop();
caseyquinn 37:6c2dca195871 609 }
caseyquinn 36:2e344db70d35 610
caseyquinn 36:2e344db70d35 611 /*
caseyquinn 36:2e344db70d35 612 if(sampledVol < 2){
caseyquinn 36:2e344db70d35 613 RGB_LED.set_led(0,1,0);
caseyquinn 36:2e344db70d35 614 }
caseyquinn 36:2e344db70d35 615 */
caseyquinn 28:42932d3b105d 616 }
caseyquinn 28:42932d3b105d 617
caseyquinn 28:42932d3b105d 618 }else if(homeDistance == 99999 && workDistance == 99999){
caseyquinn 28:42932d3b105d 619 location = 0;
caseyquinn 36:2e344db70d35 620 //RGB_LED.set_led(1,1,0);
caseyquinn 28:42932d3b105d 621 }
caseyquinn 28:42932d3b105d 622
caseyquinn 28:42932d3b105d 623 //}
caseyquinn 28:42932d3b105d 624
caseyquinn 28:42932d3b105d 625 //Check for 3.3V rail cut out and turn off pumps in this event
caseyquinn 28:42932d3b105d 626 if(vInReading > 5950 && amps > 8191) {
caseyquinn 35:e0bdd6389a75 627 pumps = 0;
caseyquinn 28:42932d3b105d 628 wait(1);
caseyquinn 28:42932d3b105d 629 //Turn pumps back on once the sampler is plugged in and charging after pumps shutoff and 3.3V rail drops out
caseyquinn 28:42932d3b105d 630 } else if(pumps == 0 && amps < 8191) {
caseyquinn 28:42932d3b105d 631
caseyquinn 28:42932d3b105d 632 // 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 633 if(gpsFix == 0 && RTC_UPAS.hour>8){
caseyquinn 28:42932d3b105d 634 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 635 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 636 //Adjust valves to ensure everything is in proper place before pumps restart
caseyquinn 36:2e344db70d35 637
caseyquinn 28:42932d3b105d 638 schoolF1.getFault();
caseyquinn 28:42932d3b105d 639 homeF2.getFault();
caseyquinn 28:42932d3b105d 640 transitF3.getFault();
caseyquinn 28:42932d3b105d 641 blankF4.getFault();
caseyquinn 28:42932d3b105d 642
caseyquinn 28:42932d3b105d 643 schoolF1.drive(254); //closed = 253, open = 254
caseyquinn 28:42932d3b105d 644 homeF2.drive(253); //closed = 253, open = 254
caseyquinn 28:42932d3b105d 645 transitF3.drive(253); //closed = 253, open = 254
caseyquinn 28:42932d3b105d 646 blankF4.drive(253); //closed = 253, open = 254
caseyquinn 28:42932d3b105d 647 wait(1);
caseyquinn 28:42932d3b105d 648 schoolF1.stop();
caseyquinn 28:42932d3b105d 649 homeF2.stop();
caseyquinn 28:42932d3b105d 650 transitF3.stop();
caseyquinn 28:42932d3b105d 651 blankF4.stop();
caseyquinn 36:2e344db70d35 652 }
caseyquinn 36:2e344db70d35 653
caseyquinn 36:2e344db70d35 654
caseyquinn 36:2e344db70d35 655 pumps = 1;
caseyquinn 28:42932d3b105d 656
caseyquinn 28:42932d3b105d 657 }
caseyquinn 28:42932d3b105d 658
caseyquinn 28:42932d3b105d 659
caseyquinn 14:7cdb643da356 660
caseyquinn 25:fbf7d44e7da4 661 if(pumps == 1){
caseyquinn 34:da333abe3476 662 omronReading = ads.readADC_SingleEnded(0, 0xC383); // read channel 0 PGA = 2 : Full Scale Range = 2.048V
caseyquinn 34:da333abe3476 663 omronVolt = (omronReading*4.096)/(32768*1);
caseyquinn 25:fbf7d44e7da4 664
caseyquinn 25:fbf7d44e7da4 665 if(omronVolt<=calibrations.omronVMin) {
caseyquinn 25:fbf7d44e7da4 666 massflow = calibrations.omronMFMin;
caseyquinn 25:fbf7d44e7da4 667 } else if(omronVolt>=calibrations.omronVMax) {
caseyquinn 25:fbf7d44e7da4 668 massflow = calibrations.omronMFMax;
caseyquinn 25:fbf7d44e7da4 669 } else {
caseyquinn 25:fbf7d44e7da4 670 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 671 }
caseyquinn 25:fbf7d44e7da4 672
caseyquinn 25:fbf7d44e7da4 673 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 674 volflow = massflow/atmoRho;
caseyquinn 25:fbf7d44e7da4 675 sampledVol = sampledVol + ((((float)logInerval)/60.0)*volflow);
caseyquinn 25:fbf7d44e7da4 676 deltaVflow = volflow-volflowSet;
caseyquinn 25:fbf7d44e7da4 677 massflowSet = volflowSet*atmoRho;
caseyquinn 25:fbf7d44e7da4 678 deltaMflow = massflow-massflowSet;
caseyquinn 25:fbf7d44e7da4 679
caseyquinn 25:fbf7d44e7da4 680 vBlowerReading = ads.readADC_SingleEnded(2, 0xE783); // read channel 0
caseyquinn 25:fbf7d44e7da4 681 omronDiff = ads.readADC_Differential(0x8583); // differential channel 2-3
caseyquinn 14:7cdb643da356 682 }
caseyquinn 14:7cdb643da356 683
caseyquinn 27:922f53fa649c 684
caseyquinn 21:bb10efc5bf57 685
caseyquinn 7:29b01d5812ee 686 FILE *fp = fopen(filename, "a");
caseyquinn 21:bb10efc5bf57 687 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 688 fprintf(fp, "%s,", timestr);
caseyquinn 7:29b01d5812ee 689 fprintf(fp, "%1.3f,%1.3f,%2.2f,%4.2f,%2.1f,%1.3f,", omronVolt,massflow,temp,press,rh,atmoRho);
caseyquinn 7:29b01d5812ee 690 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 691 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 692 fprintf(fp, "%d,%d,%d,%d,%d,%d," ,uv,omronReading, vInReading, vBlowerReading, omronDiff,amps);
caseyquinn 25:fbf7d44e7da4 693 fprintf(fp, "%d,%d,%d,%1.3f,%1.3f,", bVolt, bFuel,digital_pot_set, deltaMflow, deltaVflow);
caseyquinn 27:922f53fa649c 694 fprintf(fp, "%f,%f,%06d,%06d,", gpslatitude, gpslongitude, (long)gps.date, (long)gps.utc);
caseyquinn 28:42932d3b105d 695 //fprintf(fp, "%f,%d,%f,%f,%d,", gpsspeed, gpssatellites, gpscourse, gpsaltitude, gpsFix);
caseyquinn 28:42932d3b105d 696 fprintf(fp, "%f,%d,%f,%d,", gpsspeed, gpssatellites, gpsaltitude, gpsFix);
caseyquinn 36:2e344db70d35 697 fprintf(fp, "%f,%f,%f,%d,%d\r\n", homeDistance, home2Distance, workDistance, location, pumps == 1); // test and add in speed, etc that Josh added in to match the adafruit GPS
caseyquinn 7:29b01d5812ee 698 fclose(fp);
caseyquinn 7:29b01d5812ee 699 free(fp);
caseyquinn 25:fbf7d44e7da4 700
caseyquinn 25:fbf7d44e7da4 701
caseyquinn 14:7cdb643da356 702
caseyquinn 12:5b4f3245606a 703
caseyquinn 25:fbf7d44e7da4 704
caseyquinn 12:5b4f3245606a 705
jelord 3:122bfc998c4c 706
jelord 3:122bfc998c4c 707 }
caseyquinn 8:c4a8f9b67cee 708
caseyquinn 9:8646fd501832 709 //////////////////////////////////////////////////////////////
caseyquinn 9:8646fd501832 710 //Flow Control Function
caseyquinn 9:8646fd501832 711 //////////////////////////////////////////////////////////////
caseyquinn 8:c4a8f9b67cee 712 void flowControl()
caseyquinn 8:c4a8f9b67cee 713 {
caseyquinn 25:fbf7d44e7da4 714
caseyquinn 25:fbf7d44e7da4 715 //RGB_LED.set_led(0,1,0);
caseyquinn 34:da333abe3476 716 omronReading = ads.readADC_SingleEnded(0, 0xC383); // read channel 0 PGA = 2 : Full Scale Range = 2.048V
caseyquinn 34:da333abe3476 717 omronVolt = (omronReading*4.096)/(32768*1);
caseyquinn 8:c4a8f9b67cee 718
caseyquinn 8:c4a8f9b67cee 719 if(omronVolt<=calibrations.omronVMin) {
caseyquinn 8:c4a8f9b67cee 720 massflow = calibrations.omronMFMin;
caseyquinn 8:c4a8f9b67cee 721 } else if(omronVolt>=calibrations.omronVMax) {
caseyquinn 8:c4a8f9b67cee 722 massflow = calibrations.omronMFMax;
caseyquinn 8:c4a8f9b67cee 723 } else {
caseyquinn 8:c4a8f9b67cee 724 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 725 }
caseyquinn 8:c4a8f9b67cee 726
caseyquinn 8:c4a8f9b67cee 727 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 728 volflow = massflow/atmoRho;
caseyquinn 8:c4a8f9b67cee 729 sampledVol = sampledVol + ((((float)logInerval)/60.0)*volflow);
caseyquinn 8:c4a8f9b67cee 730 deltaVflow = volflow-volflowSet;
caseyquinn 8:c4a8f9b67cee 731 massflowSet = volflowSet*atmoRho;
caseyquinn 8:c4a8f9b67cee 732 deltaMflow = massflow-massflowSet;
caseyquinn 12:5b4f3245606a 733
caseyquinn 8:c4a8f9b67cee 734 if(abs(deltaMflow)>.025) {
caseyquinn 8:c4a8f9b67cee 735 digital_pot_change = (int)(gainFlow*deltaMflow);
caseyquinn 8:c4a8f9b67cee 736
caseyquinn 8:c4a8f9b67cee 737
caseyquinn 12:5b4f3245606a 738 if(abs(digital_pot_change)>=10) {
caseyquinn 12:5b4f3245606a 739 digital_pot_set = (int)(digital_pot_set+ (int)(1*deltaMflow));
caseyquinn 25:fbf7d44e7da4 740 //RGB_LED.set_led(1,0,0);
caseyquinn 12:5b4f3245606a 741 } else {
caseyquinn 8:c4a8f9b67cee 742 digital_pot_set = (digital_pot_set+ digital_pot_change);
caseyquinn 25:fbf7d44e7da4 743 //RGB_LED.set_led(1,1,0);
caseyquinn 8:c4a8f9b67cee 744 }
caseyquinn 8:c4a8f9b67cee 745
caseyquinn 12:5b4f3245606a 746 if(digital_pot_set>=digitalpotMax) {
caseyquinn 12:5b4f3245606a 747 digital_pot_set = digitalpotMax;
caseyquinn 25:fbf7d44e7da4 748 //RGB_LED.set_led(1,0,0);
caseyquinn 12:5b4f3245606a 749 } else if(digital_pot_set<=digitalpotMin) {
caseyquinn 12:5b4f3245606a 750 digital_pot_set = digitalpotMin;
caseyquinn 25:fbf7d44e7da4 751 //RGB_LED.set_led(1,0,0);
caseyquinn 12:5b4f3245606a 752 }
caseyquinn 8:c4a8f9b67cee 753
caseyquinn 8:c4a8f9b67cee 754 DigPot.writeRegister(digital_pot_set);
caseyquinn 12:5b4f3245606a 755
caseyquinn 8:c4a8f9b67cee 756 } else {
caseyquinn 25:fbf7d44e7da4 757 //RGB_LED.set_led(0,1,0);
caseyquinn 8:c4a8f9b67cee 758 }
caseyquinn 12:5b4f3245606a 759
caseyquinn 25:fbf7d44e7da4 760
caseyquinn 8:c4a8f9b67cee 761 }
caseyquinn 9:8646fd501832 762 //////////////////////////////////////////////////////////////
caseyquinn 9:8646fd501832 763 //Main Function
caseyquinn 9:8646fd501832 764 //////////////////////////////////////////////////////////////
jelord 1:9fbb5b665068 765 int main(){
caseyquinn 27:922f53fa649c 766
caseyquinn 29:fd74725294d5 767
caseyquinn 23:1ca41779b8ec 768 RGB_LED.set_led(0,0,1);
caseyquinn 36:2e344db70d35 769
caseyquinn 36:2e344db70d35 770
caseyquinn 29:fd74725294d5 771 /*
caseyquinn 27:922f53fa649c 772 while(1){
caseyquinn 27:922f53fa649c 773 if(sdCD == 0){
caseyquinn 27:922f53fa649c 774 RGB_LED.set_led(0,1,0);
caseyquinn 27:922f53fa649c 775 }else{
caseyquinn 27:922f53fa649c 776 RGB_LED.set_led(1,0,0);
caseyquinn 27:922f53fa649c 777 }
caseyquinn 27:922f53fa649c 778
caseyquinn 27:922f53fa649c 779 wait(10);
caseyquinn 27:922f53fa649c 780 }
caseyquinn 35:e0bdd6389a75 781
caseyquinn 13:455601f62aad 782
caseyquinn 28:42932d3b105d 783 schoolF1.getFault();
caseyquinn 28:42932d3b105d 784 homeF2.getFault();
caseyquinn 28:42932d3b105d 785 transitF3.getFault();
caseyquinn 28:42932d3b105d 786 blankF4.getFault();
caseyquinn 23:1ca41779b8ec 787
caseyquinn 30:aa6324845a84 788 schoolF1.drive(253); //closed = 253, open = 254
caseyquinn 28:42932d3b105d 789 homeF2.drive(253); //closed = 253, open = 254
caseyquinn 29:fd74725294d5 790 transitF3.drive(253); //closed = 253, open = 254
caseyquinn 28:42932d3b105d 791 blankF4.drive(253); //closed = 253, open = 254
caseyquinn 28:42932d3b105d 792
caseyquinn 28:42932d3b105d 793 wait(1);
caseyquinn 28:42932d3b105d 794 schoolF1.stop();
caseyquinn 28:42932d3b105d 795 homeF2.stop();
caseyquinn 28:42932d3b105d 796 transitF3.stop();
caseyquinn 28:42932d3b105d 797 blankF4.stop();
caseyquinn 35:e0bdd6389a75 798 */
caseyquinn 35:e0bdd6389a75 799
caseyquinn 35:e0bdd6389a75 800 schoolF1.getFault();
caseyquinn 35:e0bdd6389a75 801 homeF2.getFault();
caseyquinn 35:e0bdd6389a75 802 transitF3.getFault();
caseyquinn 35:e0bdd6389a75 803 blankF4.getFault();
caseyquinn 35:e0bdd6389a75 804
caseyquinn 35:e0bdd6389a75 805 schoolF1.drive(253); //closed = 253, open = 254
caseyquinn 36:2e344db70d35 806 homeF2.drive(253); //closed = 253, open = 254
caseyquinn 35:e0bdd6389a75 807 transitF3.drive(253); //closed = 253, open = 254
caseyquinn 35:e0bdd6389a75 808 blankF4.drive(253); //closed = 253, open = 254
caseyquinn 35:e0bdd6389a75 809
caseyquinn 35:e0bdd6389a75 810 wait(1);
caseyquinn 35:e0bdd6389a75 811 schoolF1.stop();
caseyquinn 35:e0bdd6389a75 812 homeF2.stop();
caseyquinn 35:e0bdd6389a75 813 transitF3.stop();
caseyquinn 35:e0bdd6389a75 814 blankF4.stop();
caseyquinn 30:aa6324845a84 815
caseyquinn 30:aa6324845a84 816
caseyquinn 23:1ca41779b8ec 817
caseyquinn 23:1ca41779b8ec 818 gpsEN = 1;
caseyquinn 23:1ca41779b8ec 819 wait(1);
caseyquinn 23:1ca41779b8ec 820 BT_SW = 1;
caseyquinn 23:1ca41779b8ec 821 wait(1);
caseyquinn 23:1ca41779b8ec 822 BT_IRST = 1;
caseyquinn 23:1ca41779b8ec 823 wait(1);
caseyquinn 23:1ca41779b8ec 824
caseyquinn 12:5b4f3245606a 825
caseyquinn 10:06fbb1c9e3bd 826 pc.baud(115200); // set what you want here depending on your terminal program speed
caseyquinn 10:06fbb1c9e3bd 827 pc.printf("\f\n\r-------------Startup-------------\n\r");
jelord 1:9fbb5b665068 828 wait(0.5);
caseyquinn 5:c3252e5d45ca 829
caseyquinn 29:fd74725294d5 830
caseyquinn 29:fd74725294d5 831
caseyquinn 29:fd74725294d5 832 uint8_t serialNumberAndType[6] = {0x50,0x53,}; //ex) PS0018 // 0x50,0x53 <- ASCII 80 + 83 (PS) //0x4d,0x53 <- ASCII 77 + 83 (MS)
caseyquinn 29:fd74725294d5 833 E2PROM.read(0x00034,serialNumberAndType+2,2);
caseyquinn 29:fd74725294d5 834
caseyquinn 29:fd74725294d5 835 int tempSerialNum = ((serialNumberAndType[2]-48)*10 + serialNumberAndType[3]-48);
caseyquinn 29:fd74725294d5 836 if(tempSerialNum < 18){
caseyquinn 29:fd74725294d5 837 serialNumberAndType[0] = 0x4D;
caseyquinn 29:fd74725294d5 838 }
caseyquinn 13:455601f62aad 839
jelord 3:122bfc998c4c 840 int serialNumDigits[4];
jelord 3:122bfc998c4c 841 serialNumDigits[0] = tempSerialNum / 1000 % 10;
jelord 3:122bfc998c4c 842 serialNumDigits[1] = tempSerialNum / 100 % 10;
jelord 3:122bfc998c4c 843 serialNumDigits[2] = tempSerialNum / 10 % 10;
jelord 3:122bfc998c4c 844 serialNumDigits[3] = tempSerialNum % 10;
jelord 3:122bfc998c4c 845
caseyquinn 29:fd74725294d5 846
jelord 3:122bfc998c4c 847 serialNumberAndType[2] = serialNumDigits[0]+48;
jelord 3:122bfc998c4c 848 serialNumberAndType[3] = serialNumDigits[1]+48;
jelord 3:122bfc998c4c 849 serialNumberAndType[4] = serialNumDigits[2]+48;
jelord 3:122bfc998c4c 850 serialNumberAndType[5] = serialNumDigits[3]+48;
caseyquinn 12:5b4f3245606a 851
caseyquinn 29:fd74725294d5 852 /*
caseyquinn 29:fd74725294d5 853 serialNumberAndType[2] = serialNumDigits[0];
caseyquinn 29:fd74725294d5 854 serialNumberAndType[3] = serialNumDigits[1];
caseyquinn 29:fd74725294d5 855 serialNumberAndType[4] = serialNumDigits[2];
caseyquinn 29:fd74725294d5 856 serialNumberAndType[5] = serialNumDigits[3];
caseyquinn 29:fd74725294d5 857 */
caseyquinn 29:fd74725294d5 858
caseyquinn 29:fd74725294d5 859 RGB_LED.set_led(0,1,0);
caseyquinn 13:455601f62aad 860
caseyquinn 10:06fbb1c9e3bd 861 pc.attach(pc_recv);
jelord 1:9fbb5b665068 862 microChannel.attach(uartMicro,microChannel.RxIrq);
jelord 3:122bfc998c4c 863 microChannel.baud(115200);
jelord 1:9fbb5b665068 864 microChannel.printf("$$$");
jelord 3:122bfc998c4c 865 wait(0.5);
jelord 3:122bfc998c4c 866 microChannel.printf("SN,");
jelord 3:122bfc998c4c 867 for(int i=0;i<6;i++)microChannel.putc(serialNumberAndType[i]);
jelord 3:122bfc998c4c 868 microChannel.printf("\r");
jelord 3:122bfc998c4c 869 wait(0.5);
jelord 1:9fbb5b665068 870 microChannel.printf("A\r");
jelord 3:122bfc998c4c 871 wait(0.5);
jelord 2:88fcbfadec6a 872 microChannel.printf("---\r");
jelord 3:122bfc998c4c 873 wait(0.5);
jelord 2:88fcbfadec6a 874
caseyquinn 18:41ef98db0423 875 RGB_LED.set_led(1,1,1);
caseyquinn 36:2e344db70d35 876
jelord 3:122bfc998c4c 877 while(runReady!=1) {
jelord 3:122bfc998c4c 878 wait(1);
caseyquinn 26:6aa294d83af4 879 pc.printf("Waiting for BLE instruction\r\n");
jelord 3:122bfc998c4c 880
jelord 3:122bfc998c4c 881 }
jelord 3:122bfc998c4c 882
caseyquinn 36:2e344db70d35 883 BT_SW = 0;
caseyquinn 36:2e344db70d35 884 wait(1);
caseyquinn 36:2e344db70d35 885 BT_IRST = 0;
caseyquinn 36:2e344db70d35 886 wait(1);
caseyquinn 36:2e344db70d35 887
caseyquinn 36:2e344db70d35 888
caseyquinn 36:2e344db70d35 889
jelord 3:122bfc998c4c 890 E2PROM.read(0x00015, startAndEndTime, 12); //Grab start and end times from EEPROM
jelord 3:122bfc998c4c 891 RGB_LED.set_led(0,1,0);
caseyquinn 14:7cdb643da356 892
caseyquinn 26:6aa294d83af4 893
caseyquinn 26:6aa294d83af4 894 //Pull MicroEnviornment Lat/Lons from EEPROM
caseyquinn 26:6aa294d83af4 895 // Latitude School EEPROM = 0x50-0x53
caseyquinn 26:6aa294d83af4 896 // Longitude School EEPROM = 0x54-0x57
caseyquinn 26:6aa294d83af4 897 // Latitude Home EEPROM = 0x58-0x5B
caseyquinn 26:6aa294d83af4 898 // Longitude Home EEPROM = 0x5C-0x5F
caseyquinn 26:6aa294d83af4 899
caseyquinn 26:6aa294d83af4 900 uint8_t workLat[4] = {0,};
caseyquinn 26:6aa294d83af4 901 E2PROM.read(0x00050,workLat,4);
caseyquinn 26:6aa294d83af4 902 E2PROM.byteToFloat(workLat, &work_lat);
caseyquinn 26:6aa294d83af4 903
caseyquinn 26:6aa294d83af4 904 uint8_t workLon[4] = {0,};
caseyquinn 26:6aa294d83af4 905 E2PROM.read(0x00054,workLon,4);
caseyquinn 26:6aa294d83af4 906 E2PROM.byteToFloat(workLon, &work_lon);
caseyquinn 26:6aa294d83af4 907
caseyquinn 26:6aa294d83af4 908 uint8_t homeLat[4] = {0,};
caseyquinn 26:6aa294d83af4 909 E2PROM.read(0x00058,homeLat,4);
caseyquinn 26:6aa294d83af4 910 E2PROM.byteToFloat(homeLat, &home_lat);
caseyquinn 26:6aa294d83af4 911
caseyquinn 26:6aa294d83af4 912 uint8_t homeLon[4] = {0,};
caseyquinn 26:6aa294d83af4 913 E2PROM.read(0x0005C,homeLon,4);
caseyquinn 26:6aa294d83af4 914 E2PROM.byteToFloat(homeLon, &home_lon);
caseyquinn 26:6aa294d83af4 915
caseyquinn 36:2e344db70d35 916 uint8_t homeLat2[4] = {0,};
caseyquinn 36:2e344db70d35 917 E2PROM.read(0x00060,homeLat2,4);
caseyquinn 36:2e344db70d35 918 E2PROM.byteToFloat(homeLat2, &home_lat2);
caseyquinn 26:6aa294d83af4 919
caseyquinn 36:2e344db70d35 920 uint8_t homeLon2[4] = {0,};
caseyquinn 36:2e344db70d35 921 E2PROM.read(0x00064,homeLon2,4);
caseyquinn 36:2e344db70d35 922 E2PROM.byteToFloat(homeLon2, &home_lon2);
caseyquinn 36:2e344db70d35 923
caseyquinn 36:2e344db70d35 924 pc.printf("%f,%f\r\n %f,%f\r\n %f,%f\r\n", home_lat, home_lon, work_lat, work_lon, home_lat2, home_lon2);
caseyquinn 36:2e344db70d35 925
caseyquinn 36:2e344db70d35 926 //Get the subject line information
caseyquinn 29:fd74725294d5 927 uint8_t subjectLabelOriginal[8] = {0,};
caseyquinn 29:fd74725294d5 928 E2PROM.read(0x00001, subjectLabelOriginal,8);
jelord 3:122bfc998c4c 929
jelord 3:122bfc998c4c 930 //Get the proper serial number
jelord 3:122bfc998c4c 931 uint8_t serialBytes[2] = {0,};
caseyquinn 29:fd74725294d5 932 E2PROM.read(0x00034,serialBytes,2);
caseyquinn 29:fd74725294d5 933 serial_num = (uint16_t)(((serialBytes[0]-48)*10 + serialBytes[1]-48));
caseyquinn 29:fd74725294d5 934
caseyquinn 29:fd74725294d5 935
caseyquinn 29:fd74725294d5 936 ////////////////////////////////////////////////////////////////////
caseyquinn 29:fd74725294d5 937 //Temporary fix for setting serial_num
caseyquinn 29:fd74725294d5 938 ////////////////////////////////////////////////////////////////////
caseyquinn 29:fd74725294d5 939 //uint8_t serialsubjectLabelOriginal[2] = {0,};
caseyquinn 29:fd74725294d5 940 //E2PROM.read(0x00001, serialsubjectLabelOriginal,2);
caseyquinn 29:fd74725294d5 941 //uint8_t newserialBytes[2] = {0,};
caseyquinn 29:fd74725294d5 942
caseyquinn 30:aa6324845a84 943 if(subjectLabelOriginal[2] == 126){
caseyquinn 29:fd74725294d5 944 E2PROM.write(0x00034,subjectLabelOriginal,2);
caseyquinn 29:fd74725294d5 945 serial_num = (uint16_t)(((subjectLabelOriginal[0]-48)*10 + subjectLabelOriginal[1]-48));
caseyquinn 29:fd74725294d5 946 }
caseyquinn 29:fd74725294d5 947
caseyquinn 29:fd74725294d5 948 //----------------------------------------------
jelord 3:122bfc998c4c 949 calibrations.initialize(serial_num);
caseyquinn 29:fd74725294d5 950 pc.printf("%d\r\n", serial_num);
caseyquinn 29:fd74725294d5 951 pc.printf("%f\r\n",calibrations.MF4);
caseyquinn 29:fd74725294d5 952 //----------------------------------------------
caseyquinn 29:fd74725294d5 953 ////////////////////////////////////////////////////////////////////
caseyquinn 29:fd74725294d5 954
jelord 3:122bfc998c4c 955
jelord 3:122bfc998c4c 956 uint8_t logByte[1] = {0,};
jelord 3:122bfc998c4c 957 E2PROM.read(0x00014,logByte,1);
jelord 3:122bfc998c4c 958 logInerval = logByte[0];
jelord 3:122bfc998c4c 959
jelord 3:122bfc998c4c 960 //Use the flow rate value stored in eeprom
jelord 3:122bfc998c4c 961 uint8_t flowRateBytes[4] = {0,};
jelord 3:122bfc998c4c 962 E2PROM.read(0x00010,flowRateBytes,4);
jelord 3:122bfc998c4c 963 E2PROM.byteToFloat(flowRateBytes, &volflowSet);
caseyquinn 29:fd74725294d5 964
caseyquinn 29:fd74725294d5 965
caseyquinn 36:2e344db70d35 966 time_t seconds = time(NULL);
caseyquinn 36:2e344db70d35 967 strftime(timestr, 32, "%y-%m-%d-%H=%M=%S", localtime(&seconds));
caseyquinn 36:2e344db70d35 968 RTC_UPAS.get_time();
caseyquinn 36:2e344db70d35 969 if(tempSerialNum < 18){
caseyquinn 36:2e344db70d35 970 sprintf(filename, "/sd/MS%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 36:2e344db70d35 971
caseyquinn 36:2e344db70d35 972 }
caseyquinn 36:2e344db70d35 973 else{
caseyquinn 36:2e344db70d35 974 sprintf(filename, "/sd/PS%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 36:2e344db70d35 975 }
caseyquinn 36:2e344db70d35 976 //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 36:2e344db70d35 977 //sprintf(filename, "/sd/UPAS_TboardtestLog_%s.txt", timestr);
caseyquinn 36:2e344db70d35 978 FILE *fp = fopen(filename, "w");
caseyquinn 36:2e344db70d35 979 fclose(fp);
caseyquinn 36:2e344db70d35 980 /*
caseyquinn 36:2e344db70d35 981 while(!gpsFix){
caseyquinn 36:2e344db70d35 982 gpsFix = gps.read(1);
caseyquinn 36:2e344db70d35 983 if(ledOn) {
caseyquinn 36:2e344db70d35 984 RGB_LED.set_led(0,0,0);
caseyquinn 36:2e344db70d35 985 ledOn = 0;
caseyquinn 36:2e344db70d35 986 }else {
caseyquinn 36:2e344db70d35 987 RGB_LED.set_led(1,0,0);
caseyquinn 36:2e344db70d35 988 ledOn = 1;
caseyquinn 36:2e344db70d35 989 }
caseyquinn 36:2e344db70d35 990 wait(1);
caseyquinn 36:2e344db70d35 991 }
caseyquinn 36:2e344db70d35 992 */
caseyquinn 36:2e344db70d35 993
caseyquinn 36:2e344db70d35 994
caseyquinn 36:2e344db70d35 995
caseyquinn 36:2e344db70d35 996 //!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!
caseyquinn 36:2e344db70d35 997 //UPDATE THIS TO WORK WITH ST RTC INSTEAD
caseyquinn 36:2e344db70d35 998 //!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!
caseyquinn 36:2e344db70d35 999 /*
caseyquinn 36:2e344db70d35 1000 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
caseyquinn 36:2e344db70d35 1001 wait(0.5);
caseyquinn 36:2e344db70d35 1002
caseyquinn 36:2e344db70d35 1003 RTC_UPAS.get_time();
caseyquinn 36:2e344db70d35 1004
caseyquinn 36:2e344db70d35 1005 }
caseyquinn 36:2e344db70d35 1006 */
caseyquinn 36:2e344db70d35 1007
caseyquinn 36:2e344db70d35 1008 schoolF1.getFault();
caseyquinn 36:2e344db70d35 1009 homeF2.getFault();
caseyquinn 36:2e344db70d35 1010 transitF3.getFault();
caseyquinn 36:2e344db70d35 1011 blankF4.getFault();
caseyquinn 36:2e344db70d35 1012
caseyquinn 36:2e344db70d35 1013 schoolF1.drive(254); //closed = 253, open = 254
caseyquinn 36:2e344db70d35 1014 homeF2.drive(253); //closed = 253, open = 254
caseyquinn 36:2e344db70d35 1015 transitF3.drive(253); //closed = 253, open = 254
caseyquinn 36:2e344db70d35 1016 blankF4.drive(253); //closed = 253, open = 254
caseyquinn 36:2e344db70d35 1017
caseyquinn 36:2e344db70d35 1018 wait(1);
caseyquinn 36:2e344db70d35 1019 schoolF1.stop();
caseyquinn 36:2e344db70d35 1020 homeF2.stop();
caseyquinn 36:2e344db70d35 1021 transitF3.stop();
caseyquinn 36:2e344db70d35 1022 blankF4.stop();
caseyquinn 36:2e344db70d35 1023
caseyquinn 36:2e344db70d35 1024 RGB_LED.set_led(1,0,1);
caseyquinn 36:2e344db70d35 1025
jelord 3:122bfc998c4c 1026 if(volflowSet<=1.0) {
jelord 3:122bfc998c4c 1027 gainFlow = 100;
jelord 3:122bfc998c4c 1028 } else if(volflowSet>=2.0) {
jelord 3:122bfc998c4c 1029 gainFlow = 25;
jelord 3:122bfc998c4c 1030 } else {
jelord 3:122bfc998c4c 1031 gainFlow = 25;
jelord 0:2cb2b2ea316f 1032 }
caseyquinn 36:2e344db70d35 1033
jelord 3:122bfc998c4c 1034 press = bmesensor.getPressure();
jelord 3:122bfc998c4c 1035 temp = bmesensor.getTemperature();
jelord 3:122bfc998c4c 1036 rh = bmesensor.getHumidity();
jelord 3:122bfc998c4c 1037
jelord 3:122bfc998c4c 1038 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 1039 massflowSet = volflowSet*atmoRho;
jelord 3:122bfc998c4c 1040
jelord 3:122bfc998c4c 1041 DigPot.writeRegister(digital_pot_setpoint);
jelord 3:122bfc998c4c 1042 wait(1);
caseyquinn 28:42932d3b105d 1043 pumps = 1;
caseyquinn 25:fbf7d44e7da4 1044 //pumpOn = 1;
jelord 3:122bfc998c4c 1045
caseyquinn 35:e0bdd6389a75 1046
caseyquinn 29:fd74725294d5 1047 if(volflowSet<=1.0) {
caseyquinn 29:fd74725294d5 1048 gainFlow = 100;
caseyquinn 29:fd74725294d5 1049 } else if(volflowSet>=2.0) {
caseyquinn 29:fd74725294d5 1050 gainFlow = 25;
caseyquinn 29:fd74725294d5 1051 } else {
caseyquinn 29:fd74725294d5 1052 gainFlow = 25;
caseyquinn 29:fd74725294d5 1053 }
caseyquinn 29:fd74725294d5 1054
caseyquinn 29:fd74725294d5 1055 RGB_LED.set_led(1,0,0);
caseyquinn 29:fd74725294d5 1056 press = bmesensor.getPressure();
caseyquinn 29:fd74725294d5 1057 temp = bmesensor.getTemperature();
caseyquinn 29:fd74725294d5 1058 rh = bmesensor.getHumidity();
caseyquinn 29:fd74725294d5 1059
caseyquinn 29:fd74725294d5 1060 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 29:fd74725294d5 1061 massflowSet = volflowSet*atmoRho;
caseyquinn 29:fd74725294d5 1062
caseyquinn 29:fd74725294d5 1063 //Digtal pot tf from file: UPAS v2 OSU-PrimaryFlowData FullSet 2015-05-29 CQ mods.xlsx
caseyquinn 29:fd74725294d5 1064 digital_pot_setpoint = (int)floor(calibrations.DP4*pow(massflowSet,4)+calibrations.DP3*pow(massflowSet,3)+calibrations.DP2*pow(massflowSet,2)+calibrations.DP1*massflowSet+calibrations.DP0); //min = 0x7F, max = 0x00
caseyquinn 29:fd74725294d5 1065
caseyquinn 29:fd74725294d5 1066 if(digital_pot_setpoint>=digitalpotMax) {
caseyquinn 29:fd74725294d5 1067 digital_pot_setpoint = digitalpotMax;
caseyquinn 29:fd74725294d5 1068 } else if(digital_pot_setpoint<=digitalpotMin) {
caseyquinn 29:fd74725294d5 1069 digital_pot_setpoint = digitalpotMin;
caseyquinn 29:fd74725294d5 1070 }
caseyquinn 29:fd74725294d5 1071
caseyquinn 29:fd74725294d5 1072 pc.printf("%d\r\n", digital_pot_setpoint);
caseyquinn 29:fd74725294d5 1073 DigPot.writeRegister(digital_pot_setpoint);
caseyquinn 29:fd74725294d5 1074 wait(1);
caseyquinn 35:e0bdd6389a75 1075 pumps = 1;
caseyquinn 35:e0bdd6389a75 1076
jelord 3:122bfc998c4c 1077
caseyquinn 25:fbf7d44e7da4 1078
caseyquinn 34:da333abe3476 1079 omronReading = ads.readADC_SingleEnded(0, 0xC383); // read channel 0 PGA = 2 : Full Scale Range = 2.048V
caseyquinn 34:da333abe3476 1080 omronVolt = (omronReading*4.096)/(32768*1);
caseyquinn 12:5b4f3245606a 1081 if(omronVolt<=calibrations.omronVMin) {
caseyquinn 12:5b4f3245606a 1082 massflow = calibrations.omronMFMin;
caseyquinn 12:5b4f3245606a 1083 } else if(omronVolt>=calibrations.omronVMax) {
caseyquinn 12:5b4f3245606a 1084 massflow = calibrations.omronMFMax;
caseyquinn 12:5b4f3245606a 1085 } else {
caseyquinn 12:5b4f3245606a 1086 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 1087 }
caseyquinn 12:5b4f3245606a 1088 deltaMflow = massflow-massflowSet;
caseyquinn 12:5b4f3245606a 1089 digital_pot_set = digital_pot_setpoint;
caseyquinn 12:5b4f3245606a 1090 wait(5);
caseyquinn 12:5b4f3245606a 1091
caseyquinn 12:5b4f3245606a 1092 //---------------------------------------------------------------------------------------------//
caseyquinn 12:5b4f3245606a 1093 //Sets the flow withen +-1.5% of the desired flow rate based on mass flow
caseyquinn 35:e0bdd6389a75 1094
caseyquinn 12:5b4f3245606a 1095 while(abs(deltaMflow)>.025) {
caseyquinn 12:5b4f3245606a 1096
caseyquinn 34:da333abe3476 1097 omronReading = ads.readADC_SingleEnded(0, 0xC383); // read channel 0 PGA = 2 : Full Scale Range = 2.048V
caseyquinn 34:da333abe3476 1098 omronVolt = (omronReading*4.096)/(32768*1);
caseyquinn 36:2e344db70d35 1099 pc.printf("%d,%f\r\n", omronReading, omronVolt);
caseyquinn 12:5b4f3245606a 1100 //Mass Flow tf from file: UPAS v2 OSU-PrimaryFlowData FullSet 2015-05-29 CQ mods.xlsx
caseyquinn 12:5b4f3245606a 1101 if(omronVolt<=calibrations.omronVMin) {
caseyquinn 12:5b4f3245606a 1102 massflow = calibrations.omronMFMin;
caseyquinn 12:5b4f3245606a 1103 } else if(omronVolt>=calibrations.omronVMax) {
caseyquinn 12:5b4f3245606a 1104 massflow = calibrations.omronMFMax;
caseyquinn 12:5b4f3245606a 1105 } else {
caseyquinn 12:5b4f3245606a 1106 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 1107 }
caseyquinn 12:5b4f3245606a 1108
caseyquinn 12:5b4f3245606a 1109 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 1110 volflow = massflow/atmoRho;
caseyquinn 36:2e344db70d35 1111 pc.printf("%f\r\n", volflow);
caseyquinn 12:5b4f3245606a 1112 massflowSet = volflowSet*atmoRho;
caseyquinn 12:5b4f3245606a 1113 deltaMflow = massflow-massflowSet;
caseyquinn 12:5b4f3245606a 1114
caseyquinn 12:5b4f3245606a 1115 digital_pot_set = (int)(digital_pot_set+(int)((gainFlow*deltaMflow)));
caseyquinn 12:5b4f3245606a 1116 if(digital_pot_set>=digitalpotMax) {
caseyquinn 12:5b4f3245606a 1117 digital_pot_set = digitalpotMax;
caseyquinn 12:5b4f3245606a 1118 } else if(digital_pot_set<=digitalpotMin) {
caseyquinn 12:5b4f3245606a 1119 digital_pot_set = digitalpotMin;
caseyquinn 12:5b4f3245606a 1120 }
caseyquinn 12:5b4f3245606a 1121
caseyquinn 12:5b4f3245606a 1122 wait(2);
caseyquinn 12:5b4f3245606a 1123 DigPot.writeRegister(digital_pot_set);
caseyquinn 12:5b4f3245606a 1124 pc.printf("%d,\r\n", digital_pot_set);
caseyquinn 12:5b4f3245606a 1125 wait(1);
caseyquinn 12:5b4f3245606a 1126
caseyquinn 12:5b4f3245606a 1127
caseyquinn 12:5b4f3245606a 1128 }
caseyquinn 36:2e344db70d35 1129 //pumps = 0;
jelord 3:122bfc998c4c 1130 sampledVol = 0.0;
jelord 3:122bfc998c4c 1131 RGB_LED.set_led(0,1,0);
caseyquinn 25:fbf7d44e7da4 1132 wait(1);
caseyquinn 25:fbf7d44e7da4 1133 RGB_LED.set_led(0,0,0);
caseyquinn 14:7cdb643da356 1134
caseyquinn 36:2e344db70d35 1135 //stop.attach(&check_stop, 9); // check if we should shut down every 9 number seconds, starting after the start.
caseyquinn 14:7cdb643da356 1136 logg.attach(&log_data, logInerval);
caseyquinn 35:e0bdd6389a75 1137 flowCtl.attach(&flowControl, 3);
caseyquinn 30:aa6324845a84 1138
caseyquinn 35:e0bdd6389a75 1139
caseyquinn 35:e0bdd6389a75 1140
caseyquinn 30:aa6324845a84 1141
caseyquinn 29:fd74725294d5 1142 /*
caseyquinn 29:fd74725294d5 1143 wait(60);
caseyquinn 29:fd74725294d5 1144
caseyquinn 29:fd74725294d5 1145 schoolF1.getFault();
caseyquinn 29:fd74725294d5 1146 homeF2.getFault();
caseyquinn 29:fd74725294d5 1147 transitF3.getFault();
caseyquinn 29:fd74725294d5 1148 blankF4.getFault();
caseyquinn 29:fd74725294d5 1149
caseyquinn 29:fd74725294d5 1150 schoolF1.drive(254); //closed = 253, open = 254
caseyquinn 29:fd74725294d5 1151 homeF2.drive(253); //closed = 253, open = 254
caseyquinn 29:fd74725294d5 1152 transitF3.drive(253); //closed = 253, open = 254
caseyquinn 29:fd74725294d5 1153 blankF4.drive(253); //closed = 253, open = 254
caseyquinn 29:fd74725294d5 1154
caseyquinn 29:fd74725294d5 1155 wait(1);
caseyquinn 29:fd74725294d5 1156 schoolF1.stop();
caseyquinn 29:fd74725294d5 1157 homeF2.stop();
caseyquinn 29:fd74725294d5 1158 transitF3.stop();
caseyquinn 29:fd74725294d5 1159 blankF4.stop();
caseyquinn 7:29b01d5812ee 1160
jelord 3:122bfc998c4c 1161
caseyquinn 29:fd74725294d5 1162 wait(60);
caseyquinn 29:fd74725294d5 1163
caseyquinn 29:fd74725294d5 1164 schoolF1.getFault();
caseyquinn 29:fd74725294d5 1165 homeF2.getFault();
caseyquinn 29:fd74725294d5 1166 transitF3.getFault();
caseyquinn 29:fd74725294d5 1167 blankF4.getFault();
caseyquinn 29:fd74725294d5 1168
caseyquinn 29:fd74725294d5 1169 schoolF1.drive(253); //closed = 253, open = 254
caseyquinn 29:fd74725294d5 1170 homeF2.drive(254); //closed = 253, open = 254
caseyquinn 29:fd74725294d5 1171 transitF3.drive(253); //closed = 253, open = 254
caseyquinn 29:fd74725294d5 1172 blankF4.drive(253); //closed = 253, open = 254
caseyquinn 29:fd74725294d5 1173
caseyquinn 29:fd74725294d5 1174 wait(1);
caseyquinn 29:fd74725294d5 1175 schoolF1.stop();
caseyquinn 29:fd74725294d5 1176 homeF2.stop();
caseyquinn 29:fd74725294d5 1177 transitF3.stop();
caseyquinn 29:fd74725294d5 1178 blankF4.stop();
caseyquinn 29:fd74725294d5 1179
caseyquinn 29:fd74725294d5 1180 wait(60);
caseyquinn 29:fd74725294d5 1181
caseyquinn 29:fd74725294d5 1182 schoolF1.getFault();
caseyquinn 29:fd74725294d5 1183 homeF2.getFault();
caseyquinn 29:fd74725294d5 1184 transitF3.getFault();
caseyquinn 29:fd74725294d5 1185 blankF4.getFault();
caseyquinn 29:fd74725294d5 1186
caseyquinn 29:fd74725294d5 1187 schoolF1.drive(253); //closed = 253, open = 254
caseyquinn 29:fd74725294d5 1188 homeF2.drive(253); //closed = 253, open = 254
caseyquinn 29:fd74725294d5 1189 transitF3.drive(254); //closed = 253, open = 254
caseyquinn 29:fd74725294d5 1190 blankF4.drive(253); //closed = 253, open = 254
caseyquinn 29:fd74725294d5 1191
caseyquinn 29:fd74725294d5 1192 wait(1);
caseyquinn 29:fd74725294d5 1193 schoolF1.stop();
caseyquinn 29:fd74725294d5 1194 homeF2.stop();
caseyquinn 29:fd74725294d5 1195 transitF3.stop();
caseyquinn 29:fd74725294d5 1196 blankF4.stop();
caseyquinn 29:fd74725294d5 1197
caseyquinn 29:fd74725294d5 1198 wait(60);
caseyquinn 29:fd74725294d5 1199
caseyquinn 29:fd74725294d5 1200 schoolF1.getFault();
caseyquinn 29:fd74725294d5 1201 homeF2.getFault();
caseyquinn 29:fd74725294d5 1202 transitF3.getFault();
caseyquinn 29:fd74725294d5 1203 blankF4.getFault();
caseyquinn 29:fd74725294d5 1204
caseyquinn 29:fd74725294d5 1205 schoolF1.drive(253); //closed = 253, open = 254
caseyquinn 29:fd74725294d5 1206 homeF2.drive(253); //closed = 253, open = 254
caseyquinn 29:fd74725294d5 1207 transitF3.drive(253); //closed = 253, open = 254
caseyquinn 29:fd74725294d5 1208 blankF4.drive(254); //closed = 253, open = 254
caseyquinn 29:fd74725294d5 1209
caseyquinn 29:fd74725294d5 1210 wait(1);
caseyquinn 29:fd74725294d5 1211 schoolF1.stop();
caseyquinn 29:fd74725294d5 1212 homeF2.stop();
caseyquinn 29:fd74725294d5 1213 transitF3.stop();
caseyquinn 29:fd74725294d5 1214 blankF4.stop();
caseyquinn 29:fd74725294d5 1215 */
caseyquinn 29:fd74725294d5 1216
jelord 3:122bfc998c4c 1217 //** end of initalization **//
jelord 3:122bfc998c4c 1218 //---------------------------------------------------------------------------------------------//
jelord 3:122bfc998c4c 1219 //---------------------------------------------------------------------------------------------//
jelord 3:122bfc998c4c 1220 // Main Control Loop
jelord 3:122bfc998c4c 1221
caseyquinn 7:29b01d5812ee 1222 while (1) {
caseyquinn 7:29b01d5812ee 1223 // Do other things...
caseyquinn 14:7cdb643da356 1224 /*
caseyquinn 18:41ef98db0423 1225 pumps = 1;
caseyquinn 13:455601f62aad 1226 wait(5);
caseyquinn 18:41ef98db0423 1227 pumps = 0;
caseyquinn 13:455601f62aad 1228 wait(5);
caseyquinn 14:7cdb643da356 1229 */
caseyquinn 7:29b01d5812ee 1230 }
caseyquinn 7:29b01d5812ee 1231
caseyquinn 8:c4a8f9b67cee 1232
caseyquinn 4:5d004fd997d5 1233
jelord 3:122bfc998c4c 1234
jelord 0:2cb2b2ea316f 1235 }