#include "src/battery_data/battery.h"
#include "src/peripherals/adc/adc.h"
#include <stdint.h>
#include <stdio.h>
#include "src/peripherals/adc/adc_interface.h"
#include "src/interfaces/i2c_controller_interface.h"


//static ADC_Params adc_params;
static ADC_MeasurementState adc_state = ADC_STATE_CONFIGURE;


void updateADCReading_multichannel(uint8_t slot, uint8_t channel) {
  //printf("Slot: %d, Channel: %d\n", slot, channel);
  ADC_Params adc_params= {0}; 
  while (adc_state != ADC_STATE_DONE) {
    switch (adc_state) {
        
        case ADC_STATE_CONFIGURE:
            adc_params.channel = channel;
            adc_params.resolution = 12;
            //adc_params.continuous = 1;
            adc_params.gain = 1;
            //printf("Config: Memory address of batteries: %p\n", &batteries[0]);
            adc_hal.configure(slot, &adc_params);
            //adc_state = ADC_STATE_WAIT;
            adc_state = ADC_STATE_READ;
            break;

        case ADC_STATE_WAIT:
            if(adc_hal.is_ready(slot, &adc_params)){
                adc_state = ADC_STATE_READ;
            }
            break;

        case ADC_STATE_READ:
            if (channel == 0) {

                int16_t raw_adc_voltage = adc_hal.read_raw(slot, &adc_params);
                batteries[slot].voltage =
                    adc_hal.convert_voltage(raw_adc_voltage, &adc_params); 
                adc_state = ADC_STATE_DONE;
                printf("[ADC] Battery Voltage in slot %d is %d mV.\n", slot, batteries[slot].voltage);
                //printf("voltage: Memory address of batteries: %p\n", &batteries[0].voltage);

            } else if (channel == 1) {

                int16_t raw_adc_current = adc_hal.read_raw(slot, &adc_params);
                batteries[slot].current =
                    adc_hal.convert_current(raw_adc_current, &adc_params);
                adc_state = ADC_STATE_DONE;
                printf("[ADC] Battery Current in slot %d is %d mA.\n", slot, batteries[slot].current);
                //printf("current: Memory address of batteries: %p\n", &batteries[0]);
            } else if (channel == 2) {

                int16_t raw_adc_voltage = adc_hal.read_raw(slot, &adc_params);
                batteries[slot].voltage =
                    adc_hal.convert_voltage(raw_adc_voltage, &adc_params); 
                adc_state = ADC_STATE_DONE;
                printf("[ADC] Ch3 Voltage in slot %d is %d mV.\n", slot, batteries[slot].voltage);
                //printf("voltage: Memory address of batteries: %p\n", &batteries[0].voltage);

            }
            break;
        default:
            channel = 0;
            adc_state = ADC_STATE_CONFIGURE;
            break;
    }
  }

  adc_state = ADC_STATE_CONFIGURE;
}