/*
 *  PWM_control.h
 *
 *  Created on: 10.07.2024
 *      Author: Hamza
 */
 
#include "TMP1075.h"
#include <eeprom.h>

// see Datasheet for these values
#define EEPROM_I2C_ADDR             0xA0    
#define EEPROM_WRITE_FREQ_INACTIVE  1000   
#define EEPROM_WRITE_FREQ_ACTIVE    100
#define EERROM_MEMORY_ADDR_SIZE     2
#define EEPROM_MEMORY_SIZE          1024000 // in bits
#define EEPROM_PAGE_SIZE            256     // in bits

static I2C_HandleTypeDef* hi2c;
uint32_t current_address;

void eeprom_init(I2C_HandleTypeDef* handle) {
  hi2c = handle;
  current_address = 0;
}

void eeprom_write_status(){
  uint8_t data_length = EEPROM_PAGE_SIZE/8; //32
  uint8_t data[data_length] = {};
  
  data[0] = ((state.current_state << 4) | (current_powerground_status >> 4));
  data[1] = ((current_powerground_status << 4) | (state.error_source >> 4));        // 4 bit powerground | 4 bit error 
  data[2] = ((state.error_source << 4) | (0));                                      // 4 bit error | 4 bit state of charge
  data[3] = (0);                                                                    // 8 bit state of charge
  data[4] = (RELAY_BAT_SIDE_VOLTAGE >> 8);                                          // 16 bit battery voltage
  data[5] = (RELAY_BAT_SIDE_VOLTAGE);                                      
  data[6] = (RELAY_ESC_SIDE_VOLTAGE >> 8);                                          // 16 bit Inverter voltage
  data[7] = (RELAY_ESC_SIDE_VOLTAGE);
  data[8] = (CURRENT_MEASUREMENT >> 8);                                             // 16 bit Inverter voltage
  data[9] = (CURRENT_MEASUREMENT);

  // data 10-35
  for (int i = 10; i < 36; i+=2) {
    data[i]  = ((int) module.auxVoltages[i]) >> 8;
    data[i+1]  = ((int) module.auxVoltages[i]);
  }
  for (int i = 37; i < 50; i++) {
    data[i] = tmp1075_temps[i];
  }
  eeprom_write(data, current_address);
  current_address++;
}

HAL_StatusTypeDef eeprom_read(uint8_t* data, uint16_t address){
  HAL_StatusTypeDef status = HAL_I2C_Mem_Read(
    hi2c, EEPROM_I2C_ADDR, address, 
    2, data, sizeof(data), 50);
  return status;
}

HAL_StatusTypeDef eeprom_write(uint8_t* data, uint16_t address){
  HAL_StatusTypeDef status = HAL_OK; 
  HAL_GPIO_WritePin(EEPROM___WC__GPIO_Port, EEPROM___WC__Pin, GPIO_PIN_RESET);
  if (address < 65535){
    status = HAL_I2C_Mem_Write(
      hi2c, EEPROM_I2C_ADDR,
      current_address, EERROM_MEMORY_ADDR_SIZE,
      data, sizeof(data), 50);
    current_address += sizeof(data); 
  } else if (address > 65535) {
      status = HAL_I2C_Mem_Write(
      hi2c, EEPROM_I2C_ADDR,
      current_address, EERROM_MEMORY_ADDR_SIZE,
      data, sizeof(data), 50);
    current_address += sizeof(data); 
  }
  HAL_GPIO_WritePin(EEPROM___WC__GPIO_Port, EEPROM___WC__Pin, GPIO_PIN_SET);
  return status;
}