/*!
* \fn ilp0100_error Ilp0100_interruptManager(uint32_t InterruptId, bool_t Pin)
* \brief Ilp0100 function manage Interrupts. It calls the ISR as per the Interrupt Id.
* Once the Interrupt is served, it calls Core function interruptClearStatus to clear
* the status.
* \ingroup Platform_Functions
* \param[in] InterruptId : Id of the Interrupt
* \param[in] Pin : Pin Value of GPIO Pin
* \retval ILP0100_ERROR_NONE : Success
* \retval "Other Error Code" : Failure
*/
ilp0100_error Ilp0100_interruptManager(uint32_t InterruptId, bool_t Pin)
{
ilp0100_error Ret=ILP0100_ERROR_NONE;
ILP0100_LOG_FUNCTION_START((void*)&InterruptId, (void*)&Pin);
#ifdef ST_SPECIFIC
if(Pin==INTR_PIN_0)
{
for(i=0;i<32;i++)
{
//Switch Case for interrupt Id on Pin0
switch (InterruptId&(0x01<<i))
{
case INTR_LONGEXP_GLACE_STATS_READY:
break;
case INTR_LONGEXP_HISTOGRAM_STATS_READY:
break;
case INTR_SHORTEXP_GLACE_STATS_READY:
break;
case INTR_SHORTEXP_HISTOGRAM_STATS_READY:
break;
default:
break;
}
}
}
else
{
//Switch Case for interrupt Id on Pin1
}
//! Clear the Interrupt Status
Ret= Ilp0100_interruptClearStatus(InterruptId, Pin);
if (Ret!=ILP0100_ERROR_NONE)
{
ILP0100_ERROR_LOG("Ilp0100_core_interruptClearStatus failed");
ILP0100_LOG_FUNCTION_END(Ret);
return Ret;
}
#else
/* Should contain customer's implementation */
/* Guidelines: */
/* Serve InterruptId interrupt */
#endif /*ST_SPECIFIC*/
ILP0100_LOG_FUNCTION_END(Ret);
return Ret;
}
ilp0100_error Ilp0100_interruptManager(uint32_t InterruptId, bool_t Pin)
{
ilp0100_error Ret=ILP0100_ERROR_NONE;
ILP0100_LOG_FUNCTION_START((void*)&InterruptId, (void*)&Pin);
#ifdef ST_SPECIFIC
if(Pin==INTR_PIN_0)
{
for(i=0;i<32;i++)
{
switch (InterruptId&(0x01<<i))
{
case INTR_LONGEXP_GLACE_STATS_READY:
break;
case INTR_LONGEXP_HISTOGRAM_STATS_READY:
break;
case INTR_SHORTEXP_GLACE_STATS_READY:
break;
case INTR_SHORTEXP_HISTOGRAM_STATS_READY:
break;
default:
break;
}
}
}
else
{
}
Ret= Ilp0100_interruptClearStatus(InterruptId, Pin);
if (Ret!=ILP0100_ERROR_NONE)
{
ILP0100_ERROR_LOG("Ilp0100_core_interruptClearStatus failed");
ILP0100_LOG_FUNCTION_END(Ret);
return Ret;
}
#else
#endif
ILP0100_LOG_FUNCTION_END(Ret);
return Ret;
}
/*!
* \fn ilp0100_error Ilp0100_readFirmware(Ilp0100_structInitFirmware *InitFirmwareData)
* \brief Ilp0100 Read firmware function.
* \ingroup Platform_Functions
* \param[out] InitFirmware
* \retval ILP0100_ERROR_NONE : Success
* \retval "Other Error Code" : Failure
*/
ilp0100_error Ilp0100_readFirmware(struct msm_sensor_ctrl_t *s_ctrl, Ilp0100_structInitFirmware *InitFirmwareData)
{
ilp0100_error Ret=ILP0100_ERROR_NONE;
#ifdef ST_SPECIFIC
uint8_t *pFileName[3];
#else
uint8_t *pFileName[READ_FIRMWARE_COUNT];
#endif /*ST_SPECIFIC*/
ILP0100_LOG_FUNCTION_START((void*)&InitFirmwareData);
#ifdef ST_SPECIFIC
//! Fimware Binary to be read
//pFileName[0]="/prj/imgsw/users/sheenaj/SB_1308/CVerifEnv/Ztrans/Csource/api/Ilp0100_Basic_IPM_Code_out.bin";
pFileName[0]=".\\ILP0100_IPM_Code_out.bin";
//! Copy the contents of Firmware Binary in a Buffer
Ret=Ilp0100_readFileInBuffer(pFileName[0],&InitFirmwareData->pIlp0100Firmware, &InitFirmwareData->Ilp0100FirmwareSize );
if(Ret!=ILP0100_ERROR_NONE)
{
ILP0100_ERROR_LOG("\n Error in Reading Firmware code Binary");
ILP0100_LOG_FUNCTION_END(Ret);
return Ret;
}
//! Calib Data Binary to be read
pFileName[1]=".\\ILP0100_IPM_Data_out.bin";
//! Copy the contents of Calib Data Binary in a Buffer
Ret=Ilp0100_readFileInBuffer(pFileName[1],&InitFirmwareData->pIlp0100SensorGenericCalibData, &InitFirmwareData->Ilp0100SensorGenericCalibDataSize );
if (Ret!=ILP0100_ERROR_NONE)
{
ILP0100_ERROR_LOG("\n Error in Reading Calib Data");
ILP0100_LOG_FUNCTION_END(Ret);
return Ret;
}
//! For part to part Calibration Data
/*InitFirmwareData->pIlp0100SensorRawPart2PartCalibData =0x0;
InitFirmwareData->Ilp0100SensorRawPart2PartCalibDataSize= 0;
*/
//! Part to Part Calib Data Binary to be read
pFileName[2]=".\\ILP0100_lscbuffer_out.bin";
//! Copy the contents of Part to PArt Calib Data Binary in a Buffer
Ret=Ilp0100_readFileInBuffer(pFileName[2],&InitFirmwareData->pIlp0100SensorRawPart2PartCalibData, &InitFirmwareData->Ilp0100SensorRawPart2PartCalibDataSize );
if(Ret!=ILP0100_ERROR_NONE)
{
ILP0100_ERROR_LOG("\n Error in Reading Part to Part Calib Data Binary");
ILP0100_LOG_FUNCTION_END(Ret);
return Ret;
}
#else /*hTC*/
/*Fimware Binary to be read*/
pFileName[0]="ILP0100_IPM_Code_out.bin";
/*Copy the contents of Firmware Binary in a Buffer*/
Ret=Ilp0100_readFileInBuffer(s_ctrl, pFileName[0],
&InitFirmwareData->pIlp0100Firmware,
&(InitFirmwareData->Ilp0100FirmwareSize));
if(Ret!=ILP0100_ERROR_NONE)
{
ILP0100_ERROR_LOG("\n Error in Reading Firmware code Binary");
ILP0100_LOG_FUNCTION_END(Ret);
return Ret;
}
/*Calib Data Binary to be read*/
pFileName[1]="ILP0100_IPM_Data_out.bin";
/*Copy the contents of Calib Data Binary in a Buffer*/
Ret=Ilp0100_readFileInBuffer(s_ctrl, pFileName[1],
&InitFirmwareData->pIlp0100SensorGenericCalibData,
&(InitFirmwareData->Ilp0100SensorGenericCalibDataSize));
if (Ret!=ILP0100_ERROR_NONE)
{
ILP0100_ERROR_LOG("\n Error in Reading Calib Data");
ILP0100_LOG_FUNCTION_END(Ret);
return Ret;
}
pFileName[2]="lscbuffer_rev2.bin";
//! Copy the contents of Part to PArt Calib Data Binary in a Buffer
Ret=Ilp0100_readFileInBuffer(s_ctrl, pFileName[2],&InitFirmwareData->pIlp0100SensorRawPart2PartCalibData, &InitFirmwareData->Ilp0100SensorRawPart2PartCalibDataSize );
if(Ret!=ILP0100_ERROR_NONE)
{
ILP0100_ERROR_LOG("\n Error in Reading Part to Part Calib Data Binary");
ILP0100_LOG_FUNCTION_END(Ret);
return Ret;
}
#endif /*ST_SPECIFIC*/
ILP0100_LOG_FUNCTION_END(Ret);
return Ret;
}
/*!
* \fn ilp0100_error Ilp0100_interruptHandler()
* \brief Ilp0100 function to handle Interrupts, Checks Status Register on both the Pins.
* Calls the Interrupt manager to service the Interrupt.
* \ingroup Platform_Functions
* \retval ILP0100_ERROR_NONE : Success
* \retval "Other Error Code" : Failure
*/
ilp0100_error Ilp0100_interruptHandler()
{
ilp0100_error Ret= ILP0100_ERROR_NONE;
#ifdef ST_SPECIFIC
bool_t Pin=INTR_PIN_0;
uint32_t InterruptReadStatusPin0, InterruptReadStatusPin1;
#else
/* Should contain customer's variables */
#endif /*ST_SPECIFIC*/
ILP0100_LOG_FUNCTION_START(NULL);
#ifdef ST_SPECIFIC
//! Read the Interrupt Status Register on Pin0
Pin=INTR_PIN_0;
Ret= Ilp0100_interruptReadStatus(&InterruptReadStatusPin0, Pin);
if (Ret!=ILP0100_ERROR_NONE)
{
ILP0100_ERROR_LOG("Ilp0100_core_interruptReadStatus failed");
ILP0100_LOG_FUNCTION_END(Ret);
return Ret;
}
//! If any Interrupt is there on Pin 0. Call Interrupt manger with Pin as Pin0.
if(InterruptReadStatusPin0)
{
Ret= Ilp0100_interruptManager(InterruptReadStatusPin0, Pin);
if (Ret!=ILP0100_ERROR_NONE)
{
ILP0100_ERROR_LOG("Ilp0100_interruptManagerPin0 failed");
ILP0100_LOG_FUNCTION_END(Ret);
return Ret;
}
}
Pin=INTR_PIN_1;
//! Read the Interrupt Status Register on Pin1
Ret= Ilp0100_interruptReadStatus(&InterruptReadStatusPin1, Pin);
if (Ret!=ILP0100_ERROR_NONE)
{
ILP0100_ERROR_LOG("Ilp0100_core_interruptReadStatus failed");
ILP0100_LOG_FUNCTION_END(Ret);
return Ret;
}
//! If any Interrupt is there on Pin 1. Call Interrupt manger with Pin as Pin1.
if(InterruptReadStatusPin1)
{
Ret= Ilp0100_interruptManager(InterruptReadStatusPin1, Pin);
if (Ret!=ILP0100_ERROR_NONE)
{
ILP0100_ERROR_LOG("Ilp0100_interruptManagerPin1 failed");
ILP0100_LOG_FUNCTION_END(Ret);
return Ret;
}
}
#else
/* Should contain customer's implementation */
/* Guidelines: */
/* Read the interrupt status and call the interrupt manager for each identified interrupt */
/* in order of priority */
#endif /*ST_SPECIFIC*/
ILP0100_LOG_FUNCTION_END(Ret);
return Ret;
}
ilp0100_error Ilp0100_readFileInBuffer(struct msm_sensor_ctrl_t *s_ctrl, uint8_t *pFileName,uint8_t **pAdd, uint32_t* SizeOfBuffer)
{
ilp0100_error Ret=ILP0100_ERROR_NONE;
#ifdef ST_SPECIFIC
FILE *pFile;
uint8_t *pBuffer;
uint32_t Result;
uint32_t Size;
#else
const struct firmware *fw_rawchip2 = NULL;
int rc = 0;
unsigned char *rawchipII_data_fw;
u32 rawchipII_fw_size;
#endif /*ST_SPECIFIC*/
ILP0100_LOG_FUNCTION_START((void*)&pFileName, (void*)&pAdd);
#ifdef ST_SPECIFIC
//! Open the binary File
pFile = fopen ( pFileName , "rb" );
//ILP0100_DEBUG_LOG("FileName %s",pFileName);
if (pFile==NULL)
{
ILP0100_ERROR_LOG("\nFile error ");
ILP0100_LOG_FUNCTION_END(Ret);
return ILP0100_ERROR;
}
//! Obtain file size:
fseek (pFile , 0 , SEEK_END);
Size = ftell (pFile);
rewind (pFile);
//! allocate buffer of file size
pBuffer= (uint8_t*) malloc (sizeof(uint8_t)*Size);
if (pBuffer == NULL)
{
ILP0100_ERROR_LOG ("\n Memory allocation failed");
ILP0100_LOG_FUNCTION_END(Ret);
return ILP0100_ERROR;
}
//! Load the file in Buffer
Result = fread (pBuffer,1,Size,pFile);
if (Result != Size)
{
Ret=ILP0100_ERROR;
ILP0100_ERROR_LOG("\n File Reading to buffer error");
ILP0100_ERROR_LOG("\n Result read=%d", Result);
free(pBuffer); //! Free the allocated buffer in case of error
ILP0100_LOG_FUNCTION_END(Ret);
return Ret;
}
*pAdd= (uint8_t*)pBuffer;
*SizeOfBuffer=Size;
fclose(pFile);
#else/*hTC*//*TODO:use request firmware*/
//HTC_CAM chuck add the mechanism of request FW.
rc = request_firmware(&fw_rawchip2, pFileName, &(s_ctrl->pdev->dev));
if (rc!=0) {
pr_info("request_firmware for error %d\n", rc);
Ret = ILP0100_ERROR;
return Ret;
}
Ilp0100_store_firmwarwe(fw_rawchip2);
rawchipII_data_fw = (unsigned char *)fw_rawchip2->data;
rawchipII_fw_size = (u32) fw_rawchip2->size;
*pAdd = (uint8_t*)rawchipII_data_fw;
*SizeOfBuffer = rawchipII_fw_size;
//HTC_CAM_END
#endif /*ST_SPECIFIC*/
ILP0100_LOG_FUNCTION_END(Ret);
return Ret;
}
ilp0100_error Ilp0100_readFirmware(struct msm_sensor_ctrl_t *s_ctrl, Ilp0100_structInitFirmware *InitFirmwareData)
{
ilp0100_error Ret=ILP0100_ERROR_NONE;
#ifdef ST_SPECIFIC
uint8_t *pFileName[3];
#else
uint8_t *pFileName[READ_FIRMWARE_COUNT];
#endif
ILP0100_LOG_FUNCTION_START((void*)&InitFirmwareData);
#ifdef ST_SPECIFIC
pFileName[0]=".\\ILP0100_IPM_Code_out.bin";
Ret=Ilp0100_readFileInBuffer(pFileName[0],&InitFirmwareData->pIlp0100Firmware, &InitFirmwareData->Ilp0100FirmwareSize );
if(Ret!=ILP0100_ERROR_NONE)
{
ILP0100_ERROR_LOG("\n Error in Reading Firmware code Binary");
ILP0100_LOG_FUNCTION_END(Ret);
return Ret;
}
pFileName[1]=".\\ILP0100_IPM_Data_out.bin";
Ret=Ilp0100_readFileInBuffer(pFileName[1],&InitFirmwareData->pIlp0100SensorGenericCalibData, &InitFirmwareData->Ilp0100SensorGenericCalibDataSize );
if (Ret!=ILP0100_ERROR_NONE)
{
ILP0100_ERROR_LOG("\n Error in Reading Calib Data");
ILP0100_LOG_FUNCTION_END(Ret);
return Ret;
}
pFileName[2]=".\\ILP0100_lscbuffer_out.bin";
Ret=Ilp0100_readFileInBuffer(pFileName[2],&InitFirmwareData->pIlp0100SensorRawPart2PartCalibData, &InitFirmwareData->Ilp0100SensorRawPart2PartCalibDataSize );
if(Ret!=ILP0100_ERROR_NONE)
{
ILP0100_ERROR_LOG("\n Error in Reading Part to Part Calib Data Binary");
ILP0100_LOG_FUNCTION_END(Ret);
return Ret;
}
#else
pFileName[0]="ILP0100_IPM_Code_out.bin";
Ret=Ilp0100_readFileInBuffer(s_ctrl, pFileName[0],
&InitFirmwareData->pIlp0100Firmware,
&(InitFirmwareData->Ilp0100FirmwareSize));
if(Ret!=ILP0100_ERROR_NONE)
{
ILP0100_ERROR_LOG("\n Error in Reading Firmware code Binary");
ILP0100_LOG_FUNCTION_END(Ret);
return Ret;
}
pFileName[1]="ILP0100_IPM_Data_out.bin";
Ret=Ilp0100_readFileInBuffer(s_ctrl, pFileName[1],
&InitFirmwareData->pIlp0100SensorGenericCalibData,
&(InitFirmwareData->Ilp0100SensorGenericCalibDataSize));
if (Ret!=ILP0100_ERROR_NONE)
{
ILP0100_ERROR_LOG("\n Error in Reading Calib Data");
ILP0100_LOG_FUNCTION_END(Ret);
return Ret;
}
pFileName[2]="lscbuffer_rev2.bin";
Ret=Ilp0100_readFileInBuffer(s_ctrl, pFileName[2],&InitFirmwareData->pIlp0100SensorRawPart2PartCalibData, &InitFirmwareData->Ilp0100SensorRawPart2PartCalibDataSize );
if(Ret!=ILP0100_ERROR_NONE)
{
ILP0100_ERROR_LOG("\n Error in Reading Part to Part Calib Data Binary");
ILP0100_LOG_FUNCTION_END(Ret);
return Ret;
}
#endif
ILP0100_LOG_FUNCTION_END(Ret);
return Ret;
}
ilp0100_error Ilp0100_interruptHandler()
{
ilp0100_error Ret= ILP0100_ERROR_NONE;
#ifdef ST_SPECIFIC
bool_t Pin=INTR_PIN_0;
uint32_t InterruptReadStatusPin0, InterruptReadStatusPin1;
#else
#endif
ILP0100_LOG_FUNCTION_START(NULL);
#ifdef ST_SPECIFIC
Pin=INTR_PIN_0;
Ret= Ilp0100_interruptReadStatus(&InterruptReadStatusPin0, Pin);
if (Ret!=ILP0100_ERROR_NONE)
{
ILP0100_ERROR_LOG("Ilp0100_core_interruptReadStatus failed");
ILP0100_LOG_FUNCTION_END(Ret);
return Ret;
}
if(InterruptReadStatusPin0)
{
Ret= Ilp0100_interruptManager(InterruptReadStatusPin0, Pin);
if (Ret!=ILP0100_ERROR_NONE)
{
ILP0100_ERROR_LOG("Ilp0100_interruptManagerPin0 failed");
ILP0100_LOG_FUNCTION_END(Ret);
return Ret;
}
}
Pin=INTR_PIN_1;
Ret= Ilp0100_interruptReadStatus(&InterruptReadStatusPin1, Pin);
if (Ret!=ILP0100_ERROR_NONE)
{
ILP0100_ERROR_LOG("Ilp0100_core_interruptReadStatus failed");
ILP0100_LOG_FUNCTION_END(Ret);
return Ret;
}
if(InterruptReadStatusPin1)
{
Ret= Ilp0100_interruptManager(InterruptReadStatusPin1, Pin);
if (Ret!=ILP0100_ERROR_NONE)
{
ILP0100_ERROR_LOG("Ilp0100_interruptManagerPin1 failed");
ILP0100_LOG_FUNCTION_END(Ret);
return Ret;
}
}
#else
#endif
ILP0100_LOG_FUNCTION_END(Ret);
return Ret;
}
ilp0100_error Ilp0100_readFileInBuffer(struct msm_sensor_ctrl_t *s_ctrl, uint8_t *pFileName,uint8_t **pAdd, uint32_t* SizeOfBuffer)
{
ilp0100_error Ret=ILP0100_ERROR_NONE;
#ifdef ST_SPECIFIC
FILE *pFile;
uint8_t *pBuffer;
uint32_t Result;
uint32_t Size;
#else
const struct firmware *fw_rawchip2 = NULL;
int rc = 0;
unsigned char *rawchipII_data_fw;
u32 rawchipII_fw_size;
#endif
ILP0100_LOG_FUNCTION_START((void*)&pFileName, (void*)&pAdd);
#ifdef ST_SPECIFIC
pFile = fopen ( pFileName , "rb" );
if (pFile==NULL)
{
ILP0100_ERROR_LOG("\nFile error ");
ILP0100_LOG_FUNCTION_END(Ret);
return ILP0100_ERROR;
}
fseek (pFile , 0 , SEEK_END);
Size = ftell (pFile);
rewind (pFile);
pBuffer= (uint8_t*) malloc (sizeof(uint8_t)*Size);
if (pBuffer == NULL)
{
ILP0100_ERROR_LOG ("\n Memory allocation failed");
ILP0100_LOG_FUNCTION_END(Ret);
return ILP0100_ERROR;
}
Result = fread (pBuffer,1,Size,pFile);
if (Result != Size)
{
Ret=ILP0100_ERROR;
ILP0100_ERROR_LOG("\n File Reading to buffer error");
ILP0100_ERROR_LOG("\n Result read=%d", Result);
free(pBuffer);
ILP0100_LOG_FUNCTION_END(Ret);
return Ret;
}
*pAdd= (uint8_t*)pBuffer;
*SizeOfBuffer=Size;
fclose(pFile);
#else
rc = request_firmware(&fw_rawchip2, pFileName, &(s_ctrl->sensor_i2c_client->client->dev));
if (rc!=0) {
pr_info("request_firmware for error %d\n", rc);
Ret = ILP0100_ERROR;
return Ret;
}
Ilp0100_store_firmwarwe(fw_rawchip2);
rawchipII_data_fw = (unsigned char *)fw_rawchip2->data;
rawchipII_fw_size = (u32) fw_rawchip2->size;
*pAdd = (uint8_t*)rawchipII_data_fw;
*SizeOfBuffer = rawchipII_fw_size;
#endif
ILP0100_LOG_FUNCTION_END(Ret);
return Ret;
}
