File content as of revision 84:85d11d422da3:

#include "mbed.h"
#include "SDFileSystem.h"
#include "Adafruit_ADS1015.h"
#include "MCP40D17.h"
#include "STC3100.h"
#include "LSM303.h"
#include "BME280.h"
#include "SI1145.h"
#include "NCP5623BMUTBG.h"
#include "CronoDot.h"
#include "EEPROM.h"
#include "US_Menu.h"
#include "BLEDevice.h"
#include "BLE_Menu.h"
#include "Calibration.h"

#define BLE_UUID_TXRX_SERVICE            0x0000 /**< The UUID of the Nordic UART Service. */
#define BLE_UUID_TX_CHARACTERISTIC       0x0002 /**< The UUID of the TX Characteristic. */
#define BLE_UUIDS_RX_CHARACTERISTIC      0x0003 /**< The UUID of the RX Characteristic. */

#define SERIAL_BAUD_RATE    9600
#define SCL         20
#define SDA         22


uint8_t txPayload[TXRX_BUF_LEN] = {0,};
uint8_t rxPayload[TXRX_BUF_LEN] = {0,};

static const uint8_t uart_base_uuid[] = {0x71, 0x3D, 0, 0, 0x50, 0x3E, 0x4C, 0x75, 0xBA, 0x94, 0x31, 0x48, 0xF1, 0x8D, 0x94, 0x1E};
static const uint8_t uart_tx_uuid[]   = {0x71, 0x3D, 0, 3, 0x50, 0x3E, 0x4C, 0x75, 0xBA, 0x94, 0x31, 0x48, 0xF1, 0x8D, 0x94, 0x1E};
static const uint8_t uart_rx_uuid[]   = {0x71, 0x3D, 0, 2, 0x50, 0x3E, 0x4C, 0x75, 0xBA, 0x94, 0x31, 0x48, 0xF1, 0x8D, 0x94, 0x1E};
static const uint8_t uart_base_uuid_rev[] = {0x1E, 0x94, 0x8D, 0xF1, 0x48, 0x31, 0x94, 0xBA, 0x75, 0x4C, 0x3E, 0x50, 0, 0, 0x3D, 0x71};

GattCharacteristic  txCharacteristic (uart_tx_uuid, txPayload, 1, TXRX_BUF_LEN, GattCharacteristic::BLE_GATT_CHAR_PROPERTIES_WRITE | GattCharacteristic::BLE_GATT_CHAR_PROPERTIES_WRITE_WITHOUT_RESPONSE);
GattCharacteristic  rxCharacteristic (uart_rx_uuid, rxPayload, 1, TXRX_BUF_LEN, GattCharacteristic::BLE_GATT_CHAR_PROPERTIES_NOTIFY);
GattCharacteristic *uartChars[] = {&txCharacteristic, &rxCharacteristic};
GattService         uartService(uart_base_uuid, uartChars, sizeof(uartChars) / sizeof(GattCharacteristic *));

BLEDevice   ble;
BLE_Menu    bleMenu(ble, txPayload, rxPayload, uart_base_uuid_rev, uart_base_uuid, uartService);

I2C                 i2c(p22, p20);
Adafruit_ADS1115    ads(&i2c);
MCP40D17            DigPot(&i2c);
BME280              bmesensor(p22, p20);
STC3100             gasG(p22, p20);
Serial              pc(USBTX, USBRX);
DigitalOut          blower(p29, 0);
DigitalOut          pbKill(p18, 1);
LSM303              movementsensor(p22, p20);
SI1145              lightsensor(p22, p20);
NCP5623BMUTBG       RGB_LED(p22, p20);
CronoDot            RTC(p22, p20);
EEPROM              E2PROM(p22, p20);
US_Menu             Menu;
DigitalOut          GPS_EN(p4,0);       //pin 4 is used to enable and disable the GPS, in order to recive serial communications
Calibration         calibrations(1);     //Default serial/calibration if there are no values for the selected option

Timeout         stop;   //This is the stop call back object
Timeout         logg;   //This is the logging call back object

uint16_t serial_num = 1;                // Default serial/calibration number
int RunReady =0;


float press;
float temp;
float rh;

