#include "mbed.h"
#include "uLCD_4DGL.h"
#include "ultrasonic.h"

// RGB LED Setup
class   RGBLed
{
public:
    RGBLed(PinName redpin, PinName greenpin, PinName bluepin);
    void    write(float red, float green, float blue);
private:
    PwmOut  _redpin;
    PwmOut  _greenpin;
    PwmOut  _bluepin;
};

RGBLed::RGBLed(PinName redpin, PinName greenpin, PinName bluepin) :
    _redpin(redpin),
    _greenpin(greenpin),
    _bluepin(bluepin) {
    //50Hz PWM clock default a bit too low, go to 2000Hz (less flicker)
    _redpin.period(0.0005);
}

void RGBLed::write(float red, float green, float blue) {
    _redpin = red;
    _greenpin = green;
    _bluepin = blue;
}

volatile bool   distanceChanged = false;
volatile int    newDistance;
volatile bool   updateTemperature = true;
DigitalIn       alarm(p29, PullUp);         //internal pull up
DigitalOut      led1(LED1);
DigitalOut      led2(LED2);
Timeout         distanceTimeout;
Timeout         temperatureTimeout;
Timeout         alarmTimeout;
float           tempC, tempF;
AnalogIn        TMP36(p15);
uLCD_4DGL       uLCD(p9, p10, p11);         // serial tx, serial rx, reset pin;
RGBLed          myRGBled(p23, p22, p21);    //RGB PWM pins

void  turnLed1Off(void);
void  turnLed2Off(void);
void  dist(int distance);
void  nextUpdate(void);

ultrasonic      mu(p6, p7, .1, 1, &dist);   //Set the trigger pin to p6 and the echo pin to p7

void turnLed1Off(void) {
    led1 = 0;
}

void turnLed2Off(void) {
    led2 = 0;
}

void dist(int distance) {
    distanceChanged = true;
    newDistance = distance;
    if ((distance < 3200) && (led2 != 1)) {
        led2 = 1;
        distanceTimeout.attach(callback(&turnLed2Off), 2.0);
    }
}

void nextUpdate(void) {
    updateTemperature = true;
}

int main(void) {
    mu.startUpdates();
    while (1) {
        if (updateTemperature) {
            tempC = ((TMP36 * 3.3) - 0.600) * 100.0;
            tempF = (9.0 * tempC) / 5.0 + 32.0;
            uLCD.locate(0, 0);
            uLCD.printf("%5.2F%cF", tempF, 176);
            if (tempF > 80) {
                uLCD.locate(0, 1);
                uLCD.printf("HOT ");
                myRGBled.write(1.0, 0.0, 0.0);  //red
            }
            else
            if (tempF < 66) {
                uLCD.locate(0, 1);
                uLCD.printf("COLD");
                myRGBled.write(0.0, 0.0, 1.0);  //blue
            }
            else {
                uLCD.locate(0, 1);
                uLCD.printf("FAIR");
                myRGBled.write(0.0, 1.0, 0.0);  //green
            }
            updateTemperature = false;
            temperatureTimeout.attach(callback(&nextUpdate), 1.0);   // next update after 1s
        }
        mu.checkDistance();
        if (distanceChanged) {
            uLCD.locate(0, 2);
            uLCD.printf("%dmm", newDistance);
            distanceChanged = false;
        }
        if ((!alarm) && (led1 != 1)) {
            led1 = 1;
            alarmTimeout.attach(callback(&turnLed1Off), 2.0);       //  after 2s turn LED1 off
        }
    }
}