#include "mbed.h"

DigitalOut ventil_V1(dp1);
DigitalOut ventil_V2(dp2);
DigitalOut grijac_G1(dp3);

DigitalIn prekidac(dp4);

AnalogIn senzor_S1(dp9);        
AnalogIn senzor_nivo(dp10);     /

const float temperatura_prag = 0.8;   
const float nivo_prag = 0.7;          

bool posuda_puna = false;
bool grijac_ukljucen = false;

int main() {
    ventil_V1 = 0;
    ventil_V2 = 0;
    grijac_G1 = 0;
    
    while (1) {
       
        if (prekidac) {
            ventil_V1 = 1;
            
            while (senzor_nivo.read() < nivo_prag) {
                wait(0.1);  
            }

            posuda_puna = true;
            ventil_V1 = 0;
        }
        
        if (posuda_puna && !grijac_ukljucen) {
            grijac_G1 = 1;  // Uključi grijač
            grijac_ukljucen = true;
        }

        if (grijac_ukljucen) {
            float trenutna_temperatura = senzor_S1.read();  // Očitaj trenutnu vrijednost (0.0 do 1.0)

            if (trenutna_temperatura >= temperatura_prag) {
                grijac_G1 = 0;
                grijac_ukljucen = false;

                ventil_V2 = 1;
                
                while (senzor_nivo.read() > 0.1) {
                    wait(0.1);  
                }
                
                ventil_V2 = 0;
                posuda_puna = false;  
            }
        }
        
        wait(0.5);  
    }
}