#include "mbed.h"
#include "CANMsg.h"

#define baudrate 115200

#define LD1 0x1 			//rdeca
#define LD2 0x2				//modra
#define LD3 0x4				//zelena
#define LD4 0x8				//rumena
#define LD5 0x10			//rdeca

#define THERMISTORNOMINAL 100000 	//100k ohm termistor      
#define TEMPERATURENOMINAL 25    	//temperatura @ 100k
#define BCOEFFICIENT 4303        	//B konstatna termistorja
#define RP 5100									 	//predupor NTCja
#define RD 10000									//delilnik napestosti NTC
#define PELT_STAT 1								//1 = vkljucen, 0 = izkljucen

/* Digitalni, analogni in PWM vhodi/izhodi za PELTIER */
AnalogIn						NTC_signal(PC_0);			// Analogni vhod za NTC peltier
AnalogIn						PELT_sns1(PB_0);			// 24V input
AnalogIn						PELT_sns0(PA_2);			// Vout iz regulatorja
BusOut							LEDS(PB_8, PB_9, PC_13, PC_14, PC_15); //Bus za ledice
PwmOut							PELT_pwm(PA_9);
DigitalOut					PELT_disable(PC_9);
DigitalIn						PELT_thshdn(PC_12);



Serial 							pc(PC_4, PC_5);
CAN can							(PA_11,PA_12); //najprej CAN RX, potem CAN TX
CANMsg              rxMsg;
CANMsg              txMsg;


float tempCalc (double adc) {
		/*(5.0V - Uadc)<- padec na 10k uporu (U/10000) <- tok cez upore 5100 (5k1) je upornost serisjkega upora*/
	
		double T, U, Rntc;
		
		U = adc * 3.3; //napetost na PELT_ADC
    Rntc = ((5.0-U)/(U/RD)) - RP; 
		T = Rntc / THERMISTORNOMINAL;								// (R/Ro)
		T = log(T);																	// ln(R/Ro)
		T /= BCOEFFICIENT;													// 1/B * ln(R/Ro)
		T += 1.0 / (TEMPERATURENOMINAL + 273.15);		// + (1/To)
		T = 1.0 / T;																// Invertirano
		T -= 273.15;																// iz K v C
		
    return (T);
}

void LEDtest() {
	
	for(int i = 0; i < 5; i++) {
		
		LEDS = 1<<i;
		wait(0.1);
	}
	LEDS = 0;
	LEDS = LD1; //testno prižge LED 1 (rdeca)
}

int main() {
	
		pc.baud(baudrate);
//		PELT_pwm.period_us(3);
	
//		if(PELT_STAT) {
//				PELT_disable = 1; // omogocen peltier
//				PELT_pwm.pulsewidth(0.2); // duty cycle 20%
//		}
		
		LEDtest();
		
    while(1) {
				LEDS = 0x02;
				wait(0.05);
				float Tpelt = (float)tempCalc(NTC_signal.read()); //preberi adc PELT in preracunaj temperaturo
				float VregPelt = PELT_sns0 * 24;
			  float Vpelt = PELT_sns1 * 24;
			  pc.printf("Vpelt = %2.f V, VregPelt = %.2fV \r\n",Vpelt,VregPelt);
				pc.printf("TempPelt = %.2f\r\n",Tpelt);
        pc.printf("\033[3A"); //skoci na zacetek terminala
        LEDS = 0x00;
//				if(PELT_thshdn) {
//					PELT_disable = 0;
//					PELT_pwm.pulsewidth(0.0);
//				}
        wait(1.0);
    }
}