int uv;
int vis;
int ir;

float compass;
float accel_x;
float accel_y;
float accel_z;
float accel_comp;
float mag_x;
float mag_y;
float mag_z;

int vInReading;
int vBlowerReading;
int omronDiff;
float omronVolt; //V
int omronReading;
float atmoRho; //g/L

float massflow; //g/min
float volflow; //L/min
float volflowSet = 1.0; //L/min
int   logInerval = 10; //seconds
double secondsD = 0;
float massflowSet;
float deltaVflow = 0.0;
float deltaMflow = 0.0;
float gainFlow;
float sampledVol; //L, total sampled volume

int digital_pot_setpoint; //min = 0x7F, max = 0x00
int digital_pot_set;
int digital_pot_change;
int digitalpotMax = 127;
int digitalpotMin = 2;

int dutyUp;
int dutyDown;
uint8_t f_sec, f_min, f_hour, f_date, f_month, f_year;

// variables are only place holders for the US_Menu //
int refreshtime;
float home_lat, home_lon, work_lat, work_lon;
//*************************************************//

//int refresh_Time = 10;   // refresh time in s, note calling read_GPS()(or similar) will still take how ever long it needs(hopefully < 1s)

char device_name[] = "---------------";
char filename[] = "/sd/XXXX0000LOG000000000000---------------.txt";
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)


void disconnectionCallback(Gap::Handle_t handle, Gap::DisconnectionReason_t reason)
{
    bleMenu.disconnectionCallback();
}

void WrittenHandler(const GattCharacteristicWriteCBParams *Handler) // called any time the phone sends a message
{
    bleMenu.WrittenHandler(pc, txPayload, txCharacteristic,  Handler);
    //returns things to the txPayload
}

void check_stop()   // this checks if it's time to stop and shutdown
{
    //RTC.get_time(); //debug
    //pc.printf("%02d:%02d:%02d on %d/%d/%d) \r\n",RTC.hour, RTC.minutes, RTC.seconds, RTC.month, RTC.date, RTC.year);//debig
    if(RTC.compare(f_sec, f_min, f_hour, f_date, f_month, f_year)) {
        pbKill = 0; // this is were we shut everything down
    }
    stop.detach();
    stop.attach(&check_stop, 9);
}


void log_data()
{
    logg.detach();
    logg.attach(&log_data, logInerval);
    RTC.get_time();
    secondsD = RTC.seconds;
    while(fmod(secondsD,logInerval)!=0) {
        RTC.get_time();
        secondsD = RTC.seconds;
    }


    omronReading = ads.readADC_SingleEnded(0, 0xC583); // read channel 0 PGA = 2 : Full Scale Range = 2.048V
    omronVolt = (omronReading*4.096)/(32768*2);

    if(omronVolt<=calibrations.omronVMin) {
        massflow = calibrations.omronMFMin;
    } else if(omronVolt>=calibrations.omronVMax) {
        massflow = calibrations.omronMFMax;
    } else {
        massflow = calibrations.MF4*pow(omronVolt,(float)4)+calibrations.MF3*pow(omronVolt,(float)3)+calibrations.MF2*pow(omronVolt,(float)2)+calibrations.MF1*omronVolt+calibrations.MF0;
    }

    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));
    volflow = massflow/atmoRho;
    sampledVol = sampledVol + ((((float)logInerval)/60.0)*volflow);
    deltaVflow = volflow-volflowSet;
    massflowSet = volflowSet*atmoRho;
    deltaMflow = massflow-massflowSet;

    if(abs(deltaMflow)>.025) {
        digital_pot_change = (int)(gainFlow*deltaMflow);


        if(abs(digital_pot_change)>=50) {
            digital_pot_set = (int)(digital_pot_set+(int)((10.0*deltaMflow)));
            RGB_LED.set_led(1,0,0);

        } else if(digital_pot_change+digital_pot_set>=digitalpotMax&abs(digital_pot_change)<50) {
            digital_pot_set = digitalpotMax;
            RGB_LED.set_led(1,0,0);
        } else if(digital_pot_change+digital_pot_set<=digitalpotMin&abs(digital_pot_change)<50) {
            digital_pot_set = digitalpotMin;
            RGB_LED.set_led(1,0,0);
        } else {
            digital_pot_set = (digital_pot_set+ digital_pot_change);
            RGB_LED.set_led(1,1,0);
        }

        DigPot.writeRegister(digital_pot_set);

    } else {
        RGB_LED.set_led(0,1,0);
    }

    movementsensor.getACCEL();
    movementsensor.getCOMPASS();
    compass = movementsensor.getCOMPASS_HEADING();
    accel_x = movementsensor.AccelData.x;
    accel_y = movementsensor.AccelData.y;
    accel_z = movementsensor.AccelData.z;
    accel_comp = pow(accel_x,(float)2)+pow(accel_y,(float)2)+pow(accel_z,(float)2)-1.0;
    mag_x = movementsensor.MagData.x;
    mag_y = movementsensor.MagData.y;
    mag_z = movementsensor.MagData.z;

    vInReading = ads.readADC_SingleEnded(1, 0xD583); // read channel 0
    vBlowerReading = ads.readADC_SingleEnded(2, 0xE783); // read channel 0
    omronDiff = ads.readADC_Differential(0x8583); // differential channel 2-3
    press = bmesensor.getPressure();
    temp = bmesensor.getTemperature()-5.0;
    rh = bmesensor.getHumidity();
    uv =  lightsensor.getUV();
    vis = lightsensor.getVIS();
    ir = lightsensor.getIR();

    FILE *fp = fopen(filename, "a");
    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);
    fclose(fp);

}

