/**
  *******************************************************************************
  *
  * @file    sensors.c
  * @authors fatih.bellachia@lapp.in2p3.fr
  * @date    30/09/2015
  * @version v0r1
  * @brief   Example of sensors registration in Resource Broker.
  *
  *******************************************************************************
  */

/* Includes ------------------------------------------------------------------*/
#include <stdio.h>
#include <channel/channel.h>
#include <resourceBroker/resourceBroker.h>
#include <i2c/i2clib.h>
#include <ipmb/ipmblib.h>
#include <module/module.h>
#include <sensors/sensors.h>

#include "cfg_data.h"

/** @addtogroup Component
  * @{
  */

/** @defgroup Sensors
  * @{
  */

/* Private typedef -----------------------------------------------------------*/

/* Private define ------------------------------------------------------------*/

/* Private macro -------------------------------------------------------------*/

/* Private variables ---------------------------------------------------------*/
uint32_t auiChannel2Bus[CHANNEL_NUMBER] = {
  IPMB_0, -1, I2C_MGT, I2C_SENSOR, I2C_USR, I2C_IPM_IO, -1, IPMB_L,
  -1,     -1, -1,      -1,         -1,      -1,         -1, -1
};

/* Private function prototypes -----------------------------------------------*/

/* Public variables ----------------------------------------------------------*/

/* Private functions ---------------------------------------------------------*/

/*----------------------------------------------------------------------------*/
static bool InitSensorIQ65033(struct RBResource *pstResource)
/*----------------------------------------------------------------------------*/
{
  // Sanity check
  if (pstResource == NULL)
    return false;

  // The four high-order bits of I2C address for the IQ65033 are set to 0101
  if ((pstResource->ucAddress & 0x78) != 0x28) // Changed mask
    return false;

  uint32_t uiI2Cx = auiChannel2Bus[pstResource->ucChannelId]; 

  if (uiI2Cx == 0xFFFFFFFF)
    return false;

  return (iq65033Config(uiI2Cx, pstResource->ucAddress) != -1);
}

/*----------------------------------------------------------------------------*/
static bool ReadSensorIQ65033(struct RBResource *pstResource, uint8_t *pucData)
/*----------------------------------------------------------------------------*/
{
  // Sanity check
  if ((pstResource == NULL) || (pucData == NULL))
    return false;

  // The four high-order bits of I2C address for the IQ65033 are set to 0101
  //if ((pstResource->ucAddress & 0x28) != 0x28)
  if ((pstResource->ucAddress & 0x78) != 0x28) // Changed mask
    return false;

  int iRtn;
  uint32_t uiI2Cx = auiChannel2Bus[pstResource->ucChannelId]; 
  uint8_t ucIdx = pstResource->ucIdentifier - SDR_NUM_IQ65033_STATUS;

  if (uiI2Cx == 0xFFFFFFFF)
    return false;

  if ((iRtn = iq65033Read(uiI2Cx, pstResource->ucAddress, ucIdx)) == -1)
    return false;

  *pucData = (uint8_t)iRtn;

  return true;
}

/*----------------------------------------------------------------------------*/
static int WriteSensorIQ65033(struct RBResource *pstResource, void *pvBuffer,
                             uint32_t uiLength)
/*----------------------------------------------------------------------------*/
{
  // Sanity check
  if ((pstResource == NULL) || (pvBuffer == NULL))
    return -1;

  // The four high-order bits of I2C address for the IQ65033 are set to 0101
  //if ((pstResource->ucAddress & 0x28) != 0x28)
  if ((pstResource->ucAddress & 0x78) != 0x28) // Changed mask
    return -1;

  // Nothing to do...

  return uiLength;
}

