Code supports writing to the SD card as well as working with the Volckens group smartphone apps for the mbed HRM1017

Dependencies:   ADS1115 BLE_API BME280 Calibration CronoDot EEPROM LSM303 MCP40D17 NCP5623BMUTBG SDFileSystem SI1145 STC3100 mbed nRF51822

Fork of UPAS_BLE_and_USB by Volckens Group Sensors

Committer:
joshuasmth04
Date:
Thu Sep 24 19:45:17 2015 +0000
Revision:
89:047e8558fd09
Parent:
88:9142f21a4715
Child:
90:26a08de1a0ac
Changed program flow after opening admen menu to restart if any of the program flow settings have changed. Also opening the admen menu now counts as opening the menu in general.

Who changed what in which revision?

UserRevisionLine numberNew contents of line
caseyquinn 0:14d46ef4b6cb 1 #include "mbed.h"
caseyquinn 0:14d46ef4b6cb 2 #include "SDFileSystem.h"
caseyquinn 0:14d46ef4b6cb 3 #include "Adafruit_ADS1015.h"
caseyquinn 1:37babeb68ab9 4 #include "MCP40D17.h"
caseyquinn 7:a24d7156bc02 5 #include "STC3100.h"
caseyquinn 10:f9cb61b29340 6 #include "LSM303.h"
caseyquinn 12:8c00a7f5d483 7 #include "BME280.h"
caseyquinn 14:ad550174db8b 8 #include "SI1145.h"
joshuasmth04 40:ef7e1dcb3780 9 #include "NCP5623BMUTBG.h"
joshuasmth04 41:1fb3e0ac6f87 10 #include "CronoDot.h"
caseyquinn 56:c4d6bdd7c3fb 11 #include "EEPROM.h"
joshuasmth04 72:0b36575ab00d 12 #include "US_Menu.h"
joshuasmth04 77:24fbeb2bfe05 13 #include "BLEDevice.h"
joshuasmth04 71:78edbceff4fc 14 #include "BLE_Menu.h"
joshuasmth04 77:24fbeb2bfe05 15 #include "Calibration.h"
joshuasmth04 71:78edbceff4fc 16
joshuasmth04 71:78edbceff4fc 17 #define BLE_UUID_TXRX_SERVICE 0x0000 /**< The UUID of the Nordic UART Service. */
joshuasmth04 71:78edbceff4fc 18 #define BLE_UUID_TX_CHARACTERISTIC 0x0002 /**< The UUID of the TX Characteristic. */
joshuasmth04 71:78edbceff4fc 19 #define BLE_UUIDS_RX_CHARACTERISTIC 0x0003 /**< The UUID of the RX Characteristic. */
caseyquinn 1:37babeb68ab9 20
caseyquinn 1:37babeb68ab9 21 #define SERIAL_BAUD_RATE 9600
joshuasmth04 41:1fb3e0ac6f87 22 #define SCL 20
caseyquinn 7:a24d7156bc02 23 #define SDA 22
caseyquinn 81:480f0310ef9a 24
caseyquinn 0:14d46ef4b6cb 25
joshuasmth04 71:78edbceff4fc 26 uint8_t txPayload[TXRX_BUF_LEN] = {0,};
joshuasmth04 71:78edbceff4fc 27 uint8_t rxPayload[TXRX_BUF_LEN] = {0,};
joshuasmth04 71:78edbceff4fc 28
joshuasmth04 71:78edbceff4fc 29 static const uint8_t uart_base_uuid[] = {0x71, 0x3D, 0, 0, 0x50, 0x3E, 0x4C, 0x75, 0xBA, 0x94, 0x31, 0x48, 0xF1, 0x8D, 0x94, 0x1E};
joshuasmth04 71:78edbceff4fc 30 static const uint8_t uart_tx_uuid[] = {0x71, 0x3D, 0, 3, 0x50, 0x3E, 0x4C, 0x75, 0xBA, 0x94, 0x31, 0x48, 0xF1, 0x8D, 0x94, 0x1E};
joshuasmth04 71:78edbceff4fc 31 static const uint8_t uart_rx_uuid[] = {0x71, 0x3D, 0, 2, 0x50, 0x3E, 0x4C, 0x75, 0xBA, 0x94, 0x31, 0x48, 0xF1, 0x8D, 0x94, 0x1E};
joshuasmth04 71:78edbceff4fc 32 static const uint8_t uart_base_uuid_rev[] = {0x1E, 0x94, 0x8D, 0xF1, 0x48, 0x31, 0x94, 0xBA, 0x75, 0x4C, 0x3E, 0x50, 0, 0, 0x3D, 0x71};
joshuasmth04 71:78edbceff4fc 33
joshuasmth04 71:78edbceff4fc 34 GattCharacteristic txCharacteristic (uart_tx_uuid, txPayload, 1, TXRX_BUF_LEN, GattCharacteristic::BLE_GATT_CHAR_PROPERTIES_WRITE | GattCharacteristic::BLE_GATT_CHAR_PROPERTIES_WRITE_WITHOUT_RESPONSE);
joshuasmth04 71:78edbceff4fc 35 GattCharacteristic rxCharacteristic (uart_rx_uuid, rxPayload, 1, TXRX_BUF_LEN, GattCharacteristic::BLE_GATT_CHAR_PROPERTIES_NOTIFY);
joshuasmth04 71:78edbceff4fc 36 GattCharacteristic *uartChars[] = {&txCharacteristic, &rxCharacteristic};
joshuasmth04 71:78edbceff4fc 37 GattService uartService(uart_base_uuid, uartChars, sizeof(uartChars) / sizeof(GattCharacteristic *));
joshuasmth04 71:78edbceff4fc 38
joshuasmth04 71:78edbceff4fc 39 BLEDevice ble;
joshuasmth04 71:78edbceff4fc 40 BLE_Menu bleMenu(ble, txPayload, rxPayload, uart_base_uuid_rev, uart_base_uuid, uartService);
joshuasmth04 71:78edbceff4fc 41
joshuasmth04 72:0b36575ab00d 42 I2C i2c(p22, p20);
joshuasmth04 72:0b36575ab00d 43 Adafruit_ADS1115 ads(&i2c);
joshuasmth04 72:0b36575ab00d 44 MCP40D17 DigPot(&i2c);
joshuasmth04 72:0b36575ab00d 45 BME280 bmesensor(p22, p20);
joshuasmth04 72:0b36575ab00d 46 STC3100 gasG(p22, p20);
joshuasmth04 72:0b36575ab00d 47 Serial pc(USBTX, USBRX);
joshuasmth04 72:0b36575ab00d 48 DigitalOut blower(p29, 0);
joshuasmth04 72:0b36575ab00d 49 DigitalOut pbKill(p18, 1);
joshuasmth04 72:0b36575ab00d 50 LSM303 movementsensor(p22, p20);
joshuasmth04 72:0b36575ab00d 51 SI1145 lightsensor(p22, p20);
joshuasmth04 72:0b36575ab00d 52 NCP5623BMUTBG RGB_LED(p22, p20);
joshuasmth04 72:0b36575ab00d 53 CronoDot RTC(p22, p20);
joshuasmth04 72:0b36575ab00d 54 EEPROM E2PROM(p22, p20);
joshuasmth04 72:0b36575ab00d 55 US_Menu Menu;
joshuasmth04 77:24fbeb2bfe05 56 DigitalOut GPS_EN(p4,0); //pin 4 is used to enable and disable the GPS, in order to recive serial communications
joshuasmth04 77:24fbeb2bfe05 57 Calibration calibrations(1); //Default serial/calibration if there are no values for the selected option
caseyquinn 57:0b554f7aa9a3 58
caseyquinn 57:0b554f7aa9a3 59 Timeout stop; //This is the stop call back object
joshuasmth04 77:24fbeb2bfe05 60 Timeout logg; //This is the logging call back object
caseyquinn 67:300418575137 61
joshuasmth04 77:24fbeb2bfe05 62 uint16_t serial_num = 1; // Default serial/calibration number
joshuasmth04 77:24fbeb2bfe05 63 int RunReady =0;
caseyquinn 70:81f04e69e08a 64
caseyquinn 70:81f04e69e08a 65
caseyquinn 20:ad9883973d86 66 float press;
caseyquinn 20:ad9883973d86 67 float temp;
caseyquinn 20:ad9883973d86 68 float rh;
caseyquinn 4:69bd7e8a994c 69
caseyquinn 20:ad9883973d86 70 int uv;
caseyquinn 20:ad9883973d86 71 int vis;
caseyquinn 20:ad9883973d86 72 int ir;
caseyquinn 8:204c21adf693 73
caseyquinn 67:300418575137 74 float compass;
caseyquinn 10:f9cb61b29340 75 float accel_x;
caseyquinn 10:f9cb61b29340 76 float accel_y;
caseyquinn 10:f9cb61b29340 77 float accel_z;
lionberg 52:80480b2fafba 78 float accel_comp;
caseyquinn 10:f9cb61b29340 79 float mag_x;
caseyquinn 10:f9cb61b29340 80 float mag_y;
caseyquinn 10:f9cb61b29340 81 float mag_z;
caseyquinn 10:f9cb61b29340 82
caseyquinn 0:14d46ef4b6cb 83 int vInReading;
caseyquinn 0:14d46ef4b6cb 84 int vBlowerReading;
caseyquinn 0:14d46ef4b6cb 85 int omronDiff;
lionberg 52:80480b2fafba 86 float omronVolt; //V
caseyquinn 20:ad9883973d86 87 int omronReading;
lionberg 52:80480b2fafba 88 float atmoRho; //g/L
caseyquinn 49:19e828650618 89
caseyquinn 20:ad9883973d86 90 float massflow; //g/min
caseyquinn 20:ad9883973d86 91 float volflow; //L/min
caseyquinn 67:300418575137 92 float volflowSet = 1.0; //L/min
caseyquinn 81:480f0310ef9a 93 int logInerval = 10; //seconds
caseyquinn 57:0b554f7aa9a3 94 double secondsD = 0;
joshuasmth04 41:1fb3e0ac6f87 95 float massflowSet;
caseyquinn 42:fc2f2b9f07ae 96 float deltaVflow = 0.0;
caseyquinn 42:fc2f2b9f07ae 97 float deltaMflow = 0.0;
caseyquinn 47:3146e8c949a9 98 float gainFlow;
lionberg 52:80480b2fafba 99 float sampledVol; //L, total sampled volume
caseyquinn 20:ad9883973d86 100
caseyquinn 55:f24d70f519cd 101 int digital_pot_setpoint; //min = 0x7F, max = 0x00
caseyquinn 55:f24d70f519cd 102 int digital_pot_set;
caseyquinn 55:f24d70f519cd 103 int digital_pot_change;
caseyquinn 55:f24d70f519cd 104 int digitalpotMax = 127;
caseyquinn 55:f24d70f519cd 105 int digitalpotMin = 2;
caseyquinn 55:f24d70f519cd 106
joshuasmth04 59:a9b21b3d9afc 107 int dutyUp;
joshuasmth04 59:a9b21b3d9afc 108 int dutyDown;
joshuasmth04 59:a9b21b3d9afc 109
joshuasmth04 72:0b36575ab00d 110 // variables are only place holders for the US_Menu //
joshuasmth04 72:0b36575ab00d 111 int refreshtime;
joshuasmth04 72:0b36575ab00d 112 float home_lat, home_lon, work_lat, work_lon;
joshuasmth04 77:24fbeb2bfe05 113 //*************************************************//
joshuasmth04 72:0b36575ab00d 114
caseyquinn 67:300418575137 115 //int refresh_Time = 10; // refresh time in s, note calling read_GPS()(or similar) will still take how ever long it needs(hopefully < 1s)
caseyquinn 42:fc2f2b9f07ae 116
caseyquinn 57:0b554f7aa9a3 117 char device_name[] = "---------------";
caseyquinn 81:480f0310ef9a 118 char filename[] = "/sd/XXXX0000LOG000000000000---------------.txt";
caseyquinn 7:a24d7156bc02 119 SDFileSystem sd(SPIS_PSELMOSI, SPIS_PSELMISO, SPIS_PSELSCK, SPIS_PSELSS, "sd"); // I believe this matches Todd's pinout, let me know if this doesn't work. (p12, p13, p15, p14)
caseyquinn 7:a24d7156bc02 120
caseyquinn 7:a24d7156bc02 121
joshuasmth04 71:78edbceff4fc 122 void disconnectionCallback(Gap::Handle_t handle, Gap::DisconnectionReason_t reason)
joshuasmth04 71:78edbceff4fc 123 {
joshuasmth04 71:78edbceff4fc 124 bleMenu.disconnectionCallback();
joshuasmth04 71:78edbceff4fc 125 }
joshuasmth04 71:78edbceff4fc 126
joshuasmth04 71:78edbceff4fc 127 void WrittenHandler(const GattCharacteristicWriteCBParams *Handler) // called any time the phone sends a message
joshuasmth04 71:78edbceff4fc 128 {
joshuasmth04 71:78edbceff4fc 129 bleMenu.WrittenHandler(pc, txPayload, txCharacteristic, Handler);
joshuasmth04 71:78edbceff4fc 130 //returns things to the txPayload
joshuasmth04 71:78edbceff4fc 131 }
joshuasmth04 71:78edbceff4fc 132
joshuasmth04 62:edc9632bcc43 133 void check_stop() // this checks if it's time to stop and shutdown
caseyquinn 57:0b554f7aa9a3 134 {
joshuasmth04 86:60c9ec6e48ed 135 //RTC.get_time(); //debug
joshuasmth04 86:60c9ec6e48ed 136 //pc.printf("%02d:%02d:%02d on %d/%d/%d) \r\n",RTC.hour, RTC.minutes, RTC.seconds, RTC.month, RTC.date, RTC.year);//debug
joshuasmth04 85:a95dd5f03818 137 if(RTC.compare(Menu.f_sec, Menu.f_min, Menu.f_hour, Menu.f_day, Menu.f_month, Menu.f_year)) {
caseyquinn 57:0b554f7aa9a3 138 pbKill = 0; // this is were we shut everything down
caseyquinn 57:0b554f7aa9a3 139 }
caseyquinn 57:0b554f7aa9a3 140 stop.detach();
joshuasmth04 77:24fbeb2bfe05 141 stop.attach(&check_stop, 9);
joshuasmth04 62:edc9632bcc43 142 }
caseyquinn 58:7239c2ab2b65 143
joshuasmth04 41:1fb3e0ac6f87 144
caseyquinn 57:0b554f7aa9a3 145 void log_data()
joshuasmth04 59:a9b21b3d9afc 146 {
caseyquinn 70:81f04e69e08a 147 logg.detach();
caseyquinn 70:81f04e69e08a 148 logg.attach(&log_data, logInerval);
joshuasmth04 59:a9b21b3d9afc 149 RTC.get_time();
caseyquinn 70:81f04e69e08a 150 secondsD = RTC.seconds;
joshuasmth04 77:24fbeb2bfe05 151 while(fmod(secondsD,logInerval)!=0) {
caseyquinn 70:81f04e69e08a 152 RTC.get_time();
caseyquinn 70:81f04e69e08a 153 secondsD = RTC.seconds;
joshuasmth04 77:24fbeb2bfe05 154 }
joshuasmth04 77:24fbeb2bfe05 155
joshuasmth04 59:a9b21b3d9afc 156 omronReading = ads.readADC_SingleEnded(0, 0xC583); // read channel 0 PGA = 2 : Full Scale Range = 2.048V
joshuasmth04 59:a9b21b3d9afc 157 omronVolt = (omronReading*4.096)/(32768*2);
joshuasmth04 59:a9b21b3d9afc 158
joshuasmth04 77:24fbeb2bfe05 159 if(omronVolt<=calibrations.omronVMin) {
joshuasmth04 77:24fbeb2bfe05 160 massflow = calibrations.omronMFMin;
joshuasmth04 77:24fbeb2bfe05 161 } else if(omronVolt>=calibrations.omronVMax) {
joshuasmth04 77:24fbeb2bfe05 162 massflow = calibrations.omronMFMax;
joshuasmth04 59:a9b21b3d9afc 163 } else {
joshuasmth04 77:24fbeb2bfe05 164 massflow = calibrations.MF4*pow(omronVolt,(float)4)+calibrations.MF3*pow(omronVolt,(float)3)+calibrations.MF2*pow(omronVolt,(float)2)+calibrations.MF1*omronVolt+calibrations.MF0;
joshuasmth04 59:a9b21b3d9afc 165 }
joshuasmth04 59:a9b21b3d9afc 166
joshuasmth04 59:a9b21b3d9afc 167 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));
joshuasmth04 59:a9b21b3d9afc 168 volflow = massflow/atmoRho;
joshuasmth04 59:a9b21b3d9afc 169 sampledVol = sampledVol + ((((float)logInerval)/60.0)*volflow);
joshuasmth04 59:a9b21b3d9afc 170 deltaVflow = volflow-volflowSet;
joshuasmth04 59:a9b21b3d9afc 171 massflowSet = volflowSet*atmoRho;
joshuasmth04 59:a9b21b3d9afc 172 deltaMflow = massflow-massflowSet;
joshuasmth04 59:a9b21b3d9afc 173
joshuasmth04 59:a9b21b3d9afc 174 if(abs(deltaMflow)>.025) {
joshuasmth04 59:a9b21b3d9afc 175 digital_pot_change = (int)(gainFlow*deltaMflow);
joshuasmth04 59:a9b21b3d9afc 176
joshuasmth04 59:a9b21b3d9afc 177
joshuasmth04 59:a9b21b3d9afc 178 if(abs(digital_pot_change)>=50) {
joshuasmth04 59:a9b21b3d9afc 179 digital_pot_set = (int)(digital_pot_set+(int)((10.0*deltaMflow)));
joshuasmth04 59:a9b21b3d9afc 180 RGB_LED.set_led(1,0,0);
joshuasmth04 41:1fb3e0ac6f87 181
joshuasmth04 59:a9b21b3d9afc 182 } else if(digital_pot_change+digital_pot_set>=digitalpotMax&abs(digital_pot_change)<50) {
joshuasmth04 59:a9b21b3d9afc 183 digital_pot_set = digitalpotMax;
joshuasmth04 59:a9b21b3d9afc 184 RGB_LED.set_led(1,0,0);
joshuasmth04 59:a9b21b3d9afc 185 } else if(digital_pot_change+digital_pot_set<=digitalpotMin&abs(digital_pot_change)<50) {
joshuasmth04 59:a9b21b3d9afc 186 digital_pot_set = digitalpotMin;
joshuasmth04 59:a9b21b3d9afc 187 RGB_LED.set_led(1,0,0);
joshuasmth04 59:a9b21b3d9afc 188 } else {
joshuasmth04 59:a9b21b3d9afc 189 digital_pot_set = (digital_pot_set+ digital_pot_change);
joshuasmth04 59:a9b21b3d9afc 190 RGB_LED.set_led(1,1,0);
joshuasmth04 59:a9b21b3d9afc 191 }
joshuasmth04 59:a9b21b3d9afc 192
joshuasmth04 59:a9b21b3d9afc 193 DigPot.writeRegister(digital_pot_set);
joshuasmth04 59:a9b21b3d9afc 194
joshuasmth04 59:a9b21b3d9afc 195 } else {
joshuasmth04 59:a9b21b3d9afc 196 RGB_LED.set_led(0,1,0);
joshuasmth04 59:a9b21b3d9afc 197 }
joshuasmth04 59:a9b21b3d9afc 198
joshuasmth04 59:a9b21b3d9afc 199 movementsensor.getACCEL();
joshuasmth04 59:a9b21b3d9afc 200 movementsensor.getCOMPASS();
caseyquinn 67:300418575137 201 compass = movementsensor.getCOMPASS_HEADING();
joshuasmth04 59:a9b21b3d9afc 202 accel_x = movementsensor.AccelData.x;
joshuasmth04 59:a9b21b3d9afc 203 accel_y = movementsensor.AccelData.y;
joshuasmth04 59:a9b21b3d9afc 204 accel_z = movementsensor.AccelData.z;
joshuasmth04 59:a9b21b3d9afc 205 accel_comp = pow(accel_x,(float)2)+pow(accel_y,(float)2)+pow(accel_z,(float)2)-1.0;
joshuasmth04 59:a9b21b3d9afc 206 mag_x = movementsensor.MagData.x;
joshuasmth04 59:a9b21b3d9afc 207 mag_y = movementsensor.MagData.y;
joshuasmth04 59:a9b21b3d9afc 208 mag_z = movementsensor.MagData.z;
joshuasmth04 59:a9b21b3d9afc 209
joshuasmth04 59:a9b21b3d9afc 210 vInReading = ads.readADC_SingleEnded(1, 0xD583); // read channel 0
joshuasmth04 59:a9b21b3d9afc 211 vBlowerReading = ads.readADC_SingleEnded(2, 0xE783); // read channel 0
joshuasmth04 59:a9b21b3d9afc 212 omronDiff = ads.readADC_Differential(0x8583); // differential channel 2-3
joshuasmth04 59:a9b21b3d9afc 213 press = bmesensor.getPressure();
joshuasmth04 59:a9b21b3d9afc 214 temp = bmesensor.getTemperature()-5.0;
joshuasmth04 59:a9b21b3d9afc 215 rh = bmesensor.getHumidity();
joshuasmth04 59:a9b21b3d9afc 216 uv = lightsensor.getUV();
joshuasmth04 59:a9b21b3d9afc 217 vis = lightsensor.getVIS();
joshuasmth04 59:a9b21b3d9afc 218 ir = lightsensor.getIR();
joshuasmth04 59:a9b21b3d9afc 219
joshuasmth04 59:a9b21b3d9afc 220 FILE *fp = fopen(filename, "a");
caseyquinn 67:300418575137 221 fprintf(fp, "%02d,%02d,%02d,%02d,%02d,%02d,%1.3f,%1.3f,%2.2f,%4.2f,%2.1f,%1.3f,%1.3f,%5.1f,%1.1f,%1.1f,%1.1f,%1.1f,%d,%d,%d,%d,%d,%d,%d,%d,%d,%1.3f,%1.3f,%f\r\n",RTC.year, RTC.month,RTC.date,RTC.hour,RTC.minutes,RTC.seconds,omronVolt,massflow,temp,press,rh,atmoRho,volflow,sampledVol,accel_x,accel_y,accel_z,accel_comp,uv,omronReading, vInReading, vBlowerReading, omronDiff,gasG.getAmps(), gasG.getVolts(), gasG.getCharge(),digital_pot_set, deltaMflow, deltaVflow, compass);
joshuasmth04 59:a9b21b3d9afc 222 fclose(fp);
joshuasmth04 77:24fbeb2bfe05 223
joshuasmth04 59:a9b21b3d9afc 224 }
caseyquinn 57:0b554f7aa9a3 225
caseyquinn 57:0b554f7aa9a3 226 int main()
caseyquinn 57:0b554f7aa9a3 227 {
joshuasmth04 89:047e8558fd09 228 uint8_t temp_crr;
joshuasmth04 89:047e8558fd09 229 Restart:
caseyquinn 57:0b554f7aa9a3 230 // Setup and Initialization
caseyquinn 57:0b554f7aa9a3 231 //---------------------------------------------------------------------------------------------//
joshuasmth04 77:24fbeb2bfe05 232 Menu.read_menu(E2PROM, logInerval,refreshtime, volflowSet, device_name, dutyUp, dutyDown, home_lat, home_lon, work_lat, work_lon, RunReady, serial_num); //Read all data from the EEPROM here
joshuasmth04 85:a95dd5f03818 233 if(Menu.crr == 255) {
joshuasmth04 85:a95dd5f03818 234 Menu.factory_reset(E2PROM, logInerval,refreshtime, volflowSet, device_name, dutyUp, dutyDown, home_lat, home_lon, work_lat, work_lon, RunReady, serial_num);
joshuasmth04 85:a95dd5f03818 235 }
joshuasmth04 71:78edbceff4fc 236 //**************//BLE initialization//**************//
joshuasmth04 78:a465de6cc47e 237 bleMenu.read_menu(E2PROM, logInerval,refreshtime, volflowSet, device_name, dutyUp, dutyDown, home_lat, home_lon, work_lat, work_lon, RunReady, serial_num); //Read all data from the EEPROM here
joshuasmth04 71:78edbceff4fc 238 uint8_t BLE_name[] = {device_name[0], device_name[1], device_name[2], device_name[3], device_name[4], device_name[5], device_name[6], device_name[7], device_name[8]};
joshuasmth04 77:24fbeb2bfe05 239 ble.init();
joshuasmth04 77:24fbeb2bfe05 240 // setup advertising
joshuasmth04 71:78edbceff4fc 241 ble.accumulateAdvertisingPayload(GapAdvertisingData::BREDR_NOT_SUPPORTED);
joshuasmth04 71:78edbceff4fc 242 ble.setAdvertisingType(GapAdvertisingParams::ADV_CONNECTABLE_UNDIRECTED);
joshuasmth04 71:78edbceff4fc 243 ble.accumulateAdvertisingPayload(GapAdvertisingData::SHORTENED_LOCAL_NAME,(const uint8_t *)BLE_name, sizeof(BLE_name) - 1); // ~8 char max!
joshuasmth04 71:78edbceff4fc 244 ble.accumulateAdvertisingPayload(GapAdvertisingData::COMPLETE_LIST_128BIT_SERVICE_IDS,(const uint8_t *)uart_base_uuid_rev, sizeof(uart_base_uuid));
joshuasmth04 77:24fbeb2bfe05 245 // 100ms; in multiples of 0.625ms.
joshuasmth04 71:78edbceff4fc 246 ble.setAdvertisingInterval(160);
joshuasmth04 71:78edbceff4fc 247 ble.addService(uartService);
joshuasmth04 77:24fbeb2bfe05 248 ble.startAdvertising();
joshuasmth04 71:78edbceff4fc 249 ble.onDisconnection(disconnectionCallback); //what happens when disconected
joshuasmth04 71:78edbceff4fc 250 ble.onDataWritten(WrittenHandler); //what happens when the phone sends a message
joshuasmth04 71:78edbceff4fc 251 //**************//BLE initialization//**************//
joshuasmth04 77:24fbeb2bfe05 252
joshuasmth04 77:24fbeb2bfe05 253
joshuasmth04 77:24fbeb2bfe05 254
caseyquinn 57:0b554f7aa9a3 255 //Test for errors
joshuasmth04 71:78edbceff4fc 256 //RunReady = 0; //debug always open the menu
joshuasmth04 76:8130cb6776c6 257 //if(RTC.OSF()) { //Force the menu open if the RTC needs reset.
joshuasmth04 76:8130cb6776c6 258 // RunReady = 0;
joshuasmth04 76:8130cb6776c6 259 //}
joshuasmth04 86:60c9ec6e48ed 260 Reopen:
joshuasmth04 89:047e8558fd09 261 temp_crr = Menu.crr;
joshuasmth04 89:047e8558fd09 262 if((Menu.crr &0x01) != 0x01) { // crr bit 0, should the menu be optional
joshuasmth04 85:a95dd5f03818 263 RGB_LED.set_led(1,1,1);
caseyquinn 82:e01326a63ae9 264 wait(5);
joshuasmth04 85:a95dd5f03818 265 RGB_LED.set_led(1,1,0);
joshuasmth04 80:5487ba127c82 266 Menu.Start(pc, E2PROM, RTC, logInerval, refreshtime, volflowSet, device_name, dutyUp, dutyDown, home_lat, home_lon, work_lat, work_lon, Menu.menu_ops, 2, serial_num, calibrations); //Forces you to open the menu
joshuasmth04 80:5487ba127c82 267 bleMenu.open_menu(txPayload, rxCharacteristic, E2PROM, RTC, logInerval, refreshtime, volflowSet, device_name, dutyUp, dutyDown, home_lat, home_lon, work_lat, work_lon, Menu.menu_ops ,RunReady, 3, serial_num, calibrations);
joshuasmth04 85:a95dd5f03818 268 } else if(RunReady == 0 || RTC.OSF()) {
joshuasmth04 71:78edbceff4fc 269 RGB_LED.set_led(0,1,1); // error code/color
caseyquinn 87:c920521283b2 270 //pc.printf("Fix RTC\r\n");
caseyquinn 83:9153d6c3af81 271 while(RunReady == 0 || RTC.OSF()) {
joshuasmth04 71:78edbceff4fc 272 RGB_LED.set_led(0,1,1); // error code/color
joshuasmth04 77:24fbeb2bfe05 273 RunReady = Menu.Start(pc, E2PROM, RTC, logInerval, refreshtime, volflowSet, device_name, dutyUp, dutyDown, home_lat, home_lon, work_lat, work_lon, Menu.menu_ops, 0.25, serial_num, calibrations); //Forces you to open the menu
joshuasmth04 89:047e8558fd09 274 RGB_LED.set_led(0,5,5); // error code/color
joshuasmth04 78:a465de6cc47e 275 bleMenu.open_menu(txPayload, rxCharacteristic, E2PROM, RTC, logInerval, refreshtime, volflowSet, device_name, dutyUp, dutyDown, home_lat, home_lon, work_lat, work_lon, Menu.menu_ops ,RunReady, 0.25, serial_num, calibrations);
joshuasmth04 71:78edbceff4fc 276 }
joshuasmth04 85:a95dd5f03818 277
joshuasmth04 85:a95dd5f03818 278 if((Menu.crr & 0x08) != 0) { // crr bit 3, power down prepared to sample 24hr when powered on
joshuasmth04 85:a95dd5f03818 279 RunReady = 1;
joshuasmth04 77:24fbeb2bfe05 280 Menu.save_menu(E2PROM, logInerval, refreshtime, volflowSet, device_name, dutyUp, dutyDown, home_lat, home_lon, work_lat, work_lon, RunReady, serial_num); //Save all data to the EEPROM
joshuasmth04 77:24fbeb2bfe05 281 pbKill = 0;
joshuasmth04 77:24fbeb2bfe05 282 }
joshuasmth04 71:78edbceff4fc 283 }
joshuasmth04 86:60c9ec6e48ed 284 /*if(((Menu.crr & 0x02) != 0) || ((Menu.crr & 0x02) != 0)) {
joshuasmth04 86:60c9ec6e48ed 285 RTC.get_time();
joshuasmth04 86:60c9ec6e48ed 286 if(RTC.OSF()) { //Don't proceed if the time needs to be reset
joshuasmth04 86:60c9ec6e48ed 287 RGB_LED.set_led(0,1,1); // error code/color
joshuasmth04 86:60c9ec6e48ed 288 pc.printf("Please fix the Time before exiting!\r\n");
joshuasmth04 86:60c9ec6e48ed 289 RunReady = 0;
joshuasmth04 86:60c9ec6e48ed 290 goto Reopen;
joshuasmth04 86:60c9ec6e48ed 291 }
joshuasmth04 86:60c9ec6e48ed 292 }*/
joshuasmth04 86:60c9ec6e48ed 293 if((Menu.crr & 0x02) != 0) {
joshuasmth04 86:60c9ec6e48ed 294 RTC.get_time();
joshuasmth04 86:60c9ec6e48ed 295 if(RTC.compare(Menu.s_sec, Menu.s_min, Menu.s_hour, Menu.s_day, Menu.s_month, Menu.s_year)) { //Don't proceed if it's already time to start
joshuasmth04 86:60c9ec6e48ed 296 RGB_LED.set_led(0,1,1); // error code/color
joshuasmth04 86:60c9ec6e48ed 297 pc.printf("Please fix the START time before exiting!\r\n");
joshuasmth04 86:60c9ec6e48ed 298 RunReady = 0;
joshuasmth04 86:60c9ec6e48ed 299 goto Reopen;
joshuasmth04 86:60c9ec6e48ed 300 }
joshuasmth04 86:60c9ec6e48ed 301 }
caseyquinn 83:9153d6c3af81 302 // Compare function for 519(UBCUO) mode to have it wait for the start time to start
joshuasmth04 86:60c9ec6e48ed 303 if((Menu.crr & 0x04) != 0) {
joshuasmth04 85:a95dd5f03818 304 RTC.get_time();
joshuasmth04 85:a95dd5f03818 305 //Need to add in a compare function to check to see if the start time has already passed.
joshuasmth04 85:a95dd5f03818 306 if(RTC.compare(Menu.f_sec, Menu.f_min, Menu.f_hour, Menu.f_day, Menu.f_month, Menu.f_year)) { //Don't proceed if it's already time to stop
joshuasmth04 85:a95dd5f03818 307 RGB_LED.set_led(0,1,1); // error code/color
joshuasmth04 86:60c9ec6e48ed 308 pc.printf("Please fix the STOP time before exiting!\r\n");
joshuasmth04 86:60c9ec6e48ed 309 RunReady = 0;
joshuasmth04 86:60c9ec6e48ed 310 goto Reopen;
joshuasmth04 85:a95dd5f03818 311 }
caseyquinn 83:9153d6c3af81 312 }
joshuasmth04 86:60c9ec6e48ed 313
joshuasmth04 89:047e8558fd09 314 if(bleMenu.crr != temp_crr ) {
joshuasmth04 79:ed555e9081d0 315 Menu.crr = bleMenu.crr; // if this was changed in the UBM move it to the primary USM before saving
joshuasmth04 89:047e8558fd09 316 Menu.save_menu(E2PROM, logInerval, refreshtime, volflowSet, device_name, dutyUp, dutyDown, home_lat, home_lon, work_lat, work_lon, RunReady, serial_num); //Save all data to the EEPROM
joshuasmth04 79:ed555e9081d0 317 }
joshuasmth04 89:047e8558fd09 318 if(Menu.crr != temp_crr) {
joshuasmth04 89:047e8558fd09 319 Menu.save_menu(E2PROM, logInerval, refreshtime, volflowSet, device_name, dutyUp, dutyDown, home_lat, home_lon, work_lat, work_lon, RunReady, serial_num); //Save all data to the EEPROM
joshuasmth04 89:047e8558fd09 320 //RunReady = ?;
joshuasmth04 89:047e8558fd09 321 goto Restart;
joshuasmth04 89:047e8558fd09 322 }
joshuasmth04 89:047e8558fd09 323
joshuasmth04 89:047e8558fd09 324 pc.printf("You're done, you can now disconect the USB cable.\r\n");
caseyquinn 84:85d11d422da3 325 RunReady = 0;
joshuasmth04 77:24fbeb2bfe05 326 Menu.save_menu(E2PROM, logInerval, refreshtime, volflowSet, device_name, dutyUp, dutyDown, home_lat, home_lon, work_lat, work_lon, RunReady, serial_num); //Save all data to the EEPROM
caseyquinn 83:9153d6c3af81 327 RGB_LED.set_led(1,1,0);
joshuasmth04 85:a95dd5f03818 328
joshuasmth04 85:a95dd5f03818 329 if((Menu.crr & 0x10) != 0) { //crr bit 4 uses Demo values
caseyquinn 87:c920521283b2 330 //volflowSet = 1.0; //L/min
caseyquinn 87:c920521283b2 331 //logInerval = 10;
caseyquinn 83:9153d6c3af81 332 }
joshuasmth04 85:a95dd5f03818 333
joshuasmth04 85:a95dd5f03818 334 if((Menu.crr & 0x02) != 0) {
joshuasmth04 85:a95dd5f03818 335 while(!RTC.compare(Menu.s_sec, Menu.s_min, Menu.s_hour, Menu.s_day, Menu.s_month, Menu.s_year)) { // this while waits for the start time by looping until the start time
joshuasmth04 85:a95dd5f03818 336 wait(0.5);
joshuasmth04 85:a95dd5f03818 337 RTC.get_time(); //debug
joshuasmth04 85:a95dd5f03818 338 pc.printf("%02d:%02d:%02d on %d/%d/%d) \r\n",RTC.hour, RTC.minutes, RTC.seconds, RTC.month, RTC.date, RTC.year);//debig
joshuasmth04 85:a95dd5f03818 339 //pc.printf("Waiting to start\r\n");
joshuasmth04 85:a95dd5f03818 340 // serial print a count down??
joshuasmth04 85:a95dd5f03818 341 }
caseyquinn 84:85d11d422da3 342 }
joshuasmth04 85:a95dd5f03818 343
joshuasmth04 78:a465de6cc47e 344 calibrations.initialize(serial_num);
joshuasmth04 85:a95dd5f03818 345
joshuasmth04 85:a95dd5f03818 346 if((Menu.crr & 0x04) != 0) { // don't shut off when in demo mode
joshuasmth04 79:ed555e9081d0 347 stop.attach(&check_stop, 60); // check if we should shut down every 5 seconds, starting 60s after the start.
joshuasmth04 79:ed555e9081d0 348 }
joshuasmth04 85:a95dd5f03818 349
caseyquinn 81:480f0310ef9a 350 if(volflowSet<=1.0) {
joshuasmth04 59:a9b21b3d9afc 351 gainFlow = 100;
caseyquinn 81:480f0310ef9a 352 } else if(volflowSet>=2.0) {
joshuasmth04 59:a9b21b3d9afc 353 gainFlow = 25;
joshuasmth04 59:a9b21b3d9afc 354 } else {
caseyquinn 88:9142f21a4715 355 gainFlow = 25;
joshuasmth04 59:a9b21b3d9afc 356 }
joshuasmth04 59:a9b21b3d9afc 357
caseyquinn 57:0b554f7aa9a3 358 RGB_LED.set_led(1,0,0);
caseyquinn 57:0b554f7aa9a3 359 press = bmesensor.getPressure();
caseyquinn 57:0b554f7aa9a3 360 temp = bmesensor.getTemperature();
caseyquinn 57:0b554f7aa9a3 361 rh = bmesensor.getHumidity();
caseyquinn 57:0b554f7aa9a3 362
caseyquinn 57:0b554f7aa9a3 363 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 57:0b554f7aa9a3 364 massflowSet = volflowSet*atmoRho;
caseyquinn 57:0b554f7aa9a3 365 //Digtal pot tf from file: UPAS v2 OSU-PrimaryFlowData FullSet 2015-05-29 CQ mods.xlsx
joshuasmth04 85:a95dd5f03818 366
caseyquinn 81:480f0310ef9a 367 //--------------------------------------------------------------//
caseyquinn 81:480f0310ef9a 368 // Calibration value checks //
caseyquinn 81:480f0310ef9a 369 //--------------------------------------------------------------//
joshuasmth04 85:a95dd5f03818 370 //while(1){
joshuasmth04 85:a95dd5f03818 371 //pc.printf("%f,%f,%f,%f,%f\r\n",calibrations.DP4, calibrations.DP3, calibrations.DP2, calibrations.DP1, calibrations.DP0);
joshuasmth04 85:a95dd5f03818 372 //pc.printf("%f,%f,%f,%f\r\n",calibrations.omronVMin, calibrations.omronVMax, calibrations.omronMFMin, calibrations.omronMFMax);
joshuasmth04 85:a95dd5f03818 373 //pc.printf("%f,%f,%f,%f,%f\r\n",calibrations.MF4, calibrations.MF3, calibrations.MF2, calibrations.MF1, calibrations.MF0);
joshuasmth04 85:a95dd5f03818 374 //wait(1);
joshuasmth04 85:a95dd5f03818 375 //}
caseyquinn 81:480f0310ef9a 376 //--------------------------------------------------------------//
caseyquinn 81:480f0310ef9a 377 //--------------------------------------------------------------//
joshuasmth04 85:a95dd5f03818 378
joshuasmth04 77:24fbeb2bfe05 379 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 81:480f0310ef9a 380 //pc.printf("%d\r\n", digital_pot_setpoint);
joshuasmth04 85:a95dd5f03818 381
joshuasmth04 59:a9b21b3d9afc 382 if(digital_pot_setpoint>=digitalpotMax) {
caseyquinn 57:0b554f7aa9a3 383 digital_pot_setpoint = digitalpotMax;
joshuasmth04 59:a9b21b3d9afc 384 } else if(digital_pot_setpoint<=digitalpotMin) {
caseyquinn 57:0b554f7aa9a3 385 digital_pot_setpoint = digitalpotMin;
joshuasmth04 59:a9b21b3d9afc 386 }
joshuasmth04 59:a9b21b3d9afc 387
caseyquinn 57:0b554f7aa9a3 388 DigPot.writeRegister(digital_pot_setpoint);
caseyquinn 57:0b554f7aa9a3 389 wait(1);
caseyquinn 57:0b554f7aa9a3 390 blower = 1;
joshuasmth04 85:a95dd5f03818 391 if((Menu.crr &0x08) != 0) {
joshuasmth04 77:24fbeb2bfe05 392 RTC.get_time();
joshuasmth04 85:a95dd5f03818 393 Menu.f_sec = RTC.seconds;
joshuasmth04 85:a95dd5f03818 394 Menu.f_min = RTC.minutes;
joshuasmth04 85:a95dd5f03818 395 Menu.f_hour = RTC.hour;
joshuasmth04 77:24fbeb2bfe05 396 if(RTC.month == 1 | RTC.month == 3 | RTC.month == 5 | RTC.month == 7 | RTC.month == 8 | RTC.month == 10) {
joshuasmth04 77:24fbeb2bfe05 397 if(RTC.date == 31) {
joshuasmth04 85:a95dd5f03818 398 Menu.f_day = 1;
joshuasmth04 85:a95dd5f03818 399 Menu.f_month = RTC.month +1;
joshuasmth04 85:a95dd5f03818 400 Menu.f_year = RTC.year;
joshuasmth04 77:24fbeb2bfe05 401 } else {
joshuasmth04 85:a95dd5f03818 402 Menu.f_day = RTC.date+1;
joshuasmth04 85:a95dd5f03818 403 Menu.f_month = RTC.month;
joshuasmth04 85:a95dd5f03818 404 Menu.f_year = RTC.year;
joshuasmth04 77:24fbeb2bfe05 405 }
joshuasmth04 77:24fbeb2bfe05 406 } else if(RTC.month == 4 | RTC.month == 6 | RTC.month == 9 | RTC.month == 11) {
joshuasmth04 77:24fbeb2bfe05 407 if(RTC.date == 30) {
joshuasmth04 85:a95dd5f03818 408 Menu.f_day = 1;
joshuasmth04 85:a95dd5f03818 409 Menu.f_month = RTC.month +1;
joshuasmth04 85:a95dd5f03818 410 Menu.f_year = RTC.year;
joshuasmth04 77:24fbeb2bfe05 411 } else {
joshuasmth04 85:a95dd5f03818 412 Menu.f_day = RTC.date+1;
joshuasmth04 85:a95dd5f03818 413 Menu.f_month = RTC.month;
joshuasmth04 85:a95dd5f03818 414 Menu.f_year = RTC.year;
joshuasmth04 77:24fbeb2bfe05 415 }
joshuasmth04 77:24fbeb2bfe05 416 } else if(RTC.month == 2) {
joshuasmth04 77:24fbeb2bfe05 417 if(RTC.year == 16 | RTC.year == 20 | RTC.year == 24| RTC.year == 28) {
joshuasmth04 77:24fbeb2bfe05 418 if(RTC.date == 29) {
joshuasmth04 85:a95dd5f03818 419 Menu.f_day = 1;
joshuasmth04 85:a95dd5f03818 420 Menu.f_month = RTC.month +1;
joshuasmth04 85:a95dd5f03818 421 Menu.f_year = RTC.year;
joshuasmth04 77:24fbeb2bfe05 422 } else {
joshuasmth04 85:a95dd5f03818 423 Menu.f_day = RTC.date+1;
joshuasmth04 85:a95dd5f03818 424 Menu.f_month = RTC.month;
joshuasmth04 85:a95dd5f03818 425 Menu.f_year = RTC.year;
joshuasmth04 77:24fbeb2bfe05 426 }
joshuasmth04 77:24fbeb2bfe05 427 } else {
joshuasmth04 77:24fbeb2bfe05 428 if(RTC.date == 28) {
joshuasmth04 85:a95dd5f03818 429 Menu.f_day = 1;
joshuasmth04 85:a95dd5f03818 430 Menu.f_month = RTC.month +1;
joshuasmth04 85:a95dd5f03818 431 Menu.f_year = RTC.year;
joshuasmth04 77:24fbeb2bfe05 432 } else {
joshuasmth04 85:a95dd5f03818 433 Menu.f_day = RTC.date+1;
joshuasmth04 85:a95dd5f03818 434 Menu.f_month = RTC.month;
joshuasmth04 85:a95dd5f03818 435 Menu.f_year = RTC.year;
caseyquinn 67:300418575137 436 }
caseyquinn 67:300418575137 437 }
joshuasmth04 77:24fbeb2bfe05 438 } else if(RTC.month == 12) {
joshuasmth04 77:24fbeb2bfe05 439 if(RTC.date == 31) {
joshuasmth04 85:a95dd5f03818 440 Menu.f_day = 1;
joshuasmth04 85:a95dd5f03818 441 Menu.f_month = 1;
joshuasmth04 85:a95dd5f03818 442 Menu.f_year = RTC.year+1;
joshuasmth04 77:24fbeb2bfe05 443 } else {
joshuasmth04 85:a95dd5f03818 444 Menu.f_day = RTC.date+1;
joshuasmth04 85:a95dd5f03818 445 Menu.f_month = RTC.month;
joshuasmth04 85:a95dd5f03818 446 Menu.f_year = RTC.year;
joshuasmth04 77:24fbeb2bfe05 447 }
caseyquinn 67:300418575137 448 }
joshuasmth04 77:24fbeb2bfe05 449 }
joshuasmth04 77:24fbeb2bfe05 450
caseyquinn 81:480f0310ef9a 451 sprintf(filename, "/sd/UPAS%04dLOG_%02d-%02d-%02d_%02d=%02d=%02d_%s.txt",serial_num,RTC.year,RTC.month,RTC.date,RTC.hour,RTC.minutes,RTC.seconds,device_name);
caseyquinn 57:0b554f7aa9a3 452 FILE *fp = fopen(filename, "w");
caseyquinn 57:0b554f7aa9a3 453 fclose(fp);
joshuasmth04 59:a9b21b3d9afc 454 //pc.printf("%d\r\n",digital_pot_setpoint);
joshuasmth04 59:a9b21b3d9afc 455
joshuasmth04 59:a9b21b3d9afc 456 //---------------------------------------------------------------------------------------------//
joshuasmth04 59:a9b21b3d9afc 457 //Following lines are needed to enter into the initiallization flow control loop
joshuasmth04 59:a9b21b3d9afc 458
caseyquinn 57:0b554f7aa9a3 459 wait(10);
joshuasmth04 59:a9b21b3d9afc 460
caseyquinn 57:0b554f7aa9a3 461 omronReading = ads.readADC_SingleEnded(0, 0xC583); // read channel 0 PGA = 2 : Full Scale Range = 2.048V
caseyquinn 57:0b554f7aa9a3 462 omronVolt = (omronReading*4.096)/(32768*2);
joshuasmth04 77:24fbeb2bfe05 463 if(omronVolt<=calibrations.omronVMin) {
joshuasmth04 77:24fbeb2bfe05 464 massflow = calibrations.omronMFMin;
joshuasmth04 77:24fbeb2bfe05 465 } else if(omronVolt>=calibrations.omronVMax) {
joshuasmth04 77:24fbeb2bfe05 466 massflow = calibrations.omronMFMax;
joshuasmth04 59:a9b21b3d9afc 467 } else {
joshuasmth04 77:24fbeb2bfe05 468 massflow = calibrations.MF4*pow(omronVolt,(float)4)+calibrations.MF3*pow(omronVolt,(float)3)+calibrations.MF2*pow(omronVolt,(float)2)+calibrations.MF1*omronVolt+calibrations.MF0;
joshuasmth04 59:a9b21b3d9afc 469 }
joshuasmth04 59:a9b21b3d9afc 470 deltaMflow = massflow-massflowSet;
joshuasmth04 59:a9b21b3d9afc 471 digital_pot_set = digital_pot_setpoint;
joshuasmth04 59:a9b21b3d9afc 472 wait(5);
joshuasmth04 59:a9b21b3d9afc 473
joshuasmth04 59:a9b21b3d9afc 474 //---------------------------------------------------------------------------------------------//
joshuasmth04 59:a9b21b3d9afc 475 //Sets the flow withen +-1.5% of the desired flow rate based on mass flow
joshuasmth04 59:a9b21b3d9afc 476
joshuasmth04 59:a9b21b3d9afc 477 while(abs(deltaMflow)>.015) {
joshuasmth04 77:24fbeb2bfe05 478
joshuasmth04 59:a9b21b3d9afc 479 omronReading = ads.readADC_SingleEnded(0, 0xC583); // read channel 0 PGA = 2 : Full Scale Range = 2.048V
joshuasmth04 59:a9b21b3d9afc 480 omronVolt = (omronReading*4.096)/(32768*2);
joshuasmth04 59:a9b21b3d9afc 481 //Mass Flow tf from file: UPAS v2 OSU-PrimaryFlowData FullSet 2015-05-29 CQ mods.xlsx
joshuasmth04 77:24fbeb2bfe05 482 if(omronVolt<=calibrations.omronVMin) {
joshuasmth04 77:24fbeb2bfe05 483 massflow = calibrations.omronMFMin;
joshuasmth04 77:24fbeb2bfe05 484 } else if(omronVolt>=calibrations.omronVMax) {
joshuasmth04 77:24fbeb2bfe05 485 massflow = calibrations.omronMFMax;
joshuasmth04 59:a9b21b3d9afc 486 } else {
joshuasmth04 77:24fbeb2bfe05 487 massflow = calibrations.MF4*pow(omronVolt,(float)4)+calibrations.MF3*pow(omronVolt,(float)3)+calibrations.MF2*pow(omronVolt,(float)2)+calibrations.MF1*omronVolt+calibrations.MF0;
joshuasmth04 59:a9b21b3d9afc 488 }
caseyquinn 57:0b554f7aa9a3 489
joshuasmth04 59:a9b21b3d9afc 490 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));
joshuasmth04 59:a9b21b3d9afc 491 volflow = massflow/atmoRho;
joshuasmth04 59:a9b21b3d9afc 492 massflowSet = volflowSet*atmoRho;
joshuasmth04 59:a9b21b3d9afc 493 deltaMflow = massflow-massflowSet;
joshuasmth04 63:66796aef8d68 494 //pc.printf("%f,%f,%f,%f,%d,%u,%x\r\n",volflow,massflow,massflowSet,deltaMflow,digital_pot_set,digital_pot_set,digital_pot_set);
joshuasmth04 85:a95dd5f03818 495 //pc.printf("%d,%d,%d,%d,%d,%d\r\n",Menu.f_sec,Menu.f_min,Menu.f_hour,Menu.f_day,Menu.f_month,Menu.f_year,digital_pot_set);
joshuasmth04 59:a9b21b3d9afc 496 digital_pot_set = (int)(digital_pot_set+(int)((gainFlow*deltaMflow)));
joshuasmth04 59:a9b21b3d9afc 497 if(digital_pot_set>=digitalpotMax) {
joshuasmth04 59:a9b21b3d9afc 498 digital_pot_set = digitalpotMax;
joshuasmth04 59:a9b21b3d9afc 499 } else if(digital_pot_set<=digitalpotMin) {
joshuasmth04 59:a9b21b3d9afc 500 digital_pot_set = digitalpotMin;
joshuasmth04 59:a9b21b3d9afc 501 }
joshuasmth04 59:a9b21b3d9afc 502
joshuasmth04 59:a9b21b3d9afc 503 wait(2);
joshuasmth04 59:a9b21b3d9afc 504 DigPot.writeRegister(digital_pot_set);
joshuasmth04 59:a9b21b3d9afc 505 wait(1);
joshuasmth04 59:a9b21b3d9afc 506
joshuasmth04 59:a9b21b3d9afc 507
joshuasmth04 59:a9b21b3d9afc 508 }
joshuasmth04 59:a9b21b3d9afc 509
joshuasmth04 59:a9b21b3d9afc 510 sampledVol = 0.0;
joshuasmth04 59:a9b21b3d9afc 511 RGB_LED.set_led(0,1,0);
joshuasmth04 77:24fbeb2bfe05 512
caseyquinn 67:300418575137 513
joshuasmth04 59:a9b21b3d9afc 514
joshuasmth04 59:a9b21b3d9afc 515 //** end of initalization **//
caseyquinn 84:85d11d422da3 516
joshuasmth04 59:a9b21b3d9afc 517 //---------------------------------------------------------------------------------------------//
joshuasmth04 59:a9b21b3d9afc 518 //---------------------------------------------------------------------------------------------//
joshuasmth04 59:a9b21b3d9afc 519 // Main Control Loop
joshuasmth04 59:a9b21b3d9afc 520
joshuasmth04 62:edc9632bcc43 521 logg.attach(&log_data, logInerval); // uses callbacks or block Interrupts for anything that uses i2c
joshuasmth04 59:a9b21b3d9afc 522 while(1) {
joshuasmth04 62:edc9632bcc43 523 //__disable_irq(); // Disable Interrupts
joshuasmth04 62:edc9632bcc43 524 //RTC.get_time();
joshuasmth04 62:edc9632bcc43 525 //__enable_irq(); // Enable Interrupts
joshuasmth04 62:edc9632bcc43 526 //secondsD = (double)RTC.seconds;
joshuasmth04 62:edc9632bcc43 527 //if(fmod(secondsD,logInerval)==0) {
joshuasmth04 77:24fbeb2bfe05 528 //log_data();
joshuasmth04 64:2906b0c48403 529 //}
caseyquinn 0:14d46ef4b6cb 530 }
joshuasmth04 59:a9b21b3d9afc 531
caseyquinn 0:14d46ef4b6cb 532 }
caseyquinn 0:14d46ef4b6cb 533
caseyquinn 0:14d46ef4b6cb 534