]> git.sur5r.net Git - freertos/blobdiff - FreeRTOS/Demo/CORTEX_MPU_M23_Nuvoton_NuMaker_PFM_M2351_IAR_GCC/Nuvoton_Code/StdDriver/src/sdh.c
Add Cortex M23 GCC and IAR ports. Add demo projects for Nuvoton NuMaker-PFM-2351.
[freertos] / FreeRTOS / Demo / CORTEX_MPU_M23_Nuvoton_NuMaker_PFM_M2351_IAR_GCC / Nuvoton_Code / StdDriver / src / sdh.c
diff --git a/FreeRTOS/Demo/CORTEX_MPU_M23_Nuvoton_NuMaker_PFM_M2351_IAR_GCC/Nuvoton_Code/StdDriver/src/sdh.c b/FreeRTOS/Demo/CORTEX_MPU_M23_Nuvoton_NuMaker_PFM_M2351_IAR_GCC/Nuvoton_Code/StdDriver/src/sdh.c
new file mode 100644 (file)
index 0000000..bb27778
--- /dev/null
@@ -0,0 +1,1140 @@
+/**************************************************************************//**\r
+ * @file     SDH.c\r
+ * @version  V1.00\r
+ * @brief    M2351 SDH driver source file\r
+ *\r
+ * @note\r
+ * @copyright (C) 2017 Nuvoton Technology Corp. All rights reserved.\r
+*****************************************************************************/\r
+#include <stdio.h>\r
+#include <stdlib.h>\r
+#include <string.h>\r
+#include "NuMicro.h"\r
+\r
+#if defined (__ICCARM__)\r
+# pragma diag_suppress=Pm073, Pm143        /* Misra C 2004 rule 14.7 */\r
+#endif\r
+\r
+\r
+/** @addtogroup Standard_Driver Standard Driver\r
+  @{\r
+*/\r
+\r
+/** @addtogroup SDH_Driver SDH Driver\r
+  @{\r
+*/\r
+\r
+/** @addtogroup SDH_EXPORTED_FUNCTIONS SDH Exported Functions\r
+  @{\r
+*/\r
+\r
+#define SDH_BLOCK_SIZE   512UL\r
+\r
+/* #define DEBUG_PRINTF printf */\r
+#define DEBUG_PRINTF(...)\r
+\r
+/** @cond HIDDEN_SYMBOLS */\r
+\r
+/* global variables */\r
+/* For response R3 (such as ACMD41, CRC-7 is invalid; but SD controller will still */\r
+/* calculate CRC-7 and get an error result, software should ignore this error and clear SDISR [CRC_IF] flag */\r
+/* _sd_uR3_CMD is the flag for it. 1 means software should ignore CRC-7 error */\r
+uint8_t g_u8R3Flag = 0UL;\r
+uint8_t volatile g_u8SDDataReadyFlag = (uint8_t)FALSE;\r
+\r
+static uint32_t _SDH_uR7_CMD = 0UL;\r
+static uint32_t _SDH_ReferenceClock;\r
+\r
+#if defined ( __ICCARM__ ) /*!< IAR Compiler */\r
+#pragma data_alignment = 4\r
+static uint8_t _SDH_ucSDHCBuffer[512];\r
+#else\r
+static __attribute__((aligned)) uint8_t _SDH_ucSDHCBuffer[512];\r
+#endif\r
+\r
+/* Declare these functions here to avoid MISRA C 2004 rule 8.1 error */\r
+void SDH_CheckRB(SDH_T *sdh);\r
+uint32_t SDH_SDCommand(SDH_T *sdh, uint32_t u32Cmd, uint32_t u32Arg);\r
+uint32_t SDH_SDCmdAndRsp(SDH_T *sdh, uint32_t u32Cmd, uint32_t u32Arg, uint32_t u32TickCount);\r
+uint32_t SDH_Swap32(uint32_t u32Val);\r
+uint32_t SDH_SDCmdAndRsp2(SDH_T *sdh, uint32_t u32Cmd, uint32_t u32Arg, uint32_t pu32R2ptr[]);\r
+uint32_t SDH_SDCmdAndRspDataIn(SDH_T *sdh, uint32_t u32Cmd, uint32_t u32Arg);\r
+void SDH_Set_clock(SDH_T *sdh, uint32_t u32SDClockKhz);\r
+uint32_t SDH_CardDetection(SDH_T *sdh);\r
+uint32_t SDH_Init(SDH_T *sdh);\r
+uint32_t SDH_SwitchToHighSpeed(SDH_T *sdh, SDH_INFO_T *pSD);\r
+uint32_t SDH_SelectCardType(SDH_T *sdh);\r
+void SDH_Get_SD_info(SDH_T *sdh);\r
+\r
+int SDH_ok = 0;\r
+\r
+SDH_INFO_T SD0;\r
+\r
+void SDH_CheckRB(SDH_T *sdh)\r
+{\r
+    while(1)\r
+    {\r
+        sdh->CTL |= SDH_CTL_CLK8OEN_Msk;\r
+        while(sdh->CTL & SDH_CTL_CLK8OEN_Msk) {}\r
+        if(sdh->INTSTS & SDH_INTSTS_DAT0STS_Msk)\r
+        {\r
+            break;\r
+        }\r
+    }\r
+}\r
+\r
+\r
+uint32_t SDH_SDCommand(SDH_T *sdh, uint32_t u32Cmd, uint32_t u32Arg)\r
+{\r
+    SDH_INFO_T *pSD;\r
+    volatile uint32_t u32Status = Successful;\r
+\r
+    /* M2351 is only support SDH0 */\r
+    pSD = &SD0;\r
+\r
+    sdh->CMDARG = u32Arg;\r
+    sdh->CTL = (sdh->CTL & (~SDH_CTL_CMDCODE_Msk)) | (u32Cmd << 8) | (SDH_CTL_COEN_Msk);\r
+\r
+    while(sdh->CTL & SDH_CTL_COEN_Msk)\r
+    {\r
+        if(pSD->IsCardInsert == (uint32_t)FALSE)\r
+        {\r
+            u32Status = SDH_NO_SD_CARD;\r
+        }\r
+    }\r
+    return u32Status;\r
+}\r
+\r
+\r
+uint32_t SDH_SDCmdAndRsp(SDH_T *sdh, uint32_t u32Cmd, uint32_t u32Arg, uint32_t u32TickCount)\r
+{\r
+    SDH_INFO_T *pSD;\r
+\r
+    /* M2351 is only support SDH0 */\r
+    pSD = &SD0;\r
+\r
+    sdh->CMDARG = u32Arg;\r
+    sdh->CTL = (sdh->CTL & (~SDH_CTL_CMDCODE_Msk)) | (u32Cmd << 8) | (SDH_CTL_COEN_Msk | SDH_CTL_RIEN_Msk);\r
+\r
+    if(u32TickCount > 0UL)\r
+    {\r
+        while(sdh->CTL & SDH_CTL_RIEN_Msk)\r
+        {\r
+            if(u32TickCount-- == 0UL)\r
+            {\r
+                sdh->CTL |= SDH_CTL_CTLRST_Msk; /* reset SD engine */\r
+                return 2UL;\r
+            }\r
+            if(pSD->IsCardInsert == (uint8_t)FALSE)\r
+            {\r
+                return SDH_NO_SD_CARD;\r
+            }\r
+        }\r
+    }\r
+    else\r
+    {\r
+        while(sdh->CTL & SDH_CTL_RIEN_Msk)\r
+        {\r
+            if(pSD->IsCardInsert == (uint8_t)FALSE)\r
+            {\r
+                return SDH_NO_SD_CARD;\r
+            }\r
+        }\r
+    }\r
+\r
+    if(_SDH_uR7_CMD)\r
+    {\r
+        if((sdh->RESP1 & 0xffUL) != 0x55UL)\r
+        {\r
+            if((sdh->RESP0 & 0xfUL) != 0x01UL)\r
+            {\r
+                _SDH_uR7_CMD = 0UL;\r
+                return SDH_CMD8_ERROR;\r
+            }\r
+        }\r
+    }\r
+\r
+    if(!g_u8R3Flag)\r
+    {\r
+        if(sdh->INTSTS & SDH_INTSTS_CRC7_Msk)      /* check CRC7 */\r
+        {\r
+            return Successful;\r
+        }\r
+        else\r
+        {\r
+            return SDH_CRC7_ERROR;\r
+        }\r
+    }\r
+    else     /* ignore CRC error for R3 case */\r
+    {\r
+        g_u8R3Flag = 0UL;\r
+        sdh->INTSTS = SDH_INTSTS_CRCIF_Msk;\r
+        return Successful;\r
+    }\r
+}\r
+\r
+\r
+uint32_t SDH_Swap32(uint32_t u32Val)\r
+{\r
+    uint32_t u32Buf;\r
+\r
+    u32Buf = u32Val;\r
+    u32Val <<= 24;\r
+    u32Val |= (u32Buf << 8) & 0xff0000UL;\r
+    u32Val |= (u32Buf >> 8) & 0xff00UL;\r
+    u32Val |= (u32Buf >> 24) & 0xffUL;\r
+    return u32Buf;\r
+}\r
+\r
+/* Get 16 bytes CID or CSD */\r
+uint32_t SDH_SDCmdAndRsp2(SDH_T *sdh, uint32_t u32Cmd, uint32_t u32Arg, uint32_t pu32R2ptr[])\r
+{\r
+    uint32_t i;\r
+    uint32_t au32TmpBuf[5];\r
+    SDH_INFO_T *pSD;\r
+\r
+    /* M2351 is only support SDH0 */\r
+    pSD = &SD0;\r
+\r
+    sdh->CMDARG = u32Arg;\r
+    sdh->CTL = (sdh->CTL & (~SDH_CTL_CMDCODE_Msk)) | (u32Cmd << 8) | (SDH_CTL_COEN_Msk | SDH_CTL_R2EN_Msk);\r
+\r
+    while(sdh->CTL & SDH_CTL_R2EN_Msk)\r
+    {\r
+        if(pSD->IsCardInsert == (uint8_t)FALSE)\r
+        {\r
+            return SDH_NO_SD_CARD;\r
+        }\r
+    }\r
+\r
+    if(sdh->INTSTS & SDH_INTSTS_CRC7_Msk)\r
+    {\r
+        for(i = 0UL; i < 5UL; i++)\r
+        {\r
+            au32TmpBuf[i] = SDH_Swap32(sdh->FB[i]);\r
+        }\r
+        for(i = 0UL; i < 4UL; i++)\r
+        {\r
+            pu32R2ptr[i] = ((au32TmpBuf[i] & 0x00ffffffUL) << 8) | ((au32TmpBuf[i + 1UL] & 0xff000000UL) >> 24);\r
+        }\r
+        return Successful;\r
+    }\r
+    else\r
+    {\r
+        return SDH_CRC7_ERROR;\r
+    }\r
+}\r
+\r
+\r
+uint32_t SDH_SDCmdAndRspDataIn(SDH_T *sdh, uint32_t u32Cmd, uint32_t u32Arg)\r
+{\r
+    SDH_INFO_T *pSD;\r
+\r
+    /* M2351 is only support SDH0 */\r
+    pSD = &SD0;\r
+\r
+    sdh->CMDARG = u32Arg;\r
+    sdh->CTL = (sdh->CTL & (~SDH_CTL_CMDCODE_Msk)) | ((uint32_t)u32Cmd << 8) |\r
+               (SDH_CTL_COEN_Msk | SDH_CTL_RIEN_Msk | SDH_CTL_DIEN_Msk);\r
+\r
+    while(sdh->CTL & SDH_CTL_RIEN_Msk)\r
+    {\r
+        if(pSD->IsCardInsert == (uint32_t)FALSE)\r
+        {\r
+            return SDH_NO_SD_CARD;\r
+        }\r
+    }\r
+\r
+    while(sdh->CTL & SDH_CTL_DIEN_Msk)\r
+    {\r
+        if(pSD->IsCardInsert == (uint32_t)FALSE)\r
+        {\r
+            return SDH_NO_SD_CARD;\r
+        }\r
+    }\r
+\r
+    if(!(sdh->INTSTS & SDH_INTSTS_CRC7_Msk))       /* check CRC7 */\r
+    {\r
+        return SDH_CRC7_ERROR;\r
+    }\r
+\r
+    if(!(sdh->INTSTS & SDH_INTSTS_CRC16_Msk))      /* check CRC16 */\r
+    {\r
+        return SDH_CRC16_ERROR;\r
+    }\r
+\r
+    return Successful;\r
+}\r
+\r
+/* there are 8 bits for divider0, maximum is 256 */\r
+#define SDH_CLK_DIV0_MAX     256UL\r
+\r
+void SDH_Set_clock(SDH_T *sdh, uint32_t u32SDClockKhz)\r
+{\r
+    if(!(__PC() & (1UL << 28)))\r
+    {\r
+        uint32_t u32Rate, u32Div1;\r
+        static uint32_t u32SDClkSrc = 0UL;\r
+\r
+        /* M2351 is only support SDH0 */\r
+        u32SDClkSrc = (CLK->CLKSEL0 & CLK_CLKSEL0_SDH0SEL_Msk);\r
+        if(u32SDClkSrc == CLK_CLKSEL0_SDH0SEL_HXT)\r
+        {\r
+            _SDH_ReferenceClock = (CLK_GetHXTFreq() / 1000UL);\r
+        }\r
+        else if(u32SDClkSrc == CLK_CLKSEL0_SDH0SEL_HIRC)\r
+        {\r
+            _SDH_ReferenceClock = (__HIRC / 1000UL);\r
+        }\r
+        else if(u32SDClkSrc == CLK_CLKSEL0_SDH0SEL_PLL)\r
+        {\r
+            _SDH_ReferenceClock = (CLK_GetPLLClockFreq() / 1000UL);\r
+        }\r
+        else if(u32SDClkSrc == CLK_CLKSEL0_SDH0SEL_HCLK)\r
+        {\r
+            _SDH_ReferenceClock = (CLK_GetHCLKFreq() / 1000UL);\r
+        }\r
+\r
+        if(u32SDClockKhz >= 50000UL)\r
+        {\r
+            u32SDClockKhz = 50000UL;\r
+        }\r
+        u32Rate = _SDH_ReferenceClock / u32SDClockKhz;\r
+\r
+        /* choose slower clock if system clock cannot divisible by wanted clock */\r
+        if(_SDH_ReferenceClock % u32SDClockKhz != 0UL)\r
+        {\r
+            u32Rate++;\r
+        }\r
+\r
+        if(u32Rate >= SDH_CLK_DIV0_MAX)\r
+        {\r
+            u32Rate = SDH_CLK_DIV0_MAX;\r
+        }\r
+\r
+        /* --- calculate the second divider CLKDIV0[SDHOST_N] */\r
+        if(u32Rate == 0UL)\r
+        {\r
+            u32Div1 = 0UL;\r
+        }\r
+        else\r
+        {\r
+            u32Div1 = ((u32Rate - 1UL) & 0xFFUL);\r
+        }\r
+\r
+        /* --- setup register */\r
+        /* M2351 is only support SDH0 */\r
+        CLK->CLKDIV0 &= ~CLK_CLKDIV0_SDH0DIV_Msk;\r
+        CLK->CLKDIV0 |= (u32Div1 << CLK_CLKDIV0_SDH0DIV_Pos);\r
+    }\r
+}\r
+\r
+uint32_t SDH_CardDetection(SDH_T *sdh)\r
+{\r
+    uint32_t i, u32Status = (uint32_t)TRUE;\r
+    SDH_INFO_T *pSD;\r
+\r
+    /* M2351 is only support SDH0 */\r
+    pSD = &SD0;\r
+\r
+    if(sdh->INTEN & SDH_INTEN_CDSRC_Msk)   /* Card detect pin from GPIO */\r
+    {\r
+        if(sdh->INTSTS & SDH_INTSTS_CDSTS_Msk)   /* Card remove */\r
+        {\r
+            pSD->IsCardInsert = (uint8_t)FALSE;\r
+            u32Status = (uint32_t)FALSE;\r
+        }\r
+        else\r
+        {\r
+            pSD->IsCardInsert = (uint8_t)TRUE;\r
+        }\r
+    }\r
+    else if(!(sdh->INTEN & SDH_INTEN_CDSRC_Msk))\r
+    {\r
+        sdh->CTL |= SDH_CTL_CLKKEEP_Msk;\r
+        for(i = 0UL; i < 5000UL; i++) {}\r
+\r
+        if(sdh->INTSTS & SDH_INTSTS_CDSTS_Msk) /* Card insert */\r
+        {\r
+            pSD->IsCardInsert = (uint8_t)TRUE;\r
+        }\r
+        else\r
+        {\r
+            pSD->IsCardInsert = (uint8_t)FALSE;\r
+            u32Status = (uint32_t)FALSE;\r
+        }\r
+\r
+        sdh->CTL &= ~SDH_CTL_CLKKEEP_Msk;\r
+    }\r
+\r
+    return u32Status;\r
+}\r
+\r
+\r
+/* Initial */\r
+uint32_t SDH_Init(SDH_T *sdh)\r
+{\r
+    uint32_t volatile i, u32Status;\r
+    uint32_t u32Resp;\r
+    uint32_t au32CIDBuffer[4];\r
+    uint32_t volatile u32CmdTimeOut;\r
+    SDH_INFO_T *pSD;\r
+\r
+    /* M2351 is only support SDH0 */\r
+    pSD = &SD0;\r
+\r
+    /* set the clock to 300KHz */\r
+    SDH_Set_clock(sdh, 300UL);\r
+\r
+    /* power ON 74 clock */\r
+    sdh->CTL |= SDH_CTL_CLK74OEN_Msk;\r
+\r
+    while(sdh->CTL & SDH_CTL_CLK74OEN_Msk)\r
+    {\r
+        if(pSD->IsCardInsert == (uint8_t)FALSE)\r
+        {\r
+            return SDH_NO_SD_CARD;\r
+        }\r
+    }\r
+\r
+    SDH_SDCommand(sdh, 0UL, 0UL);        /* reset all cards */\r
+    for(i = 0x1000UL; i > 0UL; i--) {}\r
+\r
+    /* initial SDHC */\r
+    _SDH_uR7_CMD = 1UL;\r
+    u32CmdTimeOut = 0xFFFFFUL;\r
+\r
+    i = SDH_SDCmdAndRsp(sdh, 8UL, 0x00000155UL, u32CmdTimeOut);\r
+    if(i == Successful)\r
+    {\r
+        /* SD 2.0 */\r
+        SDH_SDCmdAndRsp(sdh, 55UL, 0x00UL, u32CmdTimeOut);\r
+        g_u8R3Flag = 1UL;\r
+        SDH_SDCmdAndRsp(sdh, 41UL, 0x40ff8000UL, u32CmdTimeOut); /* 2.7v-3.6v */\r
+        u32Resp = sdh->RESP0;\r
+\r
+        while(!(u32Resp & 0x00800000UL))         /* check if card is ready */\r
+        {\r
+            SDH_SDCmdAndRsp(sdh, 55UL, 0x00UL, u32CmdTimeOut);\r
+            g_u8R3Flag = 1UL;\r
+            SDH_SDCmdAndRsp(sdh, 41UL, 0x40ff8000UL, u32CmdTimeOut); /* 3.0v-3.4v */\r
+            u32Resp = sdh->RESP0;\r
+        }\r
+        if(u32Resp & 0x00400000UL)\r
+        {\r
+            pSD->CardType = SDH_TYPE_SD_HIGH;\r
+        }\r
+        else\r
+        {\r
+            pSD->CardType = SDH_TYPE_SD_LOW;\r
+        }\r
+    }\r
+    else\r
+    {\r
+        /* SD 1.1 */\r
+        SDH_SDCommand(sdh, 0UL, 0UL);        /* reset all cards */\r
+        for(i = 0x100UL; i > 0UL; i--) {}\r
+\r
+        i = SDH_SDCmdAndRsp(sdh, 55UL, 0x00UL, u32CmdTimeOut);\r
+        if(i == 2UL)      /* MMC memory */\r
+        {\r
+            SDH_SDCommand(sdh, 0UL, 0UL);        /* reset */\r
+            for(i = 0x100UL; i > 0UL; i--) {}\r
+\r
+            g_u8R3Flag = 1UL;\r
+\r
+            if(SDH_SDCmdAndRsp(sdh, 1UL, 0x40ff8000UL, u32CmdTimeOut) != 2UL)     /* eMMC memory */\r
+            {\r
+                u32Resp = sdh->RESP0;\r
+                while(!(u32Resp & 0x00800000UL))         /* check if card is ready */\r
+                {\r
+                    g_u8R3Flag = 1UL;\r
+\r
+                    SDH_SDCmdAndRsp(sdh, 1UL, 0x40ff8000UL, u32CmdTimeOut);      /* high voltage */\r
+                    u32Resp = sdh->RESP0;\r
+                }\r
+\r
+                if(u32Resp & 0x00400000UL)\r
+                {\r
+                    pSD->CardType = SDH_TYPE_EMMC;\r
+                }\r
+                else\r
+                {\r
+                    pSD->CardType = SDH_TYPE_MMC;\r
+                }\r
+            }\r
+            else\r
+            {\r
+                pSD->CardType = SDH_TYPE_UNKNOWN;\r
+                return SDH_ERR_DEVICE;\r
+            }\r
+        }\r
+        else if(i == 0UL)      /* SD Memory */\r
+        {\r
+            g_u8R3Flag = 1UL;\r
+            SDH_SDCmdAndRsp(sdh, 41UL, 0x00ff8000UL, u32CmdTimeOut); /* 3.0v-3.4v */\r
+            u32Resp = sdh->RESP0;\r
+            while(!(u32Resp & 0x00800000UL))         /* check if card is ready */\r
+            {\r
+                SDH_SDCmdAndRsp(sdh, 55UL, 0x00UL, u32CmdTimeOut);\r
+                g_u8R3Flag = 1UL;\r
+                SDH_SDCmdAndRsp(sdh, 41UL, 0x00ff8000UL, u32CmdTimeOut); /* 3.0v-3.4v */\r
+                u32Resp = sdh->RESP0;\r
+            }\r
+            pSD->CardType = SDH_TYPE_SD_LOW;\r
+        }\r
+        else\r
+        {\r
+            pSD->CardType = SDH_TYPE_UNKNOWN;\r
+            return SDH_INIT_ERROR;\r
+        }\r
+    }\r
+\r
+    /* CMD2, CMD3 */\r
+    if(pSD->CardType != SDH_TYPE_UNKNOWN)\r
+    {\r
+        SDH_SDCmdAndRsp2(sdh, 2UL, 0x00UL, au32CIDBuffer);\r
+        if((pSD->CardType == SDH_TYPE_MMC) || (pSD->CardType == SDH_TYPE_EMMC))\r
+        {\r
+            if((u32Status = SDH_SDCmdAndRsp(sdh, 3UL, 0x10000UL, 0UL)) != Successful)         /* set RCA */\r
+            {\r
+                return u32Status;\r
+            }\r
+            pSD->RCA = 0x10000UL;\r
+        }\r
+        else\r
+        {\r
+            if((u32Status = SDH_SDCmdAndRsp(sdh, 3UL, 0x00UL, 0UL)) != Successful)        /* get RCA */\r
+            {\r
+                return u32Status;\r
+            }\r
+            else\r
+            {\r
+                pSD->RCA = (sdh->RESP0 << 8) & 0xffff0000UL;\r
+            }\r
+        }\r
+    }\r
+\r
+    return Successful;\r
+}\r
+\r
+\r
+uint32_t SDH_SwitchToHighSpeed(SDH_T *sdh, SDH_INFO_T *pSD)\r
+{\r
+    uint32_t volatile u32Status = 0UL;\r
+    uint16_t u16CurrentComsumption, u16BusyStatus0;\r
+\r
+    sdh->DMASA = (uint32_t)_SDH_ucSDHCBuffer;    /* set DMA transfer starting address */\r
+    sdh->BLEN = 63UL;    /* 512 bit */\r
+\r
+    if((u32Status = SDH_SDCmdAndRspDataIn(sdh, 6UL, 0x00ffff01UL)) != Successful)\r
+    {\r
+        return Fail;\r
+    }\r
+\r
+    u16CurrentComsumption = (uint16_t)_SDH_ucSDHCBuffer[0] << 8;\r
+    u16CurrentComsumption |= (uint16_t)_SDH_ucSDHCBuffer[1];\r
+    if(!u16CurrentComsumption)\r
+    {\r
+        return Fail;\r
+    }\r
+\r
+    u16BusyStatus0 = (uint16_t)_SDH_ucSDHCBuffer[28] << 8;\r
+    u16BusyStatus0 |= (uint16_t)_SDH_ucSDHCBuffer[29];\r
+\r
+    if(!u16BusyStatus0)    /* function ready */\r
+    {\r
+        sdh->DMASA = (uint32_t)_SDH_ucSDHCBuffer;        /* set DMA transfer starting address */\r
+        sdh->BLEN = 63UL;    /* 512 bit */\r
+\r
+        if((u32Status = SDH_SDCmdAndRspDataIn(sdh, 6UL, 0x80ffff01UL)) != Successful)\r
+        {\r
+            return Fail;\r
+        }\r
+\r
+        /* function change timing: 8 clocks */\r
+        sdh->CTL |= SDH_CTL_CLK8OEN_Msk;\r
+        while(sdh->CTL & SDH_CTL_CLK8OEN_Msk) {}\r
+\r
+        u16CurrentComsumption = (uint16_t)_SDH_ucSDHCBuffer[0] << 8;\r
+        u16CurrentComsumption |= (uint16_t)_SDH_ucSDHCBuffer[1];\r
+        if(!u16CurrentComsumption)\r
+        {\r
+            return Fail;\r
+        }\r
+\r
+        return Successful;\r
+    }\r
+    else\r
+    {\r
+        return Fail;\r
+    }\r
+}\r
+\r
+\r
+uint32_t SDH_SelectCardType(SDH_T *sdh)\r
+{\r
+    uint32_t volatile u32Status = 0UL;\r
+    uint32_t u32Param;\r
+    SDH_INFO_T *pSD;\r
+\r
+    /* M2351 is only support SDH0 */\r
+    pSD = &SD0;\r
+\r
+    if((u32Status = SDH_SDCmdAndRsp(sdh, 7UL, pSD->RCA, 0UL)) != Successful)\r
+    {\r
+        return u32Status;\r
+    }\r
+\r
+    SDH_CheckRB(sdh);\r
+\r
+    /* if SD card set 4bit */\r
+    if(pSD->CardType == SDH_TYPE_SD_HIGH)\r
+    {\r
+        sdh->DMASA = (uint32_t)_SDH_ucSDHCBuffer;    /* set DMA transfer starting address */\r
+        sdh->BLEN = 0x07UL;  /* 64 bit */\r
+\r
+        if((u32Status = SDH_SDCmdAndRsp(sdh, 55UL, pSD->RCA, 0UL)) != Successful)\r
+        {\r
+            return u32Status;\r
+        }\r
+\r
+        sdh->DMACTL |= 0x2;\r
+        while(sdh->DMACTL & 0x2) {};\r
+\r
+        if((u32Status = SDH_SDCmdAndRspDataIn(sdh, 51UL, 0x00UL)) != Successful)\r
+        {\r
+            return u32Status;\r
+        }\r
+\r
+        if((_SDH_ucSDHCBuffer[0] & 0xfUL) == 0xfUL)\r
+        {\r
+            u32Status = SDH_SwitchToHighSpeed(sdh, pSD);\r
+            if(u32Status == Successful)\r
+            {\r
+                /* divider */\r
+                SDH_Set_clock(sdh, SDHC_FREQ);\r
+            }\r
+        }\r
+\r
+        if((u32Status = SDH_SDCmdAndRsp(sdh, 55UL, pSD->RCA, 0UL)) != Successful)\r
+        {\r
+            return u32Status;\r
+        }\r
+        if((u32Status = SDH_SDCmdAndRsp(sdh, 6UL, 0x02UL, 0UL)) != Successful)    /* set bus width */\r
+        {\r
+            return u32Status;\r
+        }\r
+\r
+        sdh->CTL |= SDH_CTL_DBW_Msk;\r
+    }\r
+    else if(pSD->CardType == SDH_TYPE_SD_LOW)\r
+    {\r
+        sdh->DMASA = (uint32_t) _SDH_ucSDHCBuffer; /* set DMA transfer starting address */\r
+        sdh->BLEN = 0x07UL;  /* 64 bit */\r
+\r
+        if((u32Status = SDH_SDCmdAndRsp(sdh, 55UL, pSD->RCA, 0UL)) != Successful)\r
+        {\r
+            return u32Status;\r
+        }\r
+        if((u32Status = SDH_SDCmdAndRspDataIn(sdh, 51UL, 0x00UL)) != Successful)\r
+        {\r
+            return u32Status;\r
+        }\r
+\r
+        /* set data bus width. ACMD6 for SD card, SDCR_DBW for host. */\r
+        if((u32Status = SDH_SDCmdAndRsp(sdh, 55UL, pSD->RCA, 0UL)) != Successful)\r
+        {\r
+            return u32Status;\r
+        }\r
+\r
+        if((u32Status = SDH_SDCmdAndRsp(sdh, 6UL, 0x02UL, 0UL)) != Successful)    /* set bus width */\r
+        {\r
+            return u32Status;\r
+        }\r
+\r
+        sdh->CTL |= SDH_CTL_DBW_Msk;\r
+    }\r
+    else if((pSD->CardType == SDH_TYPE_MMC) || (pSD->CardType == SDH_TYPE_EMMC))\r
+    {\r
+\r
+        if(pSD->CardType == SDH_TYPE_MMC)\r
+        {\r
+            sdh->CTL &= ~SDH_CTL_DBW_Msk;\r
+        }\r
+\r
+        /* --- sent CMD6 to MMC card to set bus width to 4 bits mode */\r
+        /* set CMD6 argument Access field to 3, Index to 183, Value to 1 (4-bit mode) */\r
+        u32Param = (3UL << 24) | (183UL << 16) | (1UL << 8);\r
+        if((u32Status = SDH_SDCmdAndRsp(sdh, 6UL, u32Param, 0UL)) != Successful)\r
+        {\r
+            return u32Status;\r
+        }\r
+        SDH_CheckRB(sdh);\r
+\r
+        sdh->CTL |= SDH_CTL_DBW_Msk; /* set bus width to 4-bit mode for SD host controller */\r
+    }\r
+\r
+    if((u32Status = SDH_SDCmdAndRsp(sdh, 16UL, SDH_BLOCK_SIZE, 0UL)) != Successful)  /* set block length */\r
+    {\r
+        return u32Status;\r
+    }\r
+    sdh->BLEN = SDH_BLOCK_SIZE - 1UL;           /* set the block size */\r
+\r
+    SDH_SDCommand(sdh, 7UL, 0UL);\r
+    sdh->CTL |= SDH_CTL_CLK8OEN_Msk;\r
+    while(sdh->CTL & SDH_CTL_CLK8OEN_Msk) {}\r
+\r
+    sdh->INTEN |= SDH_INTEN_BLKDIEN_Msk;\r
+\r
+    return Successful;\r
+}\r
+\r
+void SDH_Get_SD_info(SDH_T *sdh)\r
+{\r
+    uint32_t u32RLen, u32CSize, u32Mult, u32Size;\r
+    uint32_t au32Buffer[4];\r
+    SDH_INFO_T *pSD;\r
+\r
+    /* M2351 is only support SDH0 */\r
+    pSD = &SD0;\r
+\r
+    SDH_SDCmdAndRsp2(sdh, 9UL, pSD->RCA, au32Buffer);\r
+\r
+    if((pSD->CardType == SDH_TYPE_MMC) || (pSD->CardType == SDH_TYPE_EMMC))\r
+    {\r
+        /* for MMC/eMMC card */\r
+        if((au32Buffer[0] & 0xc0000000UL) == 0xc0000000UL)\r
+        {\r
+            /* CSD_STRUCTURE [127:126] is 3 */\r
+            /* CSD version depend on EXT_CSD register in eMMC v4.4 for card size > 2GB */\r
+            SDH_SDCmdAndRsp(sdh, 7UL, pSD->RCA, 0UL);\r
+\r
+            sdh->DMASA = (uint32_t)_SDH_ucSDHCBuffer;  /* set DMA transfer starting address */\r
+            sdh->BLEN = 511UL;  /* read 512 bytes for EXT_CSD */\r
+\r
+            if(SDH_SDCmdAndRspDataIn(sdh, 8UL, 0x00UL) != Successful)\r
+            {\r
+                return;\r
+            }\r
+\r
+            SDH_SDCommand(sdh, 7UL, 0UL);\r
+            sdh->CTL |= SDH_CTL_CLK8OEN_Msk;\r
+            while(sdh->CTL & SDH_CTL_CLK8OEN_Msk) {}\r
+\r
+            pSD->totalSectorN = (uint32_t)_SDH_ucSDHCBuffer[215] << 24;\r
+            pSD->totalSectorN |= (uint32_t)_SDH_ucSDHCBuffer[214] << 16;\r
+            pSD->totalSectorN |= (uint32_t)_SDH_ucSDHCBuffer[213] << 8;\r
+            pSD->totalSectorN |= (uint32_t)_SDH_ucSDHCBuffer[212];\r
+            pSD->diskSize = pSD->totalSectorN / 2UL;\r
+        }\r
+        else\r
+        {\r
+            /* CSD version v1.0/1.1/1.2 in eMMC v4.4 spec for card size <= 2GB */\r
+            u32RLen = (au32Buffer[1] & 0x000f0000UL) >> 16;\r
+            u32CSize = ((au32Buffer[1] & 0x000003ffUL) << 2) | ((au32Buffer[2] & 0xc0000000UL) >> 30);\r
+            u32Mult = (au32Buffer[2] & 0x00038000UL) >> 15;\r
+            u32Size = (u32CSize + 1UL) * (1UL << (u32Mult + 2UL)) * (1UL << u32RLen);\r
+\r
+            pSD->diskSize = u32Size / 1024UL;\r
+            pSD->totalSectorN = u32Size / 512UL;\r
+        }\r
+    }\r
+    else\r
+    {\r
+        if(au32Buffer[0] & 0xc0000000UL)\r
+        {\r
+            u32CSize = ((au32Buffer[1] & 0x0000003fUL) << 16) | ((au32Buffer[2] & 0xffff0000UL) >> 16);\r
+            u32Size = (u32CSize + 1UL) * 512UL;  /* Kbytes */\r
+\r
+            pSD->diskSize = u32Size;\r
+            pSD->totalSectorN = u32Size << 1;\r
+        }\r
+        else\r
+        {\r
+            u32RLen = (au32Buffer[1] & 0x000f0000UL) >> 16;\r
+            u32CSize = ((au32Buffer[1] & 0x000003ffUL) << 2) | ((au32Buffer[2] & 0xc0000000UL) >> 30);\r
+            u32Mult = (au32Buffer[2] & 0x00038000UL) >> 15;\r
+            u32Size = (u32CSize + 1UL) * (1UL << (u32Mult + 2UL)) * (1UL << u32RLen);\r
+\r
+            pSD->diskSize = u32Size / 1024UL;\r
+            pSD->totalSectorN = u32Size / 512UL;\r
+        }\r
+    }\r
+    pSD->sectorSize = (int)512UL;\r
+}\r
+\r
+/** @endcond HIDDEN_SYMBOLS */\r
+\r
+\r
+/**\r
+ *  @brief  This function use to reset SD function and select card detection source and pin.\r
+ *\r
+ *  @param[in]  sdh    The pointer of the specified SDH module.\r
+ *  @param[in]  u32CardDetSrc   Select card detection pin from GPIO or DAT3 pin. ( \ref CardDetect_From_GPIO / \ref CardDetect_From_DAT3)\r
+ *\r
+ *  @return None\r
+ */\r
+void SDH_Open(SDH_T *sdh, uint32_t u32CardDetSrc)\r
+{\r
+    /* enable DMAC */\r
+    sdh->DMACTL = SDH_DMACTL_DMARST_Msk;\r
+    while(sdh->DMACTL & SDH_DMACTL_DMARST_Msk) {}\r
+\r
+    sdh->DMACTL = SDH_DMACTL_DMAEN_Msk;\r
+\r
+    /* Reset FMI */\r
+    sdh->GCTL = SDH_GCTL_GCTLRST_Msk | SDH_GCTL_SDEN_Msk;        /* Start reset FMI controller. */\r
+    while(sdh->GCTL & SDH_GCTL_GCTLRST_Msk) {}\r
+\r
+    memset(&SD0, 0, sizeof(SDH_INFO_T));\r
+\r
+    /* enable SD */\r
+    sdh->GCTL = SDH_GCTL_SDEN_Msk;\r
+\r
+    if(u32CardDetSrc & CardDetect_From_DAT3)\r
+    {\r
+        sdh->INTEN &= ~SDH_INTEN_CDSRC_Msk;\r
+    }\r
+    else\r
+    {\r
+        sdh->INTEN |= SDH_INTEN_CDSRC_Msk;\r
+    }\r
+    sdh->INTEN |= SDH_INTEN_CDIEN_Msk;\r
+\r
+    sdh->CTL |= SDH_CTL_CTLRST_Msk;     /* SD software reset */\r
+    while(sdh->CTL & SDH_CTL_CTLRST_Msk) {}\r
+\r
+}\r
+\r
+/**\r
+ *  @brief  This function use to initial SD card.\r
+ *\r
+ *  @param[in]    sdh    The pointer of the specified SDH module.\r
+ *\r
+ *  @return None\r
+ *\r
+ *  @details This function is used to initial SD card.\r
+ *           SD initial state needs 400KHz clock output, driver will use HIRC for SD initial clock source.\r
+ *           And then switch back to the user's setting.\r
+ */\r
+uint32_t SDH_Probe(SDH_T *sdh)\r
+{\r
+    uint32_t u32Val;\r
+\r
+    /* Disable FMI/SD host interrupt */\r
+    sdh->GINTEN = 0UL;\r
+\r
+    sdh->CTL &= ~SDH_CTL_SDNWR_Msk;\r
+    sdh->CTL |=  0x09UL << SDH_CTL_SDNWR_Pos;         /* set SDNWR = 9 */\r
+    sdh->CTL &= ~SDH_CTL_BLKCNT_Msk;\r
+    sdh->CTL |=  0x01UL << SDH_CTL_BLKCNT_Pos;           /* set BLKCNT = 1 */\r
+    sdh->CTL &= ~SDH_CTL_DBW_Msk;               /* SD 1-bit data bus */\r
+\r
+    if(!(SDH_CardDetection(sdh)))\r
+    {\r
+        return SDH_NO_SD_CARD;\r
+    }\r
+\r
+    if((u32Val = SDH_Init(sdh)) != 0UL)\r
+    {\r
+        return u32Val;\r
+    }\r
+\r
+    /* divider */\r
+    if(SD0.CardType == SDH_TYPE_MMC)\r
+    {\r
+        SDH_Set_clock(sdh, MMC_FREQ);\r
+    }\r
+    else\r
+    {\r
+        SDH_Set_clock(sdh, SD_FREQ);\r
+    }\r
+    SDH_Get_SD_info(sdh);\r
+\r
+    if((u32Val = SDH_SelectCardType(sdh)) != 0UL)\r
+    {\r
+        return u32Val;\r
+    }\r
+\r
+    SDH_ok = 1;\r
+    return 0UL;\r
+}\r
+\r
+/**\r
+ *  @brief  This function use to read data from SD card.\r
+ *\r
+ *  @param[in]     sdh           The pointer of the specified SDH module.\r
+ *  @param[out]    pu8BufAddr    The buffer to receive the data from SD card.\r
+ *  @param[in]     u32StartSec   The start read sector address.\r
+ *  @param[in]     u32SecCount   The the read sector number of data\r
+ *\r
+ *  @return None\r
+ */\r
+uint32_t SDH_Read(SDH_T *sdh, uint8_t *pu8BufAddr, uint32_t u32StartSec, uint32_t u32SecCount)\r
+{\r
+    uint32_t volatile u32IsSendCmd = (uint32_t)FALSE, u32Buf;\r
+    uint32_t volatile u32Reg;\r
+    uint32_t volatile i, u32Loop, u32Status;\r
+    uint32_t u32BlkSize = SDH_BLOCK_SIZE;\r
+\r
+    SDH_INFO_T *pSD;\r
+\r
+    /* M2351 is only support SDH0 */\r
+    pSD = &SD0;\r
+\r
+    /* --- check input parameters */\r
+    if(u32SecCount == 0UL)\r
+    {\r
+        return SDH_SELECT_ERROR;\r
+    }\r
+\r
+    if((u32Status = SDH_SDCmdAndRsp(sdh, 7UL, pSD->RCA, 0UL)) != Successful)\r
+    {\r
+        return u32Status;\r
+    }\r
+    SDH_CheckRB(sdh);\r
+\r
+    sdh->BLEN = u32BlkSize - 1UL;       /* the actual byte count is equal to (SDBLEN+1) */\r
+\r
+    if((pSD->CardType == SDH_TYPE_SD_HIGH) || (pSD->CardType == SDH_TYPE_EMMC))\r
+    {\r
+        sdh->CMDARG = u32StartSec;\r
+    }\r
+    else\r
+    {\r
+        sdh->CMDARG = u32StartSec * u32BlkSize;\r
+    }\r
+\r
+    sdh->DMASA = (uint32_t)pu8BufAddr;\r
+\r
+    u32Loop = u32SecCount / 255UL;\r
+    while(u32Loop > 0UL)\r
+    {\r
+        g_u8SDDataReadyFlag = (uint8_t)FALSE;\r
+        u32Reg = sdh->CTL & ~SDH_CTL_CMDCODE_Msk;\r
+        u32Reg = u32Reg | 0xff0000UL;   /* set BLK_CNT to 255 */\r
+        if(u32IsSendCmd == (uint32_t)FALSE)\r
+        {\r
+            sdh->CTL = u32Reg | (18UL << 8) | (SDH_CTL_COEN_Msk | SDH_CTL_RIEN_Msk | SDH_CTL_DIEN_Msk);\r
+            u32IsSendCmd = (uint32_t)TRUE;\r
+        }\r
+        else\r
+        {\r
+            sdh->CTL = u32Reg | SDH_CTL_DIEN_Msk;\r
+        }\r
+\r
+        while(!g_u8SDDataReadyFlag)\r
+        {\r
+            if(g_u8SDDataReadyFlag)\r
+            {\r
+                break;\r
+            }\r
+            if(pSD->IsCardInsert == (uint8_t)FALSE)\r
+            {\r
+                return SDH_NO_SD_CARD;\r
+            }\r
+        }\r
+\r
+        if(!(sdh->INTSTS & SDH_INTSTS_CRC7_Msk))     /* check CRC7 */\r
+        {\r
+            return SDH_CRC7_ERROR;\r
+        }\r
+\r
+        if(!(sdh->INTSTS & SDH_INTSTS_CRC16_Msk))    /* check CRC16 */\r
+        {\r
+            return SDH_CRC16_ERROR;\r
+        }\r
+        u32Loop--;\r
+    }\r
+\r
+    u32Loop = u32SecCount % 255UL;\r
+    if(u32Loop != 0UL)\r
+    {\r
+        uint32_t u32RegTmp;\r
+        g_u8SDDataReadyFlag = (uint8_t)FALSE;\r
+        u32Reg = sdh->CTL & (~SDH_CTL_CMDCODE_Msk);\r
+        u32Reg = u32Reg & (~SDH_CTL_BLKCNT_Msk);\r
+        u32RegTmp = (u32Loop << 16);\r
+        u32Reg |= u32RegTmp;    /* setup SDCR_BLKCNT */\r
+\r
+        if(u32IsSendCmd == (uint32_t)FALSE)\r
+        {\r
+            sdh->CTL = u32Reg | (18UL << 8) | (SDH_CTL_COEN_Msk | SDH_CTL_RIEN_Msk | SDH_CTL_DIEN_Msk);\r
+            u32IsSendCmd = (uint32_t)TRUE;\r
+        }\r
+        else\r
+        {\r
+            sdh->CTL = u32Reg | SDH_CTL_DIEN_Msk;\r
+        }\r
+\r
+        while(!g_u8SDDataReadyFlag)\r
+        {\r
+            if(pSD->IsCardInsert == (uint8_t)FALSE)\r
+            {\r
+                return SDH_NO_SD_CARD;\r
+            }\r
+        }\r
+\r
+        if(!(sdh->INTSTS & SDH_INTSTS_CRC7_Msk))     /* check CRC7 */\r
+        {\r
+            return SDH_CRC7_ERROR;\r
+        }\r
+\r
+        if(!(sdh->INTSTS & SDH_INTSTS_CRC16_Msk))     /* check CRC16 */\r
+        {\r
+            return SDH_CRC16_ERROR;\r
+        }\r
+    }\r
+\r
+    if(SDH_SDCmdAndRsp(sdh, 12UL, 0UL, 0UL))     /* stop command */\r
+    {\r
+        return SDH_CRC7_ERROR;\r
+    }\r
+    SDH_CheckRB(sdh);\r
+\r
+    SDH_SDCommand(sdh, 7UL, 0UL);\r
+    sdh->CTL |= SDH_CTL_CLK8OEN_Msk;\r
+    while(sdh->CTL & SDH_CTL_CLK8OEN_Msk) {}\r
+\r
+    return Successful;\r
+}\r
+\r
+/**\r
+ *  @brief  This function use to write data to SD card.\r
+ *\r
+ *  @param[in]    sdh           The pointer of the specified SDH module.\r
+ *  @param[in]    pu8BufAddr    The buffer to send the data to SD card.\r
+ *  @param[in]    u32StartSec   The start write sector address.\r
+ *  @param[in]    u32SecCount   The the write sector number of data.\r
+ *\r
+ *  @return   \ref SDH_SELECT_ERROR : u32SecCount is zero. \n\r
+ *            \ref SDH_NO_SD_CARD : SD card be removed. \n\r
+ *            \ref SDH_CRC_ERROR : CRC error happen. \n\r
+ *            \ref SDH_CRC7_ERROR : CRC7 error happen. \n\r
+ *            \ref Successful : Write data to SD card success.\r
+ */\r
+uint32_t SDH_Write(SDH_T *sdh, uint8_t *pu8BufAddr, uint32_t u32StartSec, uint32_t u32SecCount)\r
+{\r
+    uint32_t volatile u32IsSendCmd = (uint32_t)FALSE;\r
+    uint32_t volatile u32Reg;\r
+    uint32_t volatile i, u32Loop, u32Status;\r
+\r
+    SDH_INFO_T *pSD;\r
+\r
+    /* M2351 is only support SDH0 */\r
+    pSD = &SD0;\r
+\r
+    /* --- check input parameters */\r
+    if(u32SecCount == 0UL)\r
+    {\r
+        return SDH_SELECT_ERROR;\r
+    }\r
+\r
+    if((u32Status = SDH_SDCmdAndRsp(sdh, 7UL, pSD->RCA, 0UL)) != Successful)\r
+    {\r
+        return u32Status;\r
+    }\r
+\r
+    SDH_CheckRB(sdh);\r
+\r
+    /* According to SD Spec v2.0, the write CMD block size MUST be 512, and the start address MUST be 512*n. */\r
+    sdh->BLEN = SDH_BLOCK_SIZE - 1UL;           /* set the block size */\r
+\r
+    if((pSD->CardType == SDH_TYPE_SD_HIGH) || (pSD->CardType == SDH_TYPE_EMMC))\r
+    {\r
+        sdh->CMDARG = u32StartSec;\r
+    }\r
+    else\r
+    {\r
+        sdh->CMDARG = u32StartSec * SDH_BLOCK_SIZE;  /* set start address for SD CMD */\r
+    }\r
+\r
+    sdh->DMASA = (uint32_t)pu8BufAddr;\r
+    u32Loop = u32SecCount / 255UL;   /* the maximum block count is 0xFF=255 for register SDCR[BLK_CNT] */\r
+    while(u32Loop > 0UL)\r
+    {\r
+        g_u8SDDataReadyFlag = (uint8_t)FALSE;\r
+        u32Reg = sdh->CTL & 0xff00c080UL;\r
+        u32Reg = u32Reg | 0xff0000UL;   /* set BLK_CNT to 0xFF=255 */\r
+        if(!u32IsSendCmd)\r
+        {\r
+            sdh->CTL = u32Reg | (25UL << 8) | (SDH_CTL_COEN_Msk | SDH_CTL_RIEN_Msk | SDH_CTL_DOEN_Msk);\r
+            u32IsSendCmd = (uint32_t)TRUE;\r
+        }\r
+        else\r
+        {\r
+            sdh->CTL = u32Reg | SDH_CTL_DOEN_Msk;\r
+        }\r
+\r
+        while(!g_u8SDDataReadyFlag)\r
+        {\r
+            if(pSD->IsCardInsert == (uint8_t)FALSE)\r
+            {\r
+                return SDH_NO_SD_CARD;\r
+            }\r
+        }\r
+\r
+        if((sdh->INTSTS & SDH_INTSTS_CRCIF_Msk) != 0UL)      /* check CRC */\r
+        {\r
+            sdh->INTSTS = SDH_INTSTS_CRCIF_Msk;\r
+            return SDH_CRC_ERROR;\r
+        }\r
+        u32Loop--;\r
+    }\r
+\r
+    u32Loop = u32SecCount % 255UL;\r
+    if(u32Loop != 0UL)\r
+    {\r
+        uint32_t u32RegTmp;\r
+        g_u8SDDataReadyFlag = (uint8_t)FALSE;\r
+        u32RegTmp = (u32Loop << 16);\r
+        u32Reg = (sdh->CTL & 0xff00c080UL) | u32RegTmp;\r
+        if(!u32IsSendCmd)\r
+        {\r
+            sdh->CTL = u32Reg | (25UL << 8) | (SDH_CTL_COEN_Msk | SDH_CTL_RIEN_Msk | SDH_CTL_DOEN_Msk);\r
+            u32IsSendCmd = (uint32_t)TRUE;\r
+        }\r
+        else\r
+        {\r
+            sdh->CTL = u32Reg | SDH_CTL_DOEN_Msk;\r
+        }\r
+\r
+        while(!g_u8SDDataReadyFlag)\r
+        {\r
+            if(pSD->IsCardInsert == (uint8_t)FALSE)\r
+            {\r
+                return SDH_NO_SD_CARD;\r
+            }\r
+        }\r
+\r
+        if((sdh->INTSTS & SDH_INTSTS_CRCIF_Msk) != 0UL)      /* check CRC */\r
+        {\r
+            sdh->INTSTS = SDH_INTSTS_CRCIF_Msk;\r
+            return SDH_CRC_ERROR;\r
+        }\r
+    }\r
+    sdh->INTSTS = SDH_INTSTS_CRCIF_Msk;\r
+\r
+    if(SDH_SDCmdAndRsp(sdh, 12UL, 0UL, 0UL))       /* stop command */\r
+    {\r
+        return SDH_CRC7_ERROR;\r
+    }\r
+    SDH_CheckRB(sdh);\r
+\r
+    SDH_SDCommand(sdh, 7UL, 0UL);\r
+    sdh->CTL |= SDH_CTL_CLK8OEN_Msk;\r
+    while(sdh->CTL & SDH_CTL_CLK8OEN_Msk) {}\r
+\r
+    return Successful;\r
+}\r
+\r
+\r
+/*@}*/ /* end of group SDH_EXPORTED_FUNCTIONS */\r
+\r
+/*@}*/ /* end of group SDH_Driver */\r
+\r
+/*@}*/ /* end of group Standard_Driver */\r
+\r
+/*** (C) COPYRIGHT 2017 Nuvoton Technology Corp. ***/\r
+\r