#include "voltage.h"
#include "uart.h"

void ADC0_init(void) {
    /* Initializing ADC0 pin*/
    /*Voltage reading on pin pd6*/ 
    PORTD.PIN6CTRL &= ~PORT_ISC_gm;
    PORTD.PIN6CTRL |= PORT_ISC_INPUT_DISABLE_gc; /* Disable  */
    PORTD.PIN6CTRL &= PORT_PULLUPEN_bm;
    
    /* Thermistor */
    PORTD.PIN3CTRL &= ~PORT_ISC_gm;
    PORTD.PIN3CTRL |= PORT_ISC_INPUT_DISABLE_gc; /* Disable  */
    PORTD.PIN3CTRL &= PORT_PULLUPEN_bm;
    
    ADC0.CTRLC = ADC_PRESC_DIV4_gc;
    VREF.ADC0REF = VREF_REFSEL_VDD_gc; /* Internal reference */
    ADC0.CTRLA = ADC_ENABLE_bm /* ADC Enable: enabled */
            | ADC_RESSEL_10BIT_gc; /* 10-bit mode */
    /* Select ADC channel */
    ADC0.MUXPOS = ADC_MUXPOS_AIN6_gc;
}

uint16_t ADC0_read(void) {
    /* Start ADC conversion */
    ADC0.COMMAND = ADC_STCONV_bm;
    /* Wait until ADC conversion done */
    while (!(ADC0.INTFLAGS & ADC_RESRDY_bm)) {
        ;
    }
    // Clear the interrupt flag by writing 1:
    ADC0.INTFLAGS = ADC_RESRDY_bm;
    return ADC0.RES;
}

uint16_t thermistor_voltage_read() {
    /* Gets value for the diode */
    ADC0.MUXPOS = 0x03;
    uint16_t adc_val = ADC0_read();

    return adc_val;
}

uint16_t external_voltage_read(){
    ADC0.MUXPOS = 0x02; 
    uint16_t adc_val = ADC0_read();
    
    return adc_val;
}

uint16_t internal_voltage_read() {
    /* Gets value for the internal voltage reffreance*/
    
    ADC0.MUXPOS = 0x44;
    uint8_t adc_val = ADC0_read();
    
    return adc_val*10;
}

/* Takes inn a messured value and converts it to voltage */
uint16_t convert_to_voltage(uint16_t adc_val){
    uint16_t min_in= 0;
    uint16_t min_out= 0;
    uint16_t max_in= 1023;
    uint16_t max_out= 3.3;
    uint16_t voltage = (adc_val-min_in)*(max_out-min_out)/(max_in-min_in) + min_out;
    return voltage;
    
}