int main()
{

// Setup and Initialization
//---------------------------------------------------------------------------------------------//
    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

    //**************//BLE initialization//**************//
    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
    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]};
    ble.init();
    // setup advertising
    ble.accumulateAdvertisingPayload(GapAdvertisingData::BREDR_NOT_SUPPORTED);
    ble.setAdvertisingType(GapAdvertisingParams::ADV_CONNECTABLE_UNDIRECTED);
    ble.accumulateAdvertisingPayload(GapAdvertisingData::SHORTENED_LOCAL_NAME,(const uint8_t *)BLE_name, sizeof(BLE_name) - 1); // ~8 char max!
    ble.accumulateAdvertisingPayload(GapAdvertisingData::COMPLETE_LIST_128BIT_SERVICE_IDS,(const uint8_t *)uart_base_uuid_rev, sizeof(uart_base_uuid));
    // 100ms; in multiples of 0.625ms.
    ble.setAdvertisingInterval(160);
    ble.addService(uartService);
    ble.startAdvertising();
    ble.onDisconnection(disconnectionCallback); //what happens when disconected
    ble.onDataWritten(WrittenHandler);          //what happens when the phone sends a message
    //**************//BLE initialization//**************//



    //Test for errors
    //RunReady = 0; //debug always open the menu
    //if(RTC.OSF()) {                 //Force the menu open if the RTC needs reset.
    //    RunReady = 0;
    //}
    
    uint8_t temp_crr = Menu.crr;
    if(Menu.crr == 1){  // if in Demo mode allow 1 second for each menu to change out of demo mode
        RGB_LED.set_led(1,1,1);  
        wait(5);
        RGB_LED.set_led(1,1,0);  
        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
        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);
        volflowSet = 1.0; //L/min
        logInerval = 10;
    }else if(RunReady == 0 || RTC.OSF()) {
        RGB_LED.set_led(0,1,1); // error code/color
        //pc.printf("Change Name\r\n");
        while(RunReady == 0 || RTC.OSF()) {
            RGB_LED.set_led(0,1,1);   // error code/color
            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
            RGB_LED.set_led(0,10,10); // error code/color
            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);
        }
        
        if(Menu.menu_ops == 513 && Menu.crr == 0){
            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
            pbKill = 0;
        }
    }

    // Compare function for 519(UBCUO) mode to have it wait for the start time to start
    if(Menu.menu_ops == 519){
    RTC.get_time();
    //Need to add in a compare function to check to see if the start time has already passed.
    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
        RGB_LED.set_led(0,1,1); // error code/color
        pc.printf("Please fix the START or STOP times before exiting!\r\n");
        Menu.Start(pc, E2PROM, RTC, logInerval, refreshtime, volflowSet, device_name, dutyUp, dutyDown, home_lat, home_lon, work_lat, work_lon, Menu.menu_ops, 0, serial_num, calibrations);  //Forces you to open the menu
        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
    }
    pc.printf("You're done, you can now disconect the USB cable.\r\n");

    }
    
     if(bleMenu.crr != temp_crr){
        Menu.crr = bleMenu.crr; // if this was changed in the UBM move it to the primary USM before saving
    }
    
    RunReady = 0;
    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
    RGB_LED.set_led(1,1,0);
    
    if(Menu.menu_ops == 519){
    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
        wait(0.5);
        pc.printf("Waiting to start\r\n");
        // serial print a count down??
    }
    }
    
    calibrations.initialize(serial_num);
    
    if(Menu.crr == 0){  // don't shut off when in demo mode
        stop.attach(&check_stop, 60);    // check if we should shut down every 5 seconds, starting 60s after the start.
    }
    
    

    if(volflowSet<=1.0) {
        gainFlow = 100;
    } else if(volflowSet>=2.0) {
        gainFlow = 25;
    } else {
        gainFlow = 25;
    }

    RGB_LED.set_led(1,0,0);
    press = bmesensor.getPressure();
    temp = bmesensor.getTemperature();
    rh = bmesensor.getHumidity();

    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));
    massflowSet = volflowSet*atmoRho;
    //Digtal pot tf from file: UPAS v2 OSU-PrimaryFlowData FullSet 2015-05-29 CQ mods.xlsx
    
    //--------------------------------------------------------------//
    //  Calibration value checks   //
    //--------------------------------------------------------------//
    while(1){
    pc.printf("%f,%f,%f,%f,%f\r\n",calibrations.DP4, calibrations.DP3, calibrations.DP2, calibrations.DP1, calibrations.DP0);
    pc.printf("%f,%f,%f,%f\r\n",calibrations.omronVMin, calibrations.omronVMax, calibrations.omronMFMin, calibrations.omronMFMax);
    pc.printf("%f,%f,%f,%f,%f\r\n",calibrations.MF4, calibrations.MF3, calibrations.MF2, calibrations.MF1, calibrations.MF0);
    wait(1);
    }
    //--------------------------------------------------------------//
    //--------------------------------------------------------------//
    
    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
    //pc.printf("%d\r\n", digital_pot_setpoint);
    
    if(digital_pot_setpoint>=digitalpotMax) {
        digital_pot_setpoint = digitalpotMax;
    } else if(digital_pot_setpoint<=digitalpotMin) {
        digital_pot_setpoint = digitalpotMin;
    }

    DigPot.writeRegister(digital_pot_setpoint);
    wait(1);
    blower = 1;
    if(Menu.menu_ops == 513) {
        RTC.get_time();
        f_sec = RTC.seconds;
        f_min = RTC.minutes;
        f_hour = RTC.hour;
        if(RTC.month == 1 | RTC.month == 3 | RTC.month == 5 | RTC.month == 7 | RTC.month == 8 | RTC.month == 10) {
            if(RTC.date == 31) {
                f_date = 1;
                f_month = RTC.month +1;
                f_year = RTC.year;
            } else {
                f_date = RTC.date+1;
                f_month = RTC.month;
                f_year = RTC.year;
            }
        } else if(RTC.month == 4 | RTC.month == 6 | RTC.month == 9 | RTC.month == 11) {
            if(RTC.date == 30) {
                f_date = 1;
                f_month = RTC.month +1;
                f_year = RTC.year;
            } else {
                f_date = RTC.date+1;
                f_month = RTC.month;
                f_year = RTC.year;
            }
        } else if(RTC.month == 2) {
            if(RTC.year == 16 | RTC.year == 20 | RTC.year == 24| RTC.year == 28) {
                if(RTC.date == 29) {
                    f_date = 1;
                    f_month = RTC.month +1;
                    f_year = RTC.year;
                } else {
                    f_date = RTC.date+1;
                    f_month = RTC.month;
                    f_year = RTC.year;
                }
            } else {
                if(RTC.date == 28) {
                    f_date = 1;
                    f_month = RTC.month +1;
                    f_year = RTC.year;
                } else {
                    f_date = RTC.date+1;
                    f_month = RTC.month;
                    f_year = RTC.year;
                }
            }
        } else if(RTC.month == 12) {
            if(RTC.date == 31) {
                f_date = 1;
                f_month = 1;
                f_year = RTC.year+1;
            } else {
                f_date = RTC.date+1;
                f_month = RTC.month;
                f_year = RTC.year;
            }
        }
    }

    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);
    FILE *fp = fopen(filename, "w");
    fclose(fp);
    //pc.printf("%d\r\n",digital_pot_setpoint);

    //---------------------------------------------------------------------------------------------//
    //Following lines are needed to enter into the initiallization flow control loop

    wait(10);

    omronReading = ads.readADC_SingleEnded(0, 0xC583); // read channel 0 PGA = 2 : Full Scale Range = 2.048V
    omronVolt = (omronReading*4.096)/(32768*2);
    if(omronVolt<=calibrations.omronVMin) {
        massflow = calibrations.omronMFMin;
    } else if(omronVolt>=calibrations.omronVMax) {
        massflow = calibrations.omronMFMax;
    } else {
        massflow = calibrations.MF4*pow(omronVolt,(float)4)+calibrations.MF3*pow(omronVolt,(float)3)+calibrations.MF2*pow(omronVolt,(float)2)+calibrations.MF1*omronVolt+calibrations.MF0;
    }
    deltaMflow = massflow-massflowSet;
    digital_pot_set = digital_pot_setpoint;
    wait(5);

    //---------------------------------------------------------------------------------------------//
    //Sets the flow withen +-1.5% of the desired flow rate based on mass flow

    while(abs(deltaMflow)>.015) {

        omronReading = ads.readADC_SingleEnded(0, 0xC583); // read channel 0 PGA = 2 : Full Scale Range = 2.048V
        omronVolt = (omronReading*4.096)/(32768*2);
        //Mass Flow tf from file: UPAS v2 OSU-PrimaryFlowData FullSet 2015-05-29 CQ mods.xlsx
        if(omronVolt<=calibrations.omronVMin) {
            massflow = calibrations.omronMFMin;
        } else if(omronVolt>=calibrations.omronVMax) {
            massflow = calibrations.omronMFMax;
        } else {
            massflow = calibrations.MF4*pow(omronVolt,(float)4)+calibrations.MF3*pow(omronVolt,(float)3)+calibrations.MF2*pow(omronVolt,(float)2)+calibrations.MF1*omronVolt+calibrations.MF0;
        }

        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));
        volflow = massflow/atmoRho;
        massflowSet = volflowSet*atmoRho;
        deltaMflow = massflow-massflowSet;
        //pc.printf("%f,%f,%f,%f,%d,%u,%x\r\n",volflow,massflow,massflowSet,deltaMflow,digital_pot_set,digital_pot_set,digital_pot_set);
        pc.printf("%d,%d,%d,%d,%d,%d\r\n",f_sec,f_min,f_hour,f_date,f_month,f_year,digital_pot_set);
        digital_pot_set = (int)(digital_pot_set+(int)((gainFlow*deltaMflow)));
        if(digital_pot_set>=digitalpotMax) {
            digital_pot_set = digitalpotMax;
        } else if(digital_pot_set<=digitalpotMin) {
            digital_pot_set = digitalpotMin;
        }

        wait(2);
        DigPot.writeRegister(digital_pot_set);
        wait(1);


    }

    sampledVol = 0.0;
    RGB_LED.set_led(0,1,0);



    //** end of initalization **//

    //---------------------------------------------------------------------------------------------//
    //---------------------------------------------------------------------------------------------//
    // Main Control Loop

    logg.attach(&log_data, logInerval); // uses callbacks or block Interrupts for anything that uses i2c
    while(1) {
        //__disable_irq();  // Disable Interrupts
        //RTC.get_time();
        //__enable_irq();   // Enable Interrupts
        //secondsD = (double)RTC.seconds;
        //if(fmod(secondsD,logInerval)==0) {
        //log_data();
        //}
    }

}