#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.h"
#include "src/config.h"


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


uint16_t read_adc_channel(uint8_t slot, uint8_t channel) {
  //printf("Slot: %d, Channel: %d\n", slot, channel);
  ADC_Params adc_params= {0}; 
  uint16_t adc_voltage = 0;
  while (adc_state != ADC_STATE_DONE) {
    switch (adc_state) {
        
        case ADC_STATE_CONFIGURE:
            adc_params.channel = channel;
            adc_params.continuous = ADC_MEASUREMENT_IS_CONTINUOUS;
            
            adc_params.gain = 1;
            adc_params.resolution = 12;
            if (channel == 1 || channel == 2) {
                adc_params.factor = 1000;
            } else {
                adc_params.factor = 1;
            }

            //printf("Config: Memory address of batteries: %p\n", &batteries[0]);
            if (!adc_hal.configure(slot, &adc_params)) {
                return 0xffff;
            }
            if (adc_params.continuous != 1) {
                // in one shot mode we wait first to get the result
                adc_state = ADC_STATE_WAIT;
            } else {
                // in continuous mode we can directly read
                adc_state = ADC_STATE_READ;
                delay_cycles(ADC_CONTINUOUS_DELAY_CYCLES_VOLTAGES);
            }
            break;

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

        case ADC_STATE_READ:
            adc_voltage = adc_hal.read_voltage(slot, &adc_params);
            adc_state = ADC_STATE_DONE;
            break;
        default:
            channel = 0;
            adc_state = ADC_STATE_CONFIGURE;
            break;
    }
  }

  adc_state = ADC_STATE_CONFIGURE;
  return adc_voltage;
}