EFI_STATUS
EFIAPI
I2C_Enable(UINT32 Socket,UINT8 Port)
{
I2C0_ENABLE_U I2cEnableReg;
I2C0_ENABLE_STATUS_U I2cEnableStatusReg;
UINTN Base = GetI2cBase(Socket, Port);
I2C_REG_READ(Base + I2C_ENABLE_OFFSET, I2cEnableReg.Val32);
I2cEnableReg.bits.enable = 1;
I2C_REG_WRITE(Base + I2C_ENABLE_OFFSET, I2cEnableReg.Val32);
I2C_REG_READ(Base + I2C_ENABLE_STATUS_OFFSET, I2cEnableStatusReg.Val32);
if (1 == I2cEnableStatusReg.bits.ic_en)
{
return EFI_SUCCESS;
}
else
{
return EFI_DEVICE_ERROR;
}
}
UINT32 I2C_GetTxStatus(UINT32 Socket,UINT8 Port)
{
I2C0_TXFLR_U ulFifo;
UINTN Base = GetI2cBase(Socket, Port);
I2C_REG_READ(Base + I2C_TXFLR_OFFSET, ulFifo.Val32);
return ulFifo.bits.txflr;
}
EFI_STATUS
EFIAPI
WriteBeforeRead(I2C_DEVICE *I2cInfo, UINT32 ulLength, UINT8 *pBuf)
{
UINT32 ulFifo;
UINT32 ulCnt;
UINT32 ulTimes = 0;
UINTN Base = GetI2cBase(I2cInfo->Socket, I2cInfo->Port);
I2C_SetTarget(I2cInfo->Socket,I2cInfo->Port,I2cInfo->SlaveDeviceAddress);
ulFifo = I2C_GetTxStatus(I2cInfo->Socket,I2cInfo->Port);
while(0 != ulFifo)
{
I2C_Delay(2);
if(++ulTimes > I2C_READ_TIMEOUT)
{
return EFI_TIMEOUT;
}
ulFifo = I2C_GetTxStatus(I2cInfo->Socket,I2cInfo->Port);
}
ulTimes = 0;
for(ulCnt = 0; ulCnt < ulLength; ulCnt++)
{
while(ulFifo > I2C_TXRX_THRESHOLD)
{
if(++ulTimes > I2C_READ_TIMEOUT)
{
return EFI_TIMEOUT;
}
ulFifo = I2C_GetTxStatus(I2cInfo->Socket,I2cInfo->Port);
}
I2C_REG_WRITE(Base + I2C_DATA_CMD_OFFSET, *pBuf++);
ulFifo = I2C_GetTxStatus(I2cInfo->Socket,I2cInfo->Port);
}
ulFifo = I2C_GetTxStatus(I2cInfo->Socket,I2cInfo->Port);
ulTimes = 0;
while(0 != ulFifo)
{
I2C_Delay(2);
if(++ulTimes > I2C_READ_TIMEOUT)
{
return EFI_TIMEOUT;
}
ulFifo = I2C_GetTxStatus(I2cInfo->Socket,I2cInfo->Port);
}
return EFI_SUCCESS;
}
void I2C_SetTarget(UINT32 Socket,UINT8 Port,UINT32 I2cDeviceAddr)
{
I2C0_TAR_U I2cTargetReg;
UINTN Base = GetI2cBase(Socket, Port);
I2C_REG_READ(Base + I2C_TAR_OFFSET, I2cTargetReg.Val32);
I2cTargetReg.bits.ic_tar = I2cDeviceAddr;
I2C_REG_WRITE(Base + I2C_TAR_OFFSET, I2cTargetReg.Val32);
return;
}
EFI_STATUS
EFIAPI
I2CSdaConfig(UINT32 Socket, UINT32 Port)
{
UINTN Base = GetI2cBase(Socket, Port);
if((Socket >= MAX_SOCKET) || (Port >= I2C_PORT_MAX)){
return EFI_INVALID_PARAMETER;
}
I2C_REG_WRITE(Base + I2C_SDA_HOLD, 0x14);
return EFI_SUCCESS;
}
EFI_STATUS
I2cLibRuntimeSetup (UINT32 Socket, UINT8 Port)
{
EFI_STATUS Status;
UINTN Base = GetI2cBase (Socket, Port);
// Declare the controller as EFI_MEMORY_RUNTIME
Status = gDS->AddMemorySpace (
EfiGcdMemoryTypeMemoryMappedIo,
Base, SIZE_64KB,
EFI_MEMORY_UC | EFI_MEMORY_RUNTIME
);
if (EFI_ERROR (Status)) {
return Status;
}
Status = gDS->SetMemorySpaceAttributes (Base, SIZE_64KB, EFI_MEMORY_UC | EFI_MEMORY_RUNTIME);
if (EFI_ERROR (Status)) {
return Status;
}
//
// Register for the virtual address change event
//
// Only create event once
if (mI2cLibVirtualAddrChangeEvent == NULL) {
Status = gBS->CreateEventEx (
EVT_NOTIFY_SIGNAL,
TPL_NOTIFY,
I2cLibVirtualNotifyEvent,
NULL,
&gEfiEventVirtualAddressChangeGuid,
&mI2cLibVirtualAddrChangeEvent
);
if (EFI_ERROR (Status)) {
DEBUG ((EFI_D_ERROR, "[%a:%d] Create event failed: %r\n", __FUNCTION__, __LINE__, Status));
return Status;
}
}
return EFI_SUCCESS;
}
EFI_STATUS
EFIAPI
I2C_Disable(UINT32 Socket,UINT8 Port)
{
UINT32 ulTimeCnt = I2C_READ_TIMEOUT;
I2C0_STATUS_U I2cStatusReg;
I2C0_ENABLE_U I2cEnableReg;
I2C0_ENABLE_STATUS_U I2cEnableStatusReg;
UINTN Base = GetI2cBase(Socket, Port);
I2C_REG_READ((Base + I2C_STATUS_OFFSET), I2cStatusReg.Val32);
while (I2cStatusReg.bits.activity)
{
I2C_Delay(10000);
ulTimeCnt--;
I2C_REG_READ(Base + I2C_STATUS_OFFSET, I2cStatusReg.Val32);
if (0 == ulTimeCnt)
{
return EFI_DEVICE_ERROR;
}
}
I2C_REG_READ(Base + I2C_ENABLE_OFFSET, I2cEnableReg.Val32);
I2cEnableReg.bits.enable = 0;
I2C_REG_WRITE(Base + I2C_ENABLE_OFFSET,I2cEnableReg.Val32);
I2C_REG_READ(Base + I2C_ENABLE_OFFSET,I2cEnableStatusReg.Val32);
if (0 == I2cEnableStatusReg.bits.ic_en)
{
return EFI_SUCCESS;
}
else
{
return EFI_DEVICE_ERROR;
}
}
EFI_STATUS
EFIAPI
I2CWrite(I2C_DEVICE *I2cInfo, UINT16 InfoOffset, UINT32 ulLength, UINT8 *pBuf)
{
UINT32 ulFifo;
UINT32 ulTimes = 0;
UINT32 Idx;
UINTN Base;
if(I2cInfo->Port >= I2C_PORT_MAX)
{
return EFI_INVALID_PARAMETER;
}
Base = GetI2cBase(I2cInfo->Socket, I2cInfo->Port);
(VOID)I2C_Enable(I2cInfo->Socket, I2cInfo->Port);
I2C_SetTarget(I2cInfo->Socket,I2cInfo->Port,I2cInfo->SlaveDeviceAddress);
ulFifo = I2C_GetTxStatus(I2cInfo->Socket,I2cInfo->Port);
while(0 != ulFifo)
{
I2C_Delay(2);
if(++ulTimes > I2C_READ_TIMEOUT)
{
(VOID)I2C_Disable(I2cInfo->Socket, I2cInfo->Port);
return EFI_TIMEOUT;
}
ulFifo = I2C_GetTxStatus(I2cInfo->Socket,I2cInfo->Port);
}
if(I2cInfo->DeviceType)
{
I2C_REG_WRITE(Base + I2C_DATA_CMD_OFFSET, (InfoOffset >> 8) & 0xff);
I2C_REG_WRITE(Base + I2C_DATA_CMD_OFFSET, InfoOffset & 0xff);
}
EFI_STATUS
EFIAPI
I2CInit(UINT32 Socket, UINT32 Port, SPEED_MODE SpeedMode)
{
I2C0_CON_U I2cControlReg;
I2C0_SS_SCL_HCNT_U I2cStandardSpeedSclHighCount;
I2C0_SS_SCL_LCNT_U I2cStandardSpeedSclLowCount;
I2C0_RX_TL_U I2cRxFifoReg;
I2C0_TX_TL_U I2cTxFifoReg;
I2C0_INTR_MASK_U I2cIntrMask;
EFI_STATUS Status;
UINTN Base = GetI2cBase(Socket, Port);
if((Socket >= MAX_SOCKET) || (Port >= I2C_PORT_MAX) || (SpeedMode >= SPEED_MODE_MAX)){
return EFI_INVALID_PARAMETER;
}
Status = I2C_Disable(Socket,Port);
if(EFI_ERROR(Status))
{
return EFI_DEVICE_ERROR;
}
I2C_REG_READ(Base + I2C_CON_OFFSET, I2cControlReg.Val32);
I2cControlReg.bits.master = 1;
I2cControlReg.bits.spedd = 0x1;
I2cControlReg.bits.restart_en = 1;
I2cControlReg.bits.slave_disable = 1;
I2C_REG_WRITE(Base + I2C_CON_OFFSET,I2cControlReg.Val32);
if(Normal == SpeedMode)
{
I2C_REG_READ(Base + I2C_SS_SCL_HCNT_OFFSET,I2cStandardSpeedSclHighCount.Val32);
I2cStandardSpeedSclHighCount.bits.ic_ss_scl_hcnt = I2C_SS_SCLHCNT;
I2C_REG_WRITE(Base + I2C_SS_SCL_HCNT_OFFSET, I2cStandardSpeedSclHighCount.Val32);
I2C_REG_READ(Base + I2C_SS_SCL_LCNT_OFFSET, I2cStandardSpeedSclLowCount.Val32);
I2cStandardSpeedSclLowCount.bits.ic_ss_scl_lcnt = I2C_SS_SCLLCNT;
I2C_REG_WRITE(Base + I2C_SS_SCL_LCNT_OFFSET, I2cStandardSpeedSclLowCount.Val32);
}
else
{
I2C_REG_READ(Base + I2C_FS_SCL_HCNT_OFFSET,I2cStandardSpeedSclHighCount.Val32);
I2cStandardSpeedSclHighCount.bits.ic_ss_scl_hcnt = I2C_SS_SCLHCNT;
I2C_REG_WRITE(Base + I2C_FS_SCL_HCNT_OFFSET, I2cStandardSpeedSclHighCount.Val32);
I2C_REG_READ(Base + I2C_FS_SCL_LCNT_OFFSET, I2cStandardSpeedSclLowCount.Val32);
I2cStandardSpeedSclLowCount.bits.ic_ss_scl_lcnt = I2C_SS_SCLLCNT;
I2C_REG_WRITE(Base + I2C_FS_SCL_LCNT_OFFSET, I2cStandardSpeedSclLowCount.Val32);
}
I2C_REG_READ(Base + I2C_RX_TL_OFFSET, I2cRxFifoReg.Val32);
I2cRxFifoReg.bits.rx_tl = I2C_TXRX_THRESHOLD;
I2C_REG_WRITE(Base + I2C_RX_TL_OFFSET, I2cRxFifoReg.Val32);
I2C_REG_READ(Base + I2C_TX_TL_OFFSET,I2cTxFifoReg.Val32);
I2cTxFifoReg.bits.tx_tl = I2C_TXRX_THRESHOLD;
I2C_REG_WRITE(Base + I2C_TX_TL_OFFSET, I2cTxFifoReg.Val32);
I2C_REG_READ(Base + I2C_INTR_MASK_OFFSET, I2cIntrMask.Val32);
I2cIntrMask.Val32 = 0x0;
I2C_REG_WRITE(Base + I2C_INTR_MASK_OFFSET, I2cIntrMask.Val32);
Status = I2C_Enable(Socket,Port);
if(EFI_ERROR(Status))
{
return EFI_DEVICE_ERROR;
}
return I2cLibRuntimeSetup (Socket, Port);
}
