Diff: targets/TARGET_Realtek/TARGET_AMEBA/i2c_api.c

Revision:

182:57724642e740

Parent:

181:96ed750bd169

--- a/targets/TARGET_Realtek/TARGET_AMEBA/i2c_api.c	Wed Jan 17 15:23:54 2018 +0000
+++ /dev/null	Thu Jan 01 00:00:00 1970 +0000
@@ -1,582 +0,0 @@
-/* mbed Microcontroller Library
- * Copyright (c) 2013-2016 Realtek Semiconductor Corp.
- *
- * Licensed under the Apache License, Version 2.0 (the "License");
- * you may not use this file except in compliance with the License.
- * You may obtain a copy of the License at
- *
- *     http://www.apache.org/licenses/LICENSE-2.0
- *
- * Unless required by applicable law or agreed to in writing, software
- * distributed under the License is distributed on an "AS IS" BASIS,
- * WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied.
- * See the License for the specific language governing permissions and
- * limitations under the License.
- */
-
-#include "objects.h"
-#include "PinNames.h"
-#include "hal_i2c.h"
-#include "i2c_api.h"
-
-#if CONFIG_I2C_EN
-
-#include "pinmap.h"
-
-
-static const PinMap PinMap_I2C_SDA[] = {
-    {PD_4,  RTL_PIN_PERI(I2C0, 0, S0), RTL_PIN_FUNC(I2C0, S0)},
-    {PH_1,  RTL_PIN_PERI(I2C0, 0, S1), RTL_PIN_FUNC(I2C0, S1)},
-    {PC_8,  RTL_PIN_PERI(I2C0, 0, S2), RTL_PIN_FUNC(I2C0, S2)},
-    {PE_7,  RTL_PIN_PERI(I2C0, 0, S3), RTL_PIN_FUNC(I2C0, S3)},
-    
-    {PC_4,  RTL_PIN_PERI(I2C1, 1, S0), RTL_PIN_FUNC(I2C1, S0)},
-    {PH_3,  RTL_PIN_PERI(I2C1, 1, S1), RTL_PIN_FUNC(I2C1, S1)},
-    {PD_7,  RTL_PIN_PERI(I2C1, 1, S2), RTL_PIN_FUNC(I2C1, S2)},
-
-    {PB_7,  RTL_PIN_PERI(I2C2, 2, S0), RTL_PIN_FUNC(I2C2, S0)},
-    {PE_1,  RTL_PIN_PERI(I2C2, 2, S1), RTL_PIN_FUNC(I2C2, S1)},
-    {PC_7,  RTL_PIN_PERI(I2C2, 2, S2), RTL_PIN_FUNC(I2C2, S2)},
-
-    {PB_3,  RTL_PIN_PERI(I2C3, 3, S0), RTL_PIN_FUNC(I2C3, S0)},
-    {PE_3,  RTL_PIN_PERI(I2C3, 3, S1), RTL_PIN_FUNC(I2C3, S1)},
-    {PE_5,  RTL_PIN_PERI(I2C3, 3, S2), RTL_PIN_FUNC(I2C3, S2)},
-    {PD_9,  RTL_PIN_PERI(I2C3, 3, S3), RTL_PIN_FUNC(I2C3, S3)},
-
-    {NC,    NC,     0}
-};
-
-static const PinMap PinMap_I2C_SCL[] = {
-    {PD_5,  RTL_PIN_PERI(I2C0, 0, S0), RTL_PIN_FUNC(I2C0, S0)},
-    {PH_0,  RTL_PIN_PERI(I2C0, 0, S1), RTL_PIN_FUNC(I2C0, S1)},
-    {PC_9,  RTL_PIN_PERI(I2C0, 0, S2), RTL_PIN_FUNC(I2C0, S2)},
-    {PE_6,  RTL_PIN_PERI(I2C0, 0, S3), RTL_PIN_FUNC(I2C0, S3)},
-
-    {PC_5,  RTL_PIN_PERI(I2C1, 1, S0), RTL_PIN_FUNC(I2C1, S0)},
-    {PH_2,  RTL_PIN_PERI(I2C1, 1, S1), RTL_PIN_FUNC(I2C1, S1)},
-    {PD_6,  RTL_PIN_PERI(I2C1, 1, S2), RTL_PIN_FUNC(I2C1, S2)},
-
-    {PB_6,  RTL_PIN_PERI(I2C2, 2, S0), RTL_PIN_FUNC(I2C2, S0)},
-    {PE_0,  RTL_PIN_PERI(I2C2, 2, S1), RTL_PIN_FUNC(I2C2, S1)},
-    {PC_6,  RTL_PIN_PERI(I2C2, 2, S2), RTL_PIN_FUNC(I2C2, S2)},
-    
-    {PB_2,  RTL_PIN_PERI(I2C3, 3, S0), RTL_PIN_FUNC(I2C3, S0)},
-    {PE_2,  RTL_PIN_PERI(I2C3, 3, S1), RTL_PIN_FUNC(I2C3, S1)},
-    {PE_4,  RTL_PIN_PERI(I2C3, 3, S2), RTL_PIN_FUNC(I2C3, S2)},
-    {PD_8,  RTL_PIN_PERI(I2C3, 3, S3), RTL_PIN_FUNC(I2C3, S3)},
-
-    {NC,    NC,     0}
-};
-
-static int address_save_int[4];
-static int Byte_count[4];
-static u32 address_save[4];
-static uint16_t i2c_target_addr[4];
-static SAL_I2C_TRANSFER_BUF    i2ctxtranbuf[4];
-static SAL_I2C_TRANSFER_BUF    i2crxtranbuf[4];
-extern u32 ConfigDebugErr;
-extern u32 ConfigDebuginfo;
-void i2c_init(i2c_t *obj, PinName sda, PinName scl)
-{    
-    uint32_t i2c_sel;
-    uint32_t i2c_idx;
-    PSAL_I2C_MNGT_ADPT      pSalI2CMngtAdpt     = NULL;
-    PSAL_I2C_USERCB_ADPT    pSalI2CUserCBAdpt   = NULL;
-    PSAL_I2C_HND            pSalI2CHND          = NULL;
-    
-    // Determine the I2C to use
-    uint32_t i2c_sda = (uint32_t)pinmap_peripheral(sda, PinMap_I2C_SDA);
-    uint32_t i2c_scl = (uint32_t)pinmap_peripheral(scl, PinMap_I2C_SCL);
-    ConfigDebugErr &= (~(_DBG_I2C_|_DBG_GDMA_));
-    ConfigDebugInfo&= (~(_DBG_I2C_|_DBG_GDMA_));
-    i2c_sel = (uint32_t)pinmap_merge(i2c_sda, i2c_scl);
-    i2c_idx = RTL_GET_PERI_IDX(i2c_sel);
-    if (unlikely(i2c_idx == NC)) {
-        DBG_8195A("%s: Cannot find matched UART\n", __FUNCTION__);
-        return;
-    }
-        
-    /* Get I2C device handler */
-    pSalI2CMngtAdpt     = &(obj->SalI2CMngtAdpt);
-    pSalI2CUserCBAdpt   = (PSAL_I2C_USERCB_ADPT)&(obj->SalI2CUserCBAdpt);
-       
-
-    /*To assign the rest pointers*/
-    pSalI2CMngtAdpt->MstRDCmdCnt    = 0;
-    pSalI2CMngtAdpt->InnerTimeOut   = 2000; // inner time-out count, 2000 ms
-    pSalI2CMngtAdpt->pSalHndPriv    = &(obj->SalI2CHndPriv);
-    pSalI2CMngtAdpt->pSalHndPriv->ppSalI2CHnd = (void**)&(pSalI2CMngtAdpt->pSalHndPriv);
-
-    /* To assign the default (ROM) HAL OP initialization function */
-#if  defined(CONFIG_CHIP_A_CUT) || defined(CONFIG_CHIP_B_CUT) || defined(CONFIG_CHIP_C_CUT)
-    pSalI2CMngtAdpt->pHalOpInit     = HalI2COpInit_Patch;
-#elif defined(CONFIG_CHIP_E_CUT)
-    pSalI2CMngtAdpt->pHalOpInit     = HalI2COpInit_V04;
-#endif
-    /* To assign the default (ROM) HAL GDMA OP initialization function */
-    pSalI2CMngtAdpt->pHalGdmaOpInit = HalGdmaOpInit;
-
-    /* To assign the default (ROM) SAL interrupt function */
-#if defined(CONFIG_CHIP_A_CUT) || defined(CONFIG_CHIP_B_CUT) || defined(CONFIG_CHIP_C_CUT)
-    pSalI2CMngtAdpt->pSalIrqFunc    = I2CISRHandle_Patch;
-#elif defined(CONFIG_CHIP_E_CUT)
-    pSalI2CMngtAdpt->pSalIrqFunc    = I2CISRHandle_V04;
-#endif
-
-    /* To assign the default (ROM) SAL DMA TX interrupt function */
-    pSalI2CMngtAdpt->pSalDMATxIrqFunc   = I2CTXGDMAISRHandle;
-
-    /* To assign the default (ROM) SAL DMA RX interrupt function */
-    pSalI2CMngtAdpt->pSalDMARxIrqFunc   = I2CRXGDMAISRHandle;
-
-    pSalI2CMngtAdpt->pHalInitDat        = &(obj->HalI2CInitData);
-    pSalI2CMngtAdpt->pHalOp             = &(obj->HalI2COp);
-    pSalI2CMngtAdpt->pIrqHnd            = &(obj->I2CIrqHandleDat);
-    pSalI2CMngtAdpt->pHalTxGdmaAdp      = &(obj->HalI2CTxGdmaAdpt);
-    pSalI2CMngtAdpt->pHalRxGdmaAdp      = &(obj->HalI2CRxGdmaAdpt);
-    pSalI2CMngtAdpt->pHalGdmaOp         = &(obj->HalI2CGdmaOp);
-    pSalI2CMngtAdpt->pIrqTxGdmaHnd      = &(obj->I2CTxGdmaIrqHandleDat);
-    pSalI2CMngtAdpt->pIrqRxGdmaHnd      = &(obj->I2CRxGdmaIrqHandleDat);
-    pSalI2CMngtAdpt->pUserCB            = &(obj->SalI2CUserCB);
-    pSalI2CMngtAdpt->pDMAConf           = &(obj->SalI2CDmaUserDef);
-    
-    /* Assign the private SAL handle to public SAL handle */
-    pSalI2CHND      = &(pSalI2CMngtAdpt->pSalHndPriv->SalI2CHndPriv);
-
-    /* Assign the internal HAL initial data pointer to the SAL handle */
-    pSalI2CHND->pInitDat    = pSalI2CMngtAdpt->pHalInitDat;
-
-    /* Assign the internal user callback pointer to the SAL handle */
-    pSalI2CHND->pUserCB     = pSalI2CMngtAdpt->pUserCB;
-
-    /* Assign the internal user define DMA configuration to the SAL handle */
-    pSalI2CHND->pDMAConf    = pSalI2CMngtAdpt->pDMAConf;
-
-    /*To assign user callback pointers*/
-    pSalI2CMngtAdpt->pUserCB->pTXCB     = pSalI2CUserCBAdpt;
-    pSalI2CMngtAdpt->pUserCB->pTXCCB    = (pSalI2CUserCBAdpt+1);
-    pSalI2CMngtAdpt->pUserCB->pRXCB     = (pSalI2CUserCBAdpt+2);
-    pSalI2CMngtAdpt->pUserCB->pRXCCB    = (pSalI2CUserCBAdpt+3);
-    pSalI2CMngtAdpt->pUserCB->pRDREQCB  = (pSalI2CUserCBAdpt+4);
-    pSalI2CMngtAdpt->pUserCB->pERRCB    = (pSalI2CUserCBAdpt+5);
-    pSalI2CMngtAdpt->pUserCB->pDMATXCB  = (pSalI2CUserCBAdpt+6);
-    pSalI2CMngtAdpt->pUserCB->pDMATXCCB = (pSalI2CUserCBAdpt+7);
-    pSalI2CMngtAdpt->pUserCB->pDMARXCB  = (pSalI2CUserCBAdpt+8);
-    pSalI2CMngtAdpt->pUserCB->pDMARXCCB = (pSalI2CUserCBAdpt+9);
-    pSalI2CMngtAdpt->pUserCB->pGENCALLCB= (pSalI2CUserCBAdpt+10);
-    
-    /* Set I2C Device Number */
-    pSalI2CHND->DevNum = i2c_idx;
-
-    /* Load I2C default value */
-    RtkI2CLoadDefault(pSalI2CHND);
-
-    /* Assign I2C Pin Mux */
-    pSalI2CHND->PinMux        = RTL_GET_PERI_SEL(i2c_sel);
-    pSalI2CHND->OpType        = I2C_INTR_TYPE;
-    pSalI2CHND->I2CMaster     = I2C_MASTER_MODE;
-    pSalI2CHND->I2CSpdMod     = I2C_SS_MODE;
-    pSalI2CHND->I2CClk        = 100;
-    pSalI2CHND->I2CAckAddr    = 0;    
-    pSalI2CHND->TimeOut       = 300;
-    pSalI2CHND->AddRtyTimeOut = 3000;
-    pSalI2CHND->I2CExd         |= (I2C_EXD_MTR_ADDR_RTY);
-
-    pSalI2CMngtAdpt->InnerTimeOut   = pSalI2CHND->TimeOut;
-
-    /* Init I2C now */
-    pSalI2CHND->pInitDat->I2CAckAddr = i2c_target_addr[pSalI2CHND->DevNum];
-    HalI2CSetTarRtl8195a(pSalI2CHND->pInitDat);
-    HalI2CSetSarRtl8195a(pSalI2CHND->pInitDat);
-    RtkI2CInitForPS(pSalI2CHND); 
-}
-
-void i2c_frequency(i2c_t *obj, int hz)
-{
-    PSAL_I2C_MNGT_ADPT      pSalI2CMngtAdpt     = NULL;
-    PSAL_I2C_HND            pSalI2CHND          = NULL;
-    pSalI2CMngtAdpt     = &(obj->SalI2CMngtAdpt);
-    pSalI2CHND          = &(pSalI2CMngtAdpt->pSalHndPriv->SalI2CHndPriv);
-    
-    uint16_t i2c_default_clk    = (uint16_t) pSalI2CHND->I2CClk;
-    uint16_t i2c_user_clk       = (uint16_t) (hz/1000);
-
-        
-    if (i2c_default_clk != i2c_user_clk) {
-        /* Deinit I2C first */
-        i2c_reset(obj);
-        if (i2c_user_clk <= 100) {
-            pSalI2CHND->I2CSpdMod = I2C_SS_MODE;
-        } else if ((i2c_user_clk > 100) && (i2c_user_clk <= 400)) {
-            pSalI2CHND->I2CSpdMod = I2C_FS_MODE;
-        } else if (i2c_user_clk > 400) {
-            pSalI2CHND->I2CSpdMod = I2C_HS_MODE;
-        } else {
-            pSalI2CHND->I2CSpdMod = I2C_SS_MODE;
-        }
-        
-        /* Load the user defined I2C clock */
-        pSalI2CHND->I2CClk = i2c_user_clk;
-
-        /* Init I2C now */
-        pSalI2CHND->pInitDat->I2CAckAddr = i2c_target_addr[pSalI2CHND->DevNum];
-        HalI2CSetTarRtl8195a(pSalI2CHND->pInitDat);
-        HalI2CSetSarRtl8195a(pSalI2CHND->pInitDat);
-        RtkI2CInitForPS(pSalI2CHND);        
-    }
-}
-
-inline int i2c_start(i2c_t *obj)
-{
-    memset(address_save_int , 0, sizeof(address_save_int));
-    memset(Byte_count , 0, sizeof(Byte_count));
-    memset(address_save, 0, sizeof(address_save));
-    return 0;
-}
-
-inline int i2c_stop(i2c_t *obj)
-{
-    return 0;
-}
-
-extern u32 HalDelayUs(IN u32 us);
-
-int i2c_read(i2c_t *obj, int address, char *data, int length, int stop)
-{
-
-    PSAL_I2C_MNGT_ADPT      pSalI2CMngtAdpt     = NULL;
-    PSAL_I2C_HND            pSalI2CHND          = NULL;
-    u32 I2CInTOTcnt     = 0;
-    u32 InTimeoutCount  = 0;
-    u32 InStartCount    = 0;
-    pSalI2CMngtAdpt         = &(obj->SalI2CMngtAdpt);
-    pSalI2CHND              = &(pSalI2CMngtAdpt->pSalHndPriv->SalI2CHndPriv);
-    address = (address & 0xFE ) >>1;
-    
-    if (i2c_target_addr[pSalI2CHND->DevNum] != address) {
-        pSalI2CHND->pInitDat->I2CAckAddr = address;
-        i2c_target_addr[pSalI2CHND->DevNum] = address;
-        HalI2CSetTarRtl8195a(pSalI2CHND->pInitDat);
-    }
-
-    /* Check if the it's the last byte or not */
-    pSalI2CHND->I2CExd &= (~I2C_EXD_MTR_HOLD_BUS);
-    if (!stop) {
-        pSalI2CHND->I2CExd |= I2C_EXD_MTR_HOLD_BUS;
-    }
-
-    pSalI2CHND->pRXBuf            = &i2crxtranbuf[pSalI2CHND->DevNum];
-    pSalI2CHND->pRXBuf->DataLen   = length;
-    pSalI2CHND->pRXBuf->TargetAddr= address;//pSalI2CHND->I2CAckAddr;
-    pSalI2CHND->pRXBuf->RegAddr   = 0;
-    pSalI2CHND->pRXBuf->pDataBuf  = (u8 *)data;
-
-    if (RtkI2CReceive(pSalI2CHND) != HAL_OK) {
-        length = length - pSalI2CHND->pRXBuf->DataLen;
-        return ((int)length);
-    } else {
-        /* Calculate user time out parameters */
-        I2CInTOTcnt = 300;
-        if ((I2CInTOTcnt != 0) && (I2CInTOTcnt != I2C_TIMEOOUT_ENDLESS)) {
-            InTimeoutCount = (I2CInTOTcnt*1000/TIMER_TICK_US);
-            InStartCount = HalTimerOp.HalTimerReadCount(1);
-        }
-        while((pSalI2CHND->DevSts != I2C_STS_IDLE) && 
-              (pSalI2CHND->DevSts != I2C_STS_ERROR) &&
-              (pSalI2CHND->DevSts != I2C_STS_TIMEOUT)) {
-             /* Time-Out check */
-            if (InTimeoutCount > 0) {
-                if (HAL_TIMEOUT == I2CIsTimeout(InStartCount, InTimeoutCount)) {
-                    pSalI2CHND->DevSts  = I2C_STS_TIMEOUT;
-                    pSalI2CHND->ErrType = I2C_ERR_RX_ADD_TO;
-                    
-                    return ((int)(length));
-                }
-            } else {
-                if (I2CInTOTcnt == 0) {
-                    pSalI2CHND->DevSts  = I2C_STS_TIMEOUT;
-                    pSalI2CHND->ErrType = I2C_ERR_RX_ADD_TO;
-                    
-                    return ((int)(length));
-                }
-            }  
-        }
-        if (pSalI2CHND->DevSts != I2C_STS_TIMEOUT) {
-            return ((int)(length - pSalI2CHND->pRXBuf->DataLen));
-        } else {
-            return ((int)(length));
-        }
-    }
-}
-
-int i2c_write(i2c_t *obj, int address, const char *data, int length, int stop)
-{
-    PSAL_I2C_MNGT_ADPT      pSalI2CMngtAdpt     = NULL;
-    PSAL_I2C_HND            pSalI2CHND          = NULL;
-    u32 I2CInTOTcnt     = 0;
-    u32 InTimeoutCount  = 0;
-    u32 InStartCount    = 0;
-    
-    pSalI2CMngtAdpt         = &(obj->SalI2CMngtAdpt);
-    pSalI2CHND              = &(pSalI2CMngtAdpt->pSalHndPriv->SalI2CHndPriv);
-    address = (address & 0xFE ) >>1;
-    
-    pSalI2CHND->pInitDat->I2CAckAddr = address;
-    i2c_target_addr[pSalI2CHND->DevNum] = address;
-    HalI2CSetTarRtl8195a(pSalI2CHND->pInitDat);
-
-    /* Check if the it's the last byte or not */
-    pSalI2CHND->I2CExd &= (~I2C_EXD_MTR_HOLD_BUS);
-    if (!stop) {
-        pSalI2CHND->I2CExd |= I2C_EXD_MTR_HOLD_BUS;
-    }
-    
-    pSalI2CHND->pTXBuf            = &i2ctxtranbuf[pSalI2CHND->DevNum];
-    pSalI2CHND->pTXBuf->DataLen   = length;
-    pSalI2CHND->pTXBuf->TargetAddr= address;
-    pSalI2CHND->pTXBuf->RegAddr   = 0;
-    pSalI2CHND->pTXBuf->pDataBuf  = (u8 *)data;
-
-    if (RtkI2CSend(pSalI2CHND) != HAL_OK) {
-        length = length - pSalI2CHND->pTXBuf->DataLen;
-        return ((int)length);
-    } else {
-        /* Calculate user time out parameters */
-        I2CInTOTcnt = 300;
-        if ((I2CInTOTcnt != 0) && (I2CInTOTcnt != I2C_TIMEOOUT_ENDLESS)) {
-            InTimeoutCount = (I2CInTOTcnt*1000/TIMER_TICK_US);
-            InStartCount = HalTimerOp.HalTimerReadCount(1);
-        }
-        while((pSalI2CHND->DevSts != I2C_STS_IDLE) && 
-              (pSalI2CHND->DevSts != I2C_STS_ERROR) &&
-              (pSalI2CHND->DevSts != I2C_STS_TIMEOUT)) {
-            /* Time-Out check */
-            if (InTimeoutCount > 0) {
-                if (HAL_TIMEOUT == I2CIsTimeout(InStartCount, InTimeoutCount)) {
-                    pSalI2CHND->DevSts  = I2C_STS_TIMEOUT;
-                    pSalI2CHND->ErrType = I2C_ERR_TX_ADD_TO;
-                    return ((int)(length));
-                }
-            } else {
-                if (I2CInTOTcnt == 0) {
-                    pSalI2CHND->DevSts  = I2C_STS_TIMEOUT;
-                    pSalI2CHND->ErrType = I2C_ERR_TX_ADD_TO;
-                    return ((int)(length));
-                }
-            }         
-        }
-
-        if (pSalI2CHND->DevSts != I2C_STS_TIMEOUT) {
-            return ((int)(length - pSalI2CHND->pTXBuf->DataLen));
-        } else {
-            return ((int)(length));
-        }
-    }
-}
-
-int i2c_byte_read(i2c_t *obj, int last)
-{
-    uint8_t i2cdatlocal;
-    PSAL_I2C_MNGT_ADPT      pSalI2CMngtAdpt     = NULL;
-    PSAL_I2C_HND            pSalI2CHND          = NULL;
-    pSalI2CMngtAdpt         = &(obj->SalI2CMngtAdpt);
-    pSalI2CHND              = &(pSalI2CMngtAdpt->pSalHndPriv->SalI2CHndPriv);
-    
-    /* Check if the it's the last byte or not */
-    pSalI2CHND->I2CExd &= (~I2C_EXD_MTR_HOLD_BUS);
-    if (!last) {
-        pSalI2CHND->I2CExd |= I2C_EXD_MTR_HOLD_BUS;
-    }
-
-    pSalI2CHND->pRXBuf            = &i2crxtranbuf[pSalI2CHND->DevNum];
-    pSalI2CHND->pRXBuf->DataLen   = 1;
-    pSalI2CHND->pRXBuf->TargetAddr= i2c_target_addr[pSalI2CHND->DevNum];
-    pSalI2CHND->pRXBuf->RegAddr   = 0;
-    pSalI2CHND->pRXBuf->pDataBuf  = &i2cdatlocal;
-    RtkI2CReceive(pSalI2CHND);
-
-    return (int)i2cdatlocal;
-}
-
-int i2c_byte_write(i2c_t *obj, int data)
-{
-    PSAL_I2C_MNGT_ADPT      pSalI2CMngtAdpt     = NULL;
-    PSAL_I2C_HND            pSalI2CHND          = NULL;
-    pSalI2CMngtAdpt         = &(obj->SalI2CMngtAdpt);
-    pSalI2CHND              = &(pSalI2CMngtAdpt->pSalHndPriv->SalI2CHndPriv);
-    u8 * dp = (u8 *)&address_save[pSalI2CHND->DevNum];
-    if(Byte_count[pSalI2CHND->DevNum]<3){
-        dp[Byte_count[pSalI2CHND->DevNum]] = data;
-        Byte_count[pSalI2CHND->DevNum]++;
-        if(Byte_count[pSalI2CHND->DevNum]==3){
-            address_save_int[pSalI2CHND->DevNum] = (dp[1]<<8)+dp[2];
-        }
-        return 1;
-    }
-    int address = (dp[0] & 0xFE ) >> 1;
-    dp[1]= (unsigned char)(address_save_int[pSalI2CHND->DevNum] >> 8);
-    dp[2]= (unsigned char)(address_save_int[pSalI2CHND->DevNum] & 0xFF);
-    dp[3]= (unsigned char)data;
-    
-    pSalI2CHND->pInitDat->I2CAckAddr = address;
-    i2c_target_addr[pSalI2CHND->DevNum] = address;
-    HalI2CSetTarRtl8195a(pSalI2CHND->pInitDat);
-
-    pSalI2CHND->I2CExd &= (~I2C_EXD_MTR_HOLD_BUS);
-    pSalI2CHND->pTXBuf            = &i2ctxtranbuf[pSalI2CHND->DevNum];
-    pSalI2CHND->pTXBuf->DataLen   = 3;
-    pSalI2CHND->pTXBuf->TargetAddr= i2c_target_addr[pSalI2CHND->DevNum];
-    pSalI2CHND->pTXBuf->RegAddr   = 0;
-    pSalI2CHND->pTXBuf->pDataBuf  = dp+1;
-
-    if (RtkI2CSend(pSalI2CHND) != HAL_OK) {
-        return 0;
-    }
-    address_save_int[pSalI2CHND->DevNum]++;
-    return 1;
-}
-
-void i2c_reset(i2c_t *obj)
-{
-    PSAL_I2C_MNGT_ADPT      pSalI2CMngtAdpt     = NULL;
-    PSAL_I2C_HND            pSalI2CHND          = NULL;
-    pSalI2CMngtAdpt         = &(obj->SalI2CMngtAdpt);
-    pSalI2CHND              = &(pSalI2CMngtAdpt->pSalHndPriv->SalI2CHndPriv);
-    
-    /* Deinit I2C directly */
-    RtkI2CDeInitForPS(pSalI2CHND);
-}
-
-#if DEVICE_I2CSLAVE
-
-void i2c_slave_address(i2c_t *obj, int idx, uint32_t address, uint32_t mask)
-{
-    PSAL_I2C_MNGT_ADPT      pSalI2CMngtAdpt     = NULL;
-    PSAL_I2C_HND            pSalI2CHND          = NULL;
-    pSalI2CMngtAdpt         = &(obj->SalI2CMngtAdpt);
-    pSalI2CHND              = &(pSalI2CMngtAdpt->pSalHndPriv->SalI2CHndPriv);
-    address = (address & 0xFE ) >>1;
-    
-    uint16_t i2c_default_addr   = (uint16_t) pSalI2CHND->I2CAckAddr;
-    uint16_t i2c_user_addr      = (uint16_t) address;
-
-    if (i2c_target_addr[pSalI2CHND->DevNum] != i2c_user_addr) {
-        pSalI2CHND->pInitDat->I2CAckAddr = address;
-        i2c_target_addr[pSalI2CHND->DevNum] = address;
-        HalI2CSetSarRtl8195a(pSalI2CHND->pInitDat);
-    }
-}
-
-void i2c_slave_mode(i2c_t *obj, int enable_slave)
-{
-    PSAL_I2C_MNGT_ADPT      pSalI2CMngtAdpt     = NULL;
-    PSAL_I2C_HND            pSalI2CHND          = NULL;
-    pSalI2CMngtAdpt         = &(obj->SalI2CMngtAdpt);
-    pSalI2CHND              = &(pSalI2CMngtAdpt->pSalHndPriv->SalI2CHndPriv);
-    
-    /* Deinit I2C first */
-    i2c_reset(obj);
-
-    /* Load the user defined I2C clock */
-    pSalI2CHND->I2CMaster = I2C_MASTER_MODE;
-    if (enable_slave) 
-        pSalI2CHND->I2CMaster = I2C_SLAVE_MODE;
-
-    /* Init I2C now */
-    RtkI2CInitForPS(pSalI2CHND);
-
-    pSalI2CHND->pInitDat->I2CAckAddr = i2c_target_addr[pSalI2CHND->DevNum];
-    HalI2CSetSarRtl8195a(pSalI2CHND->pInitDat);
-}
-
-// See I2CSlave.h
-#define NoData         0 // the slave has not been addressed
-#define ReadAddressed  1 // the master has requested a read from this slave (slave = transmitter)
-#define WriteGeneral   2 // the master is writing to all slave
-#define WriteAddressed 3 // the master is writing to this slave (slave = receiver)
-
-int i2c_slave_receive(i2c_t *obj)
-{
-    int i2cslvrevsts = NoData;
-    PSAL_I2C_MNGT_ADPT      pSalI2CMngtAdpt     = NULL;
-    PSAL_I2C_HND            pSalI2CHND          = NULL;
-    pSalI2CMngtAdpt         = &(obj->SalI2CMngtAdpt);
-    pSalI2CHND              = &(pSalI2CMngtAdpt->pSalHndPriv->SalI2CHndPriv);
-    
-    i2cslvrevsts = RtkSalI2CSts(pSalI2CHND);
-    return i2cslvrevsts;
-}
-
-int i2c_slave_read(i2c_t *obj, char *data, int length)
-{
-    u32 I2CInTOTcnt     = 0;
-    u32 InTimeoutCount  = 0;
-    u32 InStartCount    = 0;
-    
-    PSAL_I2C_MNGT_ADPT      pSalI2CMngtAdpt     = NULL;
-    PSAL_I2C_HND            pSalI2CHND          = NULL;
-    pSalI2CMngtAdpt         = &(obj->SalI2CMngtAdpt);
-    pSalI2CHND              = &(pSalI2CMngtAdpt->pSalHndPriv->SalI2CHndPriv);
-    
-    pSalI2CHND->pRXBuf            = &i2crxtranbuf[pSalI2CHND->DevNum];
-    pSalI2CHND->pRXBuf->DataLen   = length;
-    pSalI2CHND->pRXBuf->pDataBuf  = (u8 *)data;
-
-    if (RtkI2CReceive(pSalI2CHND) != HAL_OK) {
-        return 0;   //error
-    } else {
-        /* Calculate user time out parameters */
-        I2CInTOTcnt = 300;
-        if ((I2CInTOTcnt != 0) && (I2CInTOTcnt != I2C_TIMEOOUT_ENDLESS)) {
-            InTimeoutCount = (I2CInTOTcnt*1000/TIMER_TICK_US);
-            InStartCount = HalTimerOp.HalTimerReadCount(1);
-        }
-        while((pSalI2CHND->DevSts != I2C_STS_IDLE) && 
-              (pSalI2CHND->DevSts != I2C_STS_ERROR) &&
-              (pSalI2CHND->DevSts != I2C_STS_TIMEOUT)) {
-            /* Time-Out check */
-            if (InTimeoutCount > 0) {
-                if (HAL_TIMEOUT == I2CIsTimeout(InStartCount, InTimeoutCount)) {
-                    pSalI2CHND->DevSts  = I2C_STS_TIMEOUT;
-                    pSalI2CHND->ErrType = I2C_ERR_RX_ADD_TO;
-                    return ((int)(length));
-                }
-            } else {
-                if (I2CInTOTcnt == 0) {
-                    pSalI2CHND->DevSts  = I2C_STS_TIMEOUT;
-                    pSalI2CHND->ErrType = I2C_ERR_RX_ADD_TO;
-                    return ((int)(length));
-                }
-            }         
-        }
-
-        if (pSalI2CHND->DevSts != I2C_STS_TIMEOUT) {
-            return ((int)(length - pSalI2CHND->pTXBuf->DataLen));
-        } else {
-            return ((int)(length));
-        }
-    }
-}
-
-int i2c_slave_write(i2c_t *obj, const char *data, int length)
-{
-    PSAL_I2C_MNGT_ADPT      pSalI2CMngtAdpt     = NULL;
-    PSAL_I2C_HND            pSalI2CHND          = NULL;
-    pSalI2CMngtAdpt         = &(obj->SalI2CMngtAdpt);
-    pSalI2CHND              = &(pSalI2CMngtAdpt->pSalHndPriv->SalI2CHndPriv);
-    
-    pSalI2CHND->pTXBuf            = &i2ctxtranbuf[pSalI2CHND->DevNum];
-    pSalI2CHND->pTXBuf->DataLen   = length;
-    pSalI2CHND->pTXBuf->pDataBuf  = (u8 *)data;
-
-    if (RtkI2CSend(pSalI2CHND) != HAL_OK) {
-        return 0;   //error
-    }
-
-    return 1;
-}
-
-#endif // CONFIG_I2C_SLAVE_EN
-
-#endif // CONFIG_I2C_EN
-