Exemplo n.º 1
0
/************************************************************************
*
*  Function Name    : PFlashSetProtection.c
*  Description      : This function sets the P-Flash protection to the 
*                     intended protection status 
*  Arguments        : PFLASH_SSD_CONFIG, UINT32
*  Return Value     : UINT32
*
*************************************************************************/
UINT32 PFlashSetProtection(PFLASH_SSD_CONFIG pSSDConfig, \
                                      UINT32 protectStatus)
{
    UINT8 reg0, reg1, reg2, reg3;
    UINT32 ret;
    ret = FTFx_OK;
    reg0 = GET_BIT_24_31(protectStatus);
    reg1 = GET_BIT_16_23(protectStatus);
    reg2 = GET_BIT_8_15(protectStatus);
    reg3 = GET_BIT_0_7(protectStatus);
    
     
    REG_WRITE(pSSDConfig->ftfxRegBase + FTFx_SSD_FPROT0_OFFSET, reg0);
    REG_WRITE(pSSDConfig->ftfxRegBase + FTFx_SSD_FPROT1_OFFSET, reg1);
    REG_WRITE(pSSDConfig->ftfxRegBase + FTFx_SSD_FPROT2_OFFSET, reg2);
    REG_WRITE(pSSDConfig->ftfxRegBase + FTFx_SSD_FPROT3_OFFSET, reg3);
  
    /* Read the value of FPPROT registers */
    if ((REG_READ(pSSDConfig->ftfxRegBase + FTFx_SSD_FPROT0_OFFSET) != reg0) ||\
        (REG_READ(pSSDConfig->ftfxRegBase + FTFx_SSD_FPROT1_OFFSET) != reg1) ||\
        (REG_READ(pSSDConfig->ftfxRegBase + FTFx_SSD_FPROT2_OFFSET) != reg2) ||\
        (REG_READ(pSSDConfig->ftfxRegBase + FTFx_SSD_FPROT3_OFFSET) != reg3))    
    {
        ret = FTFx_ERR_CHANGEPROT; 
    }

    /* Enter Debug state if enabled */
     if (TRUE == (pSSDConfig->DebugEnable))
    {
        ENTER_DEBUG_MODE;
    }

    return(ret);
}
uint32_t SIZE_OPTIMIZATION PFlashSetProtection(PFLASH_SSD_CONFIG pSSDConfig, \
                                      uint32_t protectStatus)
{
    uint32_t ret = FTFx_OK;
    uint32_t addr;
    uint32_t temp0, temp1, temp2, temp3;
    uint8_t reg0, reg1, reg2, reg3;

    reg0 = GET_BIT_24_31(protectStatus);
    reg1 = GET_BIT_16_23(protectStatus);
    reg2 = GET_BIT_8_15(protectStatus);
    reg3 = GET_BIT_0_7(protectStatus);

    addr = pSSDConfig->ftfxRegBase + FTFx_SSD_FPROT0_OFFSET;
    REG_WRITE(addr, reg0);
    temp0 = REG_READ(addr);
    addr = pSSDConfig->ftfxRegBase + FTFx_SSD_FPROT1_OFFSET;
    REG_WRITE(addr, reg1);
    temp1 = REG_READ(addr);
    addr = pSSDConfig->ftfxRegBase + FTFx_SSD_FPROT2_OFFSET;
    REG_WRITE(addr, reg2);
    temp2 = REG_READ(addr);
    addr = pSSDConfig->ftfxRegBase + FTFx_SSD_FPROT3_OFFSET;
    REG_WRITE(addr, reg3);
    temp3 = REG_READ(addr);

    /* Read the value of FPPROT registers */
    if ((temp0 != reg0) || (temp1 != reg1) || (temp2 != reg2) || (temp3 != reg3))
    {
        ret = FTFx_ERR_CHANGEPROT;
    }

#if C90TFS_ENABLE_DEBUG
    /* Enter Debug state if enabled */
    if (TRUE == (pSSDConfig->DebugEnable))
    {
        ENTER_DEBUG_MODE;
    }
#endif

    return(ret);
}