From mboxrd@z Thu Jan 1 00:00:00 1970 Return-Path: Received-SPF: Pass (sender SPF authorized) identity=mailfrom; client-ip=2607:f8b0:4864:20::442; helo=mail-pf1-x442.google.com; envelope-from=ming.huang@linaro.org; receiver=edk2-devel@lists.01.org Received: from mail-pf1-x442.google.com (mail-pf1-x442.google.com [IPv6:2607:f8b0:4864:20::442]) (using TLSv1.2 with cipher ECDHE-RSA-AES128-GCM-SHA256 (128/128 bits)) (No client certificate requested) by ml01.01.org (Postfix) with ESMTPS id 59F61210F30D6 for ; Thu, 16 Aug 2018 05:13:50 -0700 (PDT) Received: by mail-pf1-x442.google.com with SMTP id j8-v6so1949334pff.6 for ; Thu, 16 Aug 2018 05:13:50 -0700 (PDT) DKIM-Signature: v=1; a=rsa-sha256; c=relaxed/relaxed; d=linaro.org; s=google; h=from:to:cc:subject:date:message-id:in-reply-to:references; bh=wgQ6yJ7/crkcZqOILBJETqBngNVmDBEde3VmN0jR2s0=; b=H0RKtv6PxMHPQsu4KdRtFNmE9ffdw9rTRpR83peXsQXhWu7+RPPyEyOzL4E/MlSzaT 1GlEV6rMtyJxy9iXvwy1iDHokeI5+qnfMJsjG6PDDKe9h6LBeRIeiPrtzneBczUx0aZu RlMTZMxgR3oOCU6/GryWARs97qTCrSvqQVtTc= X-Google-DKIM-Signature: v=1; a=rsa-sha256; c=relaxed/relaxed; d=1e100.net; s=20161025; h=x-gm-message-state:from:to:cc:subject:date:message-id:in-reply-to :references; bh=wgQ6yJ7/crkcZqOILBJETqBngNVmDBEde3VmN0jR2s0=; b=JPw6rsEFRj99JhYEuwJDjJy/BdldcoxCxQ/2Kl2KAkJXiQuptrdWHwEFjBMB6B58lt egIrCdmdzNV2VaPFsmC0XGxluQnOphbS5MyBvgns1aKaV8JvqJ/aYdBJLh+Ad1M/p7oD KnSFoBZ4g37WnMCQXz3D3FK+HK4vrhI49LA5jRRkVohwGOPiqibDt/DDySNdSN2RJhgT 74m/Uo4UWhbVBjSCFXdM/zo7fUutk+qFtA0aYOQSa2SDLbVxqCv6GPwovkpi5PVOPrmz 53RSiYE/XPw/jFrLNYKVRgV1YqunMN5Ob5qc+8urkyRLG17wB0BaR40MzOd/NU89CTl7 FVaQ== X-Gm-Message-State: AOUpUlEJHEq8tAyyrIhbo3TOLbbDUAIR/dGrhFui4f2Ct6lAqf1p9bH9 JFIC0T+5oBoddoFBKMZZxThI0w== X-Google-Smtp-Source: AA+uWPzeLAiHQeYl2rDMgqXkP/ItK7NYNeaNV5AeXcxsKkDtNcH+ahNAsY4jEUhdKO00V141qdMiTA== X-Received: by 2002:a62:be03:: with SMTP id l3-v6mr31953514pff.138.1534421629523; Thu, 16 Aug 2018 05:13:49 -0700 (PDT) Received: from localhost.localdomain ([120.31.149.194]) by smtp.gmail.com with ESMTPSA id j27-v6sm46736311pfj.91.2018.08.16.05.13.46 (version=TLS1_2 cipher=ECDHE-RSA-AES128-SHA bits=128/128); Thu, 16 Aug 2018 05:13:48 -0700 (PDT) From: Ming Huang To: leif.lindholm@linaro.org, linaro-uefi@lists.linaro.org, edk2-devel@lists.01.org, graeme.gregory@linaro.org Cc: ard.biesheuvel@linaro.org, michael.d.kinney@intel.com, lersek@redhat.com, guoheyi@huawei.com, wanghuiqiang@huawei.com, huangming23@huawei.com, zhangjinsong2@huawei.com, huangdaode@hisilicon.com, john.garry@huawei.com, xinliang.liu@linaro.org, Ming Huang Date: Thu, 16 Aug 2018 20:12:16 +0800 Message-Id: <20180816121239.44129-14-ming.huang@linaro.org> X-Mailer: git-send-email 2.17.0 In-Reply-To: <20180816121239.44129-1-ming.huang@linaro.org> References: <20180816121239.44129-1-ming.huang@linaro.org> Subject: [PATCH edk2-platforms v3 13/36] Hisilicon/I2C: Modify I2CLib.c for coding style X-BeenThere: edk2-devel@lists.01.org X-Mailman-Version: 2.1.27 Precedence: list List-Id: EDK II Development List-Unsubscribe: , List-Archive: List-Post: List-Help: List-Subscribe: , X-List-Received-Date: Thu, 16 Aug 2018 12:13:50 -0000 Correct coding style for I2CLib.c before adding other I2CLib patches. Contributed-under: TianoCore Contribution Agreement 1.1 Signed-off-by: Ming Huang --- Silicon/Hisilicon/Library/I2CLib/I2CLib.c | 1034 ++++++++++---------- 1 file changed, 499 insertions(+), 535 deletions(-) diff --git a/Silicon/Hisilicon/Library/I2CLib/I2CLib.c b/Silicon/Hisilicon/Library/I2CLib/I2CLib.c index b5b388d756..f03d55d6b2 100644 --- a/Silicon/Hisilicon/Library/I2CLib/I2CLib.c +++ b/Silicon/Hisilicon/Library/I2CLib/I2CLib.c @@ -16,640 +16,604 @@ #include -#include -#include #include #include +#include #include #include +#include #include #include "I2CLibInternal.h" #include "I2CHw.h" -VOID I2C_Delay(UINT32 ulCount) +VOID +I2C_Delay ( + UINT32 Count + ) { - MicroSecondDelay(ulCount); - return; + MicroSecondDelay (Count); + return; } EFI_STATUS EFIAPI -I2C_Disable(UINT32 Socket,UINT8 Port) +I2C_Disable ( + UINT32 Socket, + UINT8 Port + ) { - UINT32 ulTimeCnt = I2C_READ_TIMEOUT; - I2C0_STATUS_U I2cStatusReg; - I2C0_ENABLE_U I2cEnableReg; - I2C0_ENABLE_STATUS_U I2cEnableStatusReg; + UINT32 TimeCnt = I2C_READ_TIMEOUT; + I2C0_STATUS_U I2cStatusReg; + I2C0_ENABLE_U I2cEnableReg; + I2C0_ENABLE_STATUS_U I2cEnableStatusReg; - UINTN Base = GetI2cBase(Socket, Port); + UINTN Base = GetI2cBase (Socket, Port); - I2C_REG_READ((Base + I2C_STATUS_OFFSET), I2cStatusReg.Val32); + I2C_REG_READ ((Base + I2C_STATUS_OFFSET), I2cStatusReg.Val32); - while (I2cStatusReg.bits.activity) - { - I2C_Delay(10000); + while (I2cStatusReg.bits.activity) { + I2C_Delay (10000); - ulTimeCnt--; - I2C_REG_READ(Base + I2C_STATUS_OFFSET, I2cStatusReg.Val32); - if (0 == ulTimeCnt) - { - return EFI_DEVICE_ERROR; - } + TimeCnt--; + I2C_REG_READ (Base + I2C_STATUS_OFFSET, I2cStatusReg.Val32); + if (TimeCnt == 0) { + 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, 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; - } + I2C_REG_READ (Base + I2C_ENABLE_OFFSET, I2cEnableStatusReg.Val32); + if (I2cEnableStatusReg.bits.ic_en == 0) { + return EFI_SUCCESS; + } else { + return EFI_DEVICE_ERROR; + } } EFI_STATUS EFIAPI -I2C_Enable(UINT32 Socket,UINT8 Port) +I2C_Enable ( + UINT32 Socket, + UINT8 Port + ) { - I2C0_ENABLE_U I2cEnableReg; - I2C0_ENABLE_STATUS_U I2cEnableStatusReg; + I2C0_ENABLE_U I2cEnableReg; + I2C0_ENABLE_STATUS_U I2cEnableStatusReg; - UINTN Base = GetI2cBase(Socket, Port); + 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_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; - } + I2C_REG_READ (Base + I2C_ENABLE_STATUS_OFFSET, I2cEnableStatusReg.Val32); + if (I2cEnableStatusReg.bits.ic_en == 1) { + return EFI_SUCCESS; + } else { + return EFI_DEVICE_ERROR; + } } -void I2C_SetTarget(UINT32 Socket,UINT8 Port,UINT32 I2cDeviceAddr) +VOID +I2C_SetTarget ( + UINT32 Socket, + UINT8 Port, + UINT32 I2cDeviceAddr + ) { - I2C0_TAR_U I2cTargetReg; - UINTN Base = GetI2cBase(Socket, Port); + 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); + I2C_REG_READ (Base + I2C_TAR_OFFSET, I2cTargetReg.Val32); + I2cTargetReg.bits.ic_tar = I2cDeviceAddr; + I2C_REG_WRITE (Base + I2C_TAR_OFFSET, I2cTargetReg.Val32); - return; + return; } EFI_STATUS EFIAPI -I2CInit(UINT32 Socket, UINT32 Port, SPEED_MODE SpeedMode) +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); + 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 (SpeedMode == Normal) { + 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); } EFI_STATUS EFIAPI -I2CSdaConfig(UINT32 Socket, UINT32 Port) +I2CSdaConfig ( + UINT32 Socket, + UINT32 Port + ) { + UINTN Base = GetI2cBase (Socket, Port); - UINTN Base = GetI2cBase(Socket, Port); + if ((Socket >= MAX_SOCKET) || (Port >= I2C_PORT_MAX)) { + return EFI_INVALID_PARAMETER; + } - if((Socket >= MAX_SOCKET) || (Port >= I2C_PORT_MAX)){ - return EFI_INVALID_PARAMETER; - } - - I2C_REG_WRITE(Base + I2C_SDA_HOLD, 0x14); + I2C_REG_WRITE (Base + I2C_SDA_HOLD, 0x14); - return EFI_SUCCESS; + return EFI_SUCCESS; } -UINT32 I2C_GetTxStatus(UINT32 Socket,UINT8 Port) +UINT32 +I2C_GetTxStatus ( + UINT32 Socket, + UINT8 Port + ) { - I2C0_TXFLR_U ulFifo; - UINTN Base = GetI2cBase(Socket, Port); + I2C0_TXFLR_U Fifo; + UINTN Base = GetI2cBase (Socket, Port); - I2C_REG_READ(Base + I2C_TXFLR_OFFSET, ulFifo.Val32); - return ulFifo.bits.txflr; + I2C_REG_READ (Base + I2C_TXFLR_OFFSET, Fifo.Val32); + return Fifo.bits.txflr; } UINT32 -I2C_GetRxStatus(UINT32 Socket,UINT8 Port) +I2C_GetRxStatus ( + UINT32 Socket, + UINT8 Port + ) { - I2C0_RXFLR_U ulFifo; - UINTN Base = GetI2cBase(Socket, Port); + I2C0_RXFLR_U Fifo; + UINTN Base = GetI2cBase (Socket, Port); - I2C_REG_READ(Base + I2C_RXFLR_OFFSET, ulFifo.Val32); - return ulFifo.bits.rxflr; + I2C_REG_READ (Base + I2C_RXFLR_OFFSET, Fifo.Val32); + return Fifo.bits.rxflr; } EFI_STATUS EFIAPI -WriteBeforeRead(I2C_DEVICE *I2cInfo, UINT32 ulLength, UINT8 *pBuf) +WriteBeforeRead ( + I2C_DEVICE *I2cInfo, + UINT32 Length, + UINT8 *pBuf + ) { - UINT32 ulFifo; - UINT32 ulCnt; - UINT32 ulTimes = 0; + UINT32 Fifo; + UINT32 Count; + UINT32 Times = 0; - UINTN Base = GetI2cBase(I2cInfo->Socket, I2cInfo->Port); + UINTN Base = GetI2cBase (I2cInfo->Socket, I2cInfo->Port); + I2C_SetTarget (I2cInfo->Socket, I2cInfo->Port, I2cInfo->SlaveDeviceAddress); - 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); + Fifo = I2C_GetTxStatus (I2cInfo->Socket, I2cInfo->Port); + while (Fifo != 0) { + I2C_Delay (2); + if (++Times > I2C_READ_TIMEOUT) { + return EFI_TIMEOUT; } + Fifo = I2C_GetTxStatus (I2cInfo->Socket, I2cInfo->Port); + } - for(ulCnt = 0; ulCnt < ulLength; ulCnt++) - { - ulTimes = 0; - while(ulFifo > I2C_TXRX_THRESHOLD) - { - I2C_Delay(2); - 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); + for (Count = 0; Count < Length; Count++) { + Times = 0; + while (Fifo > I2C_TXRX_THRESHOLD) { + I2C_Delay (2); + if (++Times > I2C_READ_TIMEOUT) { + return EFI_TIMEOUT; + } + Fifo = 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); + I2C_REG_WRITE (Base + I2C_DATA_CMD_OFFSET, *pBuf++); + Fifo = I2C_GetTxStatus (I2cInfo->Socket, I2cInfo->Port); + } + + Fifo = I2C_GetTxStatus (I2cInfo->Socket, I2cInfo->Port); + Times = 0; + while (Fifo != 0) { + I2C_Delay (2); + + if (++Times > I2C_READ_TIMEOUT) { + return EFI_TIMEOUT; } + Fifo = I2C_GetTxStatus (I2cInfo->Socket, I2cInfo->Port); + } - return EFI_SUCCESS; + return EFI_SUCCESS; } EFI_STATUS EFIAPI -I2CWrite(I2C_DEVICE *I2cInfo, UINT16 InfoOffset, UINT32 ulLength, UINT8 *pBuf) +I2CWrite( + I2C_DEVICE *I2cInfo, + UINT16 InfoOffset, + UINT32 Length, + 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); - } - else - { - I2C_REG_WRITE(Base + I2C_DATA_CMD_OFFSET, InfoOffset & 0xff); - } - - ulFifo = I2C_GetTxStatus(I2cInfo->Socket,I2cInfo->Port); - ulTimes = 0; - 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); - } - - for(Idx = 0; Idx < ulLength; Idx++) - { - ulTimes = 0; - ulFifo = I2C_GetTxStatus(I2cInfo->Socket,I2cInfo->Port); - while(ulFifo > I2C_TXRX_THRESHOLD) - { - 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 (Idx < ulLength - 1) { - I2C_REG_WRITE(Base + I2C_DATA_CMD_OFFSET, (*pBuf++)); - } else { - //Send command stop bit for the last transfer - I2C_REG_WRITE(Base + I2C_DATA_CMD_OFFSET, (*pBuf++) | I2C_CMD_STOP_BIT); - } - } - - ulFifo = I2C_GetTxStatus(I2cInfo->Socket,I2cInfo->Port); - ulTimes = 0; - while(0 != ulFifo) - { - I2C_Delay(2); - - if(++ulTimes > I2C_READ_TIMEOUT) - { - DEBUG ((EFI_D_ERROR, "I2C Write try to finished,time out!\n")); - (VOID)I2C_Disable(I2cInfo->Socket, I2cInfo->Port); - return EFI_TIMEOUT; - } - ulFifo = I2C_GetTxStatus(I2cInfo->Socket,I2cInfo->Port); - } - (VOID)I2C_Disable(I2cInfo->Socket, I2cInfo->Port); - - return EFI_SUCCESS; + UINT32 Fifo; + UINT32 Times = 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); + + Fifo = I2C_GetTxStatus (I2cInfo->Socket, I2cInfo->Port); + while (Fifo != 0) { + I2C_Delay (2); + if (++Times > I2C_READ_TIMEOUT) { + (VOID)I2C_Disable (I2cInfo->Socket, I2cInfo->Port); + return EFI_TIMEOUT; + } + Fifo = 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); + } else { + I2C_REG_WRITE (Base + I2C_DATA_CMD_OFFSET, InfoOffset & 0xff); + } + + Fifo = I2C_GetTxStatus (I2cInfo->Socket, I2cInfo->Port); + Times = 0; + while (Fifo != 0) { + I2C_Delay (2); + if (++Times > I2C_READ_TIMEOUT) { + (VOID)I2C_Disable (I2cInfo->Socket, I2cInfo->Port); + return EFI_TIMEOUT; + } + Fifo = I2C_GetTxStatus (I2cInfo->Socket, I2cInfo->Port); + } + + for (Idx = 0; Idx < Length; Idx++) { + Times = 0; + Fifo = I2C_GetTxStatus (I2cInfo->Socket, I2cInfo->Port); + while (Fifo > I2C_TXRX_THRESHOLD) { + I2C_Delay (2); + if (++Times > I2C_READ_TIMEOUT) { + (VOID)I2C_Disable (I2cInfo->Socket, I2cInfo->Port); + return EFI_TIMEOUT; + } + Fifo = I2C_GetTxStatus (I2cInfo->Socket, I2cInfo->Port); + } + + if (Idx < Length - 1) { + I2C_REG_WRITE (Base + I2C_DATA_CMD_OFFSET, (*pBuf++)); + } else { + //Send command stop bit for the last transfer + I2C_REG_WRITE (Base + I2C_DATA_CMD_OFFSET, (*pBuf++) | I2C_CMD_STOP_BIT); + } + } + + Fifo = I2C_GetTxStatus (I2cInfo->Socket, I2cInfo->Port); + Times = 0; + while (Fifo != 0) { + I2C_Delay (2); + + if (++Times > I2C_READ_TIMEOUT) { + DEBUG ((DEBUG_ERROR, "I2C Write try to finished,time out!\n")); + (VOID)I2C_Disable (I2cInfo->Socket, I2cInfo->Port); + return EFI_TIMEOUT; + } + Fifo = I2C_GetTxStatus (I2cInfo->Socket, I2cInfo->Port); + } + (VOID)I2C_Disable (I2cInfo->Socket, I2cInfo->Port); + + return EFI_SUCCESS; } EFI_STATUS EFIAPI -I2CRead(I2C_DEVICE *I2cInfo, UINT16 InfoOffset,UINT32 ulRxLen,UINT8 *pBuf) +I2CRead( + I2C_DEVICE *I2cInfo, + UINT16 InfoOffset, + UINT32 RxLen, + UINT8 *pBuf + ) { - UINT32 ulFifo; - UINT32 ulTimes = 0; - UINT8 I2CWAddr[2]; - EFI_STATUS Status; - UINT32 Idx = 0; - UINTN Base; - - - if(I2cInfo->Port >= I2C_PORT_MAX) - { - return EFI_INVALID_PARAMETER; - } - - (VOID)I2C_Enable(I2cInfo->Socket, I2cInfo->Port); - Base = GetI2cBase(I2cInfo->Socket, I2cInfo->Port); - if(I2cInfo->DeviceType) - { - I2CWAddr[0] = (InfoOffset >> 8) & 0xff; - I2CWAddr[1] = (InfoOffset & 0xff); - Status = WriteBeforeRead(I2cInfo, 2,I2CWAddr); - if(EFI_ERROR(Status)) - { - (VOID)I2C_Disable(I2cInfo->Socket, I2cInfo->Port); - return EFI_ABORTED; - } - } - else - { - I2CWAddr[0] = (InfoOffset & 0xff); - Status = WriteBeforeRead(I2cInfo, 1,I2CWAddr); - if(EFI_ERROR(Status)) - { - (VOID)I2C_Disable(I2cInfo->Socket, I2cInfo->Port); - return EFI_ABORTED; - } - } - - I2C_SetTarget(I2cInfo->Socket,I2cInfo->Port,I2cInfo->SlaveDeviceAddress); - - ulFifo = I2C_GetTxStatus(I2cInfo->Socket,I2cInfo->Port); - while(0 != ulFifo) - { - I2C_Delay(2); - - while(++ulTimes > I2C_READ_TIMEOUT) - { - (VOID)I2C_Disable(I2cInfo->Socket, I2cInfo->Port); - return EFI_TIMEOUT; - } - ulFifo = I2C_GetTxStatus(I2cInfo->Socket,I2cInfo->Port); - } - - while (ulRxLen > 0) { - if (ulRxLen > 1) { - I2C_REG_WRITE(Base + I2C_DATA_CMD_OFFSET, I2C_READ_SIGNAL); - } else { - //Send command stop bit for the last transfer - I2C_REG_WRITE(Base + I2C_DATA_CMD_OFFSET, I2C_READ_SIGNAL | I2C_CMD_STOP_BIT); - } - - ulTimes = 0; - do { - I2C_Delay(2); - - while(++ulTimes > I2C_READ_TIMEOUT) { - (VOID)I2C_Disable(I2cInfo->Socket, I2cInfo->Port); - return EFI_TIMEOUT; - } - ulFifo = I2C_GetRxStatus(I2cInfo->Socket,I2cInfo->Port); - }while(0 == ulFifo); - - I2C_REG_READ(Base + I2C_DATA_CMD_OFFSET, pBuf[Idx++]); - - ulRxLen --; - } - (VOID)I2C_Disable(I2cInfo->Socket, I2cInfo->Port); - - return EFI_SUCCESS; + UINT32 Fifo; + UINT32 Times = 0; + UINT8 I2CWAddr[2]; + EFI_STATUS Status; + UINT32 Idx = 0; + UINTN Base; + + if (I2cInfo->Port >= I2C_PORT_MAX) { + return EFI_INVALID_PARAMETER; + } + + (VOID)I2C_Enable(I2cInfo->Socket, I2cInfo->Port); + Base = GetI2cBase (I2cInfo->Socket, I2cInfo->Port); + if (I2cInfo->DeviceType) { + I2CWAddr[0] = (InfoOffset >> 8) & 0xff; + I2CWAddr[1] = (InfoOffset & 0xff); + Status = WriteBeforeRead (I2cInfo, 2,I2CWAddr); + if (EFI_ERROR (Status)) { + (VOID)I2C_Disable (I2cInfo->Socket, I2cInfo->Port); + return EFI_ABORTED; + } + } else { + I2CWAddr[0] = (InfoOffset & 0xff); + Status = WriteBeforeRead (I2cInfo, 1, I2CWAddr); + if (EFI_ERROR (Status)) { + (VOID)I2C_Disable (I2cInfo->Socket, I2cInfo->Port); + return EFI_ABORTED; + } + } + + I2C_SetTarget (I2cInfo->Socket, I2cInfo->Port, I2cInfo->SlaveDeviceAddress); + + Fifo = I2C_GetTxStatus (I2cInfo->Socket, I2cInfo->Port); + while (Fifo != 0) { + I2C_Delay (2); + + while (++Times > I2C_READ_TIMEOUT) { + (VOID)I2C_Disable (I2cInfo->Socket, I2cInfo->Port); + return EFI_TIMEOUT; + } + Fifo = I2C_GetTxStatus (I2cInfo->Socket, I2cInfo->Port); + } + + while (RxLen > 0) { + if (RxLen > 1) { + I2C_REG_WRITE (Base + I2C_DATA_CMD_OFFSET, I2C_READ_SIGNAL); + } else { + //Send command stop bit for the last transfer + I2C_REG_WRITE (Base + I2C_DATA_CMD_OFFSET, I2C_READ_SIGNAL | I2C_CMD_STOP_BIT); + } + + Times = 0; + do { + I2C_Delay (2); + + while (++Times > I2C_READ_TIMEOUT) { + (VOID)I2C_Disable (I2cInfo->Socket, I2cInfo->Port); + return EFI_TIMEOUT; + } + Fifo = I2C_GetRxStatus (I2cInfo->Socket, I2cInfo->Port); + } while (Fifo == 0); + + I2C_REG_READ (Base + I2C_DATA_CMD_OFFSET, pBuf[Idx++]); + + RxLen --; + } + (VOID)I2C_Disable (I2cInfo->Socket, I2cInfo->Port); + + return EFI_SUCCESS; } EFI_STATUS EFIAPI -I2CReadMultiByte(I2C_DEVICE *I2cInfo, UINT32 InfoOffset,UINT32 ulRxLen,UINT8 *pBuf) +I2CReadMultiByte ( + I2C_DEVICE *I2cInfo, + UINT32 InfoOffset, + UINT32 RxLen, + UINT8 *pBuf + ) { - UINT32 ulCnt; - UINT16 usTotalLen = 0; - UINT32 ulFifo; - UINT32 ulTimes = 0; - UINT8 I2CWAddr[4]; - EFI_STATUS Status; - UINT32 BytesLeft; - UINT32 Idx = 0; - UINTN Base; - - - if(I2cInfo->Port >= I2C_PORT_MAX) - { - return EFI_INVALID_PARAMETER; - } - - (VOID)I2C_Enable(I2cInfo->Socket, I2cInfo->Port); - Base = GetI2cBase(I2cInfo->Socket, I2cInfo->Port); - if(I2cInfo->DeviceType == DEVICE_TYPE_E2PROM) - { - I2CWAddr[0] = (InfoOffset >> 8) & 0xff; - I2CWAddr[1] = (InfoOffset & 0xff); - Status = WriteBeforeRead(I2cInfo, 2,I2CWAddr); - if(EFI_ERROR(Status)) - { - (VOID)I2C_Disable(I2cInfo->Socket, I2cInfo->Port); - return EFI_ABORTED; - } - } - - else if(I2cInfo->DeviceType == DEVICE_TYPE_CPLD_3BYTE_OPERANDS) - { - I2CWAddr[0] = (InfoOffset >> 16) & 0xff; - I2CWAddr[1] = (InfoOffset >> 8) & 0xff; - I2CWAddr[2] = (InfoOffset & 0xff); - Status = WriteBeforeRead(I2cInfo, 3,I2CWAddr); - if(EFI_ERROR(Status)) - { - (VOID)I2C_Disable(I2cInfo->Socket, I2cInfo->Port); - return EFI_ABORTED; - } - } - - else if(I2cInfo->DeviceType == DEVICE_TYPE_CPLD_4BYTE_OPERANDS) - { - I2CWAddr[0] = (InfoOffset >> 24) & 0xff; - I2CWAddr[1] = (InfoOffset >> 16) & 0xff; - I2CWAddr[2] = (InfoOffset >> 8) & 0xff; - I2CWAddr[3] = (InfoOffset & 0xff); - Status = WriteBeforeRead(I2cInfo, 4,I2CWAddr); - if(EFI_ERROR(Status)) - { - (VOID)I2C_Disable(I2cInfo->Socket, I2cInfo->Port); - return EFI_ABORTED; - } - } - - else - { - I2CWAddr[0] = (InfoOffset & 0xff); - Status = WriteBeforeRead(I2cInfo, 1,I2CWAddr); - if(EFI_ERROR(Status)) - { - (VOID)I2C_Disable(I2cInfo->Socket, I2cInfo->Port); - return EFI_ABORTED; - } - } - - - I2C_SetTarget(I2cInfo->Socket,I2cInfo->Port,I2cInfo->SlaveDeviceAddress); - usTotalLen = ulRxLen; - BytesLeft = usTotalLen; - - for(ulCnt = 0; ulCnt < BytesLeft; ulCnt++) { - I2C_REG_WRITE(Base + I2C_DATA_CMD_OFFSET, I2C_READ_SIGNAL); - } - - - for(ulCnt = 0; ulCnt < BytesLeft; ulCnt++) { - ulTimes = 0; - do { - I2C_Delay(2); - - while(++ulTimes > I2C_READ_TIMEOUT) { - (VOID)I2C_Disable(I2cInfo->Socket, I2cInfo->Port); - return EFI_TIMEOUT; - } - ulFifo = I2C_GetRxStatus(I2cInfo->Socket,I2cInfo->Port); - }while(0 == ulFifo); - - I2C_REG_READ(Base + I2C_DATA_CMD_OFFSET, pBuf[Idx++]); - } - (VOID)I2C_Disable(I2cInfo->Socket, I2cInfo->Port); - - return EFI_SUCCESS; + UINT32 Count; + UINT16 TotalLen = 0; + UINT32 Fifo; + UINT32 Times = 0; + UINT8 I2CWAddr[4]; + EFI_STATUS Status; + UINT32 BytesLeft; + UINT32 Idx = 0; + UINTN Base; + + if (I2cInfo->Port >= I2C_PORT_MAX) { + return EFI_INVALID_PARAMETER; + } + + (VOID)I2C_Enable (I2cInfo->Socket, I2cInfo->Port); + Base = GetI2cBase (I2cInfo->Socket, I2cInfo->Port); + if (I2cInfo->DeviceType == DEVICE_TYPE_E2PROM) { + I2CWAddr[0] = (InfoOffset >> 8) & 0xff; + I2CWAddr[1] = (InfoOffset & 0xff); + Status = WriteBeforeRead (I2cInfo, 2,I2CWAddr); + if (EFI_ERROR (Status)) { + (VOID)I2C_Disable (I2cInfo->Socket, I2cInfo->Port); + return EFI_ABORTED; + } + } else if (I2cInfo->DeviceType == DEVICE_TYPE_CPLD_3BYTE_OPERANDS) { + I2CWAddr[0] = (InfoOffset >> 16) & 0xff; + I2CWAddr[1] = (InfoOffset >> 8) & 0xff; + I2CWAddr[2] = (InfoOffset & 0xff); + Status = WriteBeforeRead (I2cInfo, 3, I2CWAddr); + if (EFI_ERROR (Status)) { + (VOID)I2C_Disable (I2cInfo->Socket, I2cInfo->Port); + return EFI_ABORTED; + } + } else if (I2cInfo->DeviceType == DEVICE_TYPE_CPLD_4BYTE_OPERANDS) { + I2CWAddr[0] = (InfoOffset >> 24) & 0xff; + I2CWAddr[1] = (InfoOffset >> 16) & 0xff; + I2CWAddr[2] = (InfoOffset >> 8) & 0xff; + I2CWAddr[3] = (InfoOffset & 0xff); + Status = WriteBeforeRead (I2cInfo, 4,I2CWAddr); + if (EFI_ERROR (Status)) { + (VOID)I2C_Disable (I2cInfo->Socket, I2cInfo->Port); + return EFI_ABORTED; + } + } else { + I2CWAddr[0] = (InfoOffset & 0xff); + Status = WriteBeforeRead (I2cInfo, 1,I2CWAddr); + if (EFI_ERROR (Status)) { + (VOID)I2C_Disable (I2cInfo->Socket, I2cInfo->Port); + return EFI_ABORTED; + } + } + + I2C_SetTarget(I2cInfo->Socket, I2cInfo->Port, I2cInfo->SlaveDeviceAddress); + TotalLen = RxLen; + BytesLeft = TotalLen; + + for (Count = 0; Count < BytesLeft; Count++) { + I2C_REG_WRITE (Base + I2C_DATA_CMD_OFFSET, I2C_READ_SIGNAL); + } + + for (Count = 0; Count < BytesLeft; Count++) { + Times = 0; + do { + I2C_Delay (2); + + while (++Times > I2C_READ_TIMEOUT) { + (VOID)I2C_Disable (I2cInfo->Socket, I2cInfo->Port); + return EFI_TIMEOUT; + } + Fifo = I2C_GetRxStatus (I2cInfo->Socket, I2cInfo->Port); + } while (Fifo == 0); + + I2C_REG_READ (Base + I2C_DATA_CMD_OFFSET, pBuf[Idx++]); + } + (VOID)I2C_Disable (I2cInfo->Socket, I2cInfo->Port); + + return EFI_SUCCESS; } EFI_STATUS EFIAPI -I2CWriteMultiByte(I2C_DEVICE *I2cInfo, UINT32 InfoOffset, UINT32 ulLength, UINT8 *pBuf) +I2CWriteMultiByte( + I2C_DEVICE *I2cInfo, + UINT32 InfoOffset, + UINT32 Length, + 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 == DEVICE_TYPE_CPLD_3BYTE_OPERANDS) - { - I2C_REG_WRITE(Base + I2C_DATA_CMD_OFFSET, (InfoOffset >> 16) & 0xff); - I2C_REG_WRITE(Base + I2C_DATA_CMD_OFFSET, (InfoOffset >> 8) & 0xff); - I2C_REG_WRITE(Base + I2C_DATA_CMD_OFFSET, InfoOffset & 0xff); - } - - else if(I2cInfo->DeviceType == DEVICE_TYPE_CPLD_4BYTE_OPERANDS) - { - I2C_REG_WRITE(Base + I2C_DATA_CMD_OFFSET, (InfoOffset >> 24) & 0xff); - I2C_REG_WRITE(Base + I2C_DATA_CMD_OFFSET, (InfoOffset >> 16) & 0xff); - I2C_REG_WRITE(Base + I2C_DATA_CMD_OFFSET, (InfoOffset >> 8) & 0xff); - I2C_REG_WRITE(Base + I2C_DATA_CMD_OFFSET, InfoOffset & 0xff); - } - - else - { - - } - - ulTimes = 0; - for(Idx = 0; Idx < ulLength; Idx++) - { - - I2C_REG_WRITE(Base + I2C_DATA_CMD_OFFSET, *pBuf++); - - } - - ulFifo = I2C_GetTxStatus(I2cInfo->Socket,I2cInfo->Port); - ulTimes = 0; - while(0 != ulFifo) - { - I2C_Delay(2); - - if(++ulTimes > I2C_READ_TIMEOUT) - { - DEBUG ((EFI_D_ERROR, "I2C Write try to finished,time out!\n")); - (VOID)I2C_Disable(I2cInfo->Socket, I2cInfo->Port); - return EFI_TIMEOUT; - } - ulFifo = I2C_GetTxStatus(I2cInfo->Socket,I2cInfo->Port); - } - (VOID)I2C_Disable(I2cInfo->Socket, I2cInfo->Port); - - return EFI_SUCCESS; + UINT32 Fifo; + UINT32 Times = 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); + + Fifo = I2C_GetTxStatus (I2cInfo->Socket, I2cInfo->Port); + while (0 != Fifo) { + I2C_Delay (2); + if (++Times > I2C_READ_TIMEOUT) { + (VOID)I2C_Disable (I2cInfo->Socket, I2cInfo->Port); + return EFI_TIMEOUT; + } + Fifo = I2C_GetTxStatus (I2cInfo->Socket, I2cInfo->Port); + } + + if (I2cInfo->DeviceType == DEVICE_TYPE_CPLD_3BYTE_OPERANDS) { + I2C_REG_WRITE (Base + I2C_DATA_CMD_OFFSET, (InfoOffset >> 16) & 0xff); + I2C_REG_WRITE (Base + I2C_DATA_CMD_OFFSET, (InfoOffset >> 8) & 0xff); + I2C_REG_WRITE (Base + I2C_DATA_CMD_OFFSET, InfoOffset & 0xff); + } else if (I2cInfo->DeviceType == DEVICE_TYPE_CPLD_4BYTE_OPERANDS) { + I2C_REG_WRITE (Base + I2C_DATA_CMD_OFFSET, (InfoOffset >> 24) & 0xff); + I2C_REG_WRITE (Base + I2C_DATA_CMD_OFFSET, (InfoOffset >> 16) & 0xff); + I2C_REG_WRITE (Base + I2C_DATA_CMD_OFFSET, (InfoOffset >> 8) & 0xff); + I2C_REG_WRITE (Base + I2C_DATA_CMD_OFFSET, InfoOffset & 0xff); + } else { + } + + Times = 0; + for (Idx = 0; Idx < Length; Idx++) { + I2C_REG_WRITE (Base + I2C_DATA_CMD_OFFSET, *pBuf++); + } + + Fifo = I2C_GetTxStatus (I2cInfo->Socket, I2cInfo->Port); + Times = 0; + while (Fifo != 0) { + I2C_Delay (2); + + if (++Times > I2C_READ_TIMEOUT) { + DEBUG ((DEBUG_ERROR, "I2C Write try to finished,time out!\n")); + (VOID)I2C_Disable (I2cInfo->Socket, I2cInfo->Port); + return EFI_TIMEOUT; + } + Fifo = I2C_GetTxStatus (I2cInfo->Socket, I2cInfo->Port); + } + (VOID)I2C_Disable (I2cInfo->Socket, I2cInfo->Port); + + return EFI_SUCCESS; } -- 2.17.0