#include "mbed.h"
#include "SHTx/sht15.hpp"
#include "SCP1000.h"
#include "uLCD_4DGL.h"
 
uLCD_4DGL uLCD(p28,p27,p29); // Color LCD
SCP1000 scp1000(p5,p6,p7,p8); // Pressure Sensor
SHTx::SHT15 sensor(p9, p10); // Temp / Humidity sensor

float comfort_calc(float val, int min, int max){
    // This function calculates and returns the comfort penalty using a parameter value
    //      and the ranges commonly considered comfortable

    float delta;
    
    if (val < min)  
        delta = val-min;
    else if (val > max)
        delta = val - max;
    else
        delta = 0;      // If value is within comfortable range then there is no penalty
    
    delta = delta * 10 / (max-min); // Scales the penalty relative to the magnitude of probable values
        
    return delta;
}

int main() {

    //declare comfort values 
    float temp_delta = 0;
    float humid_delta = 0;
    float press_delta = 0;
    float color_delta = 0;
    float comfort = 0;

    while(1) {
        
        // Read each sensor and store values
        sensor.update();
        temp = (sensor.getTemperature() + scp1000.readTemperature() )/ 2;   // Averages the 2 available temperature readings
        humid = sensor.getHumidity();
        press = scp1000.readPressure();

        // Calculate the penalty due to each parameter
        temp_delta = comfort_calc(tempF, 65, 75);  // Degrees F
        humid_delta = comfort_calc(humid, 30, 70); // %
        press_delta = comfort_calc(inHg, 28, 31);  // InHg
        color_delta = comfort_calc(red+green+blue, 30, 450); // Arbitrary units

        // Calculates the final comfort value
        comfort = abs(temp_delta) + abs(humid_delta) + abs(press_delta)+ abs(color_delta); // Sums all of the penalties
        if (comfort < 100 )
               comfort = 100 - comfort;  // Puts comfort value on scale of 0-100 with 100 being the most comfortable
        else
               comfort = 0;  // Makes 0 is the lowest comfort level



       ///// Code to print out results goes here //////


         }
}