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