/* Public functions ----------------------------------------------------------*/
/*----------------------------------------------------------------------------*/
bool SensorsInit()
/*----------------------------------------------------------------------------*/
{
  RBResource_t stResource;


/*
  // IQ65033 HU_CAP Voltage
  stResource.ucChannelId  = CHANNEL_I2C_MGT;
  stResource.ucAddress    = SDR_IQ65033_I2C_ADDR;
  stResource.ucIdentifier = SDR_NUM_IQ65033_48V_CURRENT;
  stResource.fnInit       = InitSensorIQ65033;
  stResource.fnRead       = ReadSensorIQ65033;
  stResource.fnWrite      = WriteSensorIQ65033;

  if (ResourceBrokerAddResource("IQ65033 HU_CAP Voltage", &stResource) == false)
    return false;
*/

  // IQ65033 -48V Current
  stResource.ucChannelId  = CHANNEL_I2C_MGT;
  stResource.ucAddress    = SDR_IQ65033_I2C_ADDR;
  stResource.ucIdentifier = SDR_NUM_IQ65033_48V_CURRENT;
  stResource.fnInit       = InitSensorIQ65033;
  stResource.fnRead       = ReadSensorIQ65033;
  stResource.fnWrite      = WriteSensorIQ65033;

  if (ResourceBrokerAddResource("IQ65033 -48V Current", &stResource) == false)
    return false;

/*
  // IQ65033 -48V_A Voltage
  stResource.ucChannelId  = CHANNEL_I2C_MGT;
  stResource.ucAddress    = SDR_IQ65033_I2C_ADDR;
  stResource.ucIdentifier = SDR_NUM_IQ65033_48V_A;
  stResource.fnInit       = InitSensorIQ65033;
  stResource.fnRead       = ReadSensorIQ65033;
  stResource.fnWrite      = WriteSensorIQ65033;

  if (ResourceBrokerAddResource("IQ65033 -48V_A Voltage", &stResource) == false)
    return false;
*/

  // IQ65033 -48V_B Voltage
  stResource.ucChannelId  = CHANNEL_I2C_MGT;
  stResource.ucAddress    = SDR_IQ65033_I2C_ADDR;
  stResource.ucIdentifier = SDR_NUM_IQ65033_48V_B;
  stResource.fnInit       = InitSensorIQ65033;
  stResource.fnRead       = ReadSensorIQ65033;
  stResource.fnWrite      = WriteSensorIQ65033;

  if (ResourceBrokerAddResource("IQ65033 -48V_B Voltage", &stResource) == false)
    return false;

  // IQ65033 Temperature
  stResource.ucChannelId  = CHANNEL_I2C_MGT;
  stResource.ucAddress    = SDR_IQ65033_I2C_ADDR;
  stResource.ucIdentifier = SDR_NUM_IQ65033_TEMP;
  stResource.fnInit       = InitSensorIQ65033;
  stResource.fnRead       = ReadSensorIQ65033;
  stResource.fnWrite      = WriteSensorIQ65033;

  if (ResourceBrokerAddResource("IQ65033 Temp", &stResource) == false)
    return false;

  ResourceBrokerDumpResources("DEBUG> [SensorsInit]");

  return true;
}

/*----------------------------------------------------------------------------*/
bool SensorsClean()
/*----------------------------------------------------------------------------*/
{
  bool bRtn = true;

  //bRtn &= ResourceBrokerRemoveResourceByName("AD7414 Temp");
  //bRtn &= ResourceBrokerRemoveResourceByName("LTC4151 12V Current");
  //bRtn &= ResourceBrokerRemoveResourceByName("LTC4151 12V Voltage");
  //bRtn &= ResourceBrokerRemoveResourceByName("IQ65033 HU_CAP Voltage");
  bRtn &= ResourceBrokerRemoveResourceByName("IQ65033 -48V Current");
  //bRtn &= ResourceBrokerRemoveResourceByName("IQ65033 -48V_A Voltage");
  bRtn &= ResourceBrokerRemoveResourceByName("IQ65033 -48V_B Voltage");
  bRtn &= ResourceBrokerRemoveResourceByName("IQ65033 Temp");

  return bRtn;
}

MODULE_BEGIN_DECL(sensors, 1)
  MODULE_NAME("Board sensors")
  MODULE_AUTHOR("fatih.bellachia@lapp.in2p3.fr")
  MODULE_INIT(SensorsInit)
  MODULE_CLEANUP(SensorsClean)
  MODULE_PROCESS(NULL, NULL)
MODULE_END_DECL

/**
  * @}
  */

/**
  * @}
  */