Subversion Repositories dashGPS

/**

  ******************************************************************************

  * @file    stm32f1xx_hal_mmc.c

  * @author  MCD Application Team

  * @brief   MMC card HAL module driver.

  *          This file provides firmware functions to manage the following

  *          functionalities of the Secure Digital (MMC) peripheral:

  *           + Initialization and de-initialization functions

  *           + IO operation functions

  *           + Peripheral Control functions

  *           + MMC card Control functions

  *

  @verbatim

  ==============================================================================

                        ##### How to use this driver #####

  ==============================================================================

  [..]

    This driver implements a high level communication layer for read and write from/to

    this memory. The needed STM32 hardware resources (SDMMC and GPIO) are performed by

    the user in HAL_MMC_MspInit() function (MSP layer).

    Basically, the MSP layer configuration should be the same as we provide in the

    examples.

    You can easily tailor this configuration according to hardware resources.

  [..]

    This driver is a generic layered driver for SDMMC memories which uses the HAL

    SDMMC driver functions to interface with MMC and eMMC cards devices.

    It is used as follows:

    (#)Initialize the SDMMC low level resources by implement the HAL_MMC_MspInit() API:

        (##) Enable the SDMMC interface clock using __HAL_RCC_SDMMC_CLK_ENABLE();

        (##) SDMMC pins configuration for MMC card

            (+++) Enable the clock for the SDMMC GPIOs using the functions __HAL_RCC_GPIOx_CLK_ENABLE();

            (+++) Configure these SDMMC pins as alternate function pull-up using HAL_GPIO_Init()

                  and according to your pin assignment;

        (##) DMA Configuration if you need to use DMA process (HAL_MMC_ReadBlocks_DMA()

             and HAL_MMC_WriteBlocks_DMA() APIs).

            (+++) Enable the DMAx interface clock using __HAL_RCC_DMAx_CLK_ENABLE();

            (+++) Configure the DMA using the function HAL_DMA_Init() with predeclared and filled.

        (##) NVIC configuration if you need to use interrupt process when using DMA transfer.

            (+++) Configure the SDMMC and DMA interrupt priorities using function HAL_NVIC_SetPriority();

                  DMA priority is superior to SDMMC's priority

            (+++) Enable the NVIC DMA and SDMMC IRQs using function HAL_NVIC_EnableIRQ()

            (+++) SDMMC interrupts are managed using the macros __HAL_MMC_ENABLE_IT()

                  and __HAL_MMC_DISABLE_IT() inside the communication process.

            (+++) SDMMC interrupts pending bits are managed using the macros __HAL_MMC_GET_IT()

                  and __HAL_MMC_CLEAR_IT()

        (##) NVIC configuration if you need to use interrupt process (HAL_MMC_ReadBlocks_IT()

             and HAL_MMC_WriteBlocks_IT() APIs).

            (+++) Configure the SDMMC interrupt priorities using function HAL_NVIC_SetPriority();

            (+++) Enable the NVIC SDMMC IRQs using function HAL_NVIC_EnableIRQ()

            (+++) SDMMC interrupts are managed using the macros __HAL_MMC_ENABLE_IT()

                  and __HAL_MMC_DISABLE_IT() inside the communication process.

            (+++) SDMMC interrupts pending bits are managed using the macros __HAL_MMC_GET_IT()

                  and __HAL_MMC_CLEAR_IT()

    (#) At this stage, you can perform MMC read/write/erase operations after MMC card initialization

  *** MMC Card Initialization and configuration ***

  ================================================

  [..]

    To initialize the MMC Card, use the HAL_MMC_Init() function. It Initializes

    SDMMC Peripheral (STM32 side) and the MMC Card, and put it into StandBy State (Ready for data transfer).

    This function provide the following operations:

    (#) Initialize the SDMMC peripheral interface with defaullt configuration.

        The initialization process is done at 400KHz. You can change or adapt

        this frequency by adjusting the "ClockDiv" field.

        The MMC Card frequency (SDMMC_CK) is computed as follows:

           SDMMC_CK = SDMMCCLK / (ClockDiv + 2)

        In initialization mode and according to the MMC Card standard,

        make sure that the SDMMC_CK frequency doesn't exceed 400KHz.

        This phase of initialization is done through SDMMC_Init() and

        SDMMC_PowerState_ON() SDMMC low level APIs.

    (#) Initialize the MMC card. The API used is HAL_MMC_InitCard().

        This phase allows the card initialization and identification

        and check the MMC Card type (Standard Capacity or High Capacity)

        The initialization flow is compatible with MMC standard.

        This API (HAL_MMC_InitCard()) could be used also to reinitialize the card in case

        of plug-off plug-in.

    (#) Configure the MMC Card Data transfer frequency. By Default, the card transfer

        frequency is set to 24MHz. You can change or adapt this frequency by adjusting

        the "ClockDiv" field.

        In transfer mode and according to the MMC Card standard, make sure that the

        SDMMC_CK frequency doesn't exceed 25MHz and 50MHz in High-speed mode switch.

        To be able to use a frequency higher than 24MHz, you should use the SDMMC

        peripheral in bypass mode. Refer to the corresponding reference manual

        for more details.

    (#) Select the corresponding MMC Card according to the address read with the step 2.

    (#) Configure the MMC Card in wide bus mode: 4-bits data.

  *** MMC Card Read operation ***

  ==============================

  [..]

    (+) You can read from MMC card in polling mode by using function HAL_MMC_ReadBlocks().

        This function support only 512-bytes block length (the block size should be

        chosen as 512 bytes).

        You can choose either one block read operation or multiple block read operation

        by adjusting the "NumberOfBlocks" parameter.

        After this, you have to ensure that the transfer is done correctly. The check is done

        through HAL_MMC_GetCardState() function for MMC card state.

    (+) You can read from MMC card in DMA mode by using function HAL_MMC_ReadBlocks_DMA().

        This function support only 512-bytes block length (the block size should be

        chosen as 512 bytes).

        You can choose either one block read operation or multiple block read operation

        by adjusting the "NumberOfBlocks" parameter.

        After this, you have to ensure that the transfer is done correctly. The check is done

        through HAL_MMC_GetCardState() function for MMC card state.

        You could also check the DMA transfer process through the MMC Rx interrupt event.

    (+) You can read from MMC card in Interrupt mode by using function HAL_MMC_ReadBlocks_IT().

        This function allows the read of 512 bytes blocks.

        You can choose either one block read operation or multiple block read operation

        by adjusting the "NumberOfBlocks" parameter.

        After this, you have to ensure that the transfer is done correctly. The check is done

        through HAL_MMC_GetCardState() function for MMC card state.

        You could also check the IT transfer process through the MMC Rx interrupt event.

  *** MMC Card Write operation ***

  ===============================

  [..]

    (+) You can write to MMC card in polling mode by using function HAL_MMC_WriteBlocks().

        This function support only 512-bytes block length (the block size should be

        chosen as 512 bytes).

        You can choose either one block read operation or multiple block read operation

        by adjusting the "NumberOfBlocks" parameter.

        After this, you have to ensure that the transfer is done correctly. The check is done

        through HAL_MMC_GetCardState() function for MMC card state.

    (+) You can write to MMC card in DMA mode by using function HAL_MMC_WriteBlocks_DMA().

        This function support only 512-bytes block length (the block size should be

        chosen as 512 byte).

        You can choose either one block read operation or multiple block read operation

        by adjusting the "NumberOfBlocks" parameter.

        After this, you have to ensure that the transfer is done correctly. The check is done

        through HAL_MMC_GetCardState() function for MMC card state.

        You could also check the DMA transfer process through the MMC Tx interrupt event.  

    (+) You can write to MMC card in Interrupt mode by using function HAL_MMC_WriteBlocks_IT().

        This function allows the read of 512 bytes blocks.

        You can choose either one block read operation or multiple block read operation

        by adjusting the "NumberOfBlocks" parameter.

        After this, you have to ensure that the transfer is done correctly. The check is done

        through HAL_MMC_GetCardState() function for MMC card state.

        You could also check the IT transfer process through the MMC Tx interrupt event.

  *** MMC card information ***

  ===========================

  [..]

    (+) To get MMC card information, you can use the function HAL_MMC_GetCardInfo().

        It returns useful information about the MMC card such as block size, card type,

        block number ...

  *** MMC card CSD register ***

  ============================

  [..]

    (+) The HAL_MMC_GetCardCSD() API allows to get the parameters of the CSD register.

        Some of the CSD parameters are useful for card initialization and identification.

  *** MMC card CID register ***

  ============================

  [..]

    (+) The HAL_MMC_GetCardCID() API allows to get the parameters of the CID register.

        Some of the CID parameters are useful for card initialization and identification.

  *** MMC HAL driver macros list ***

  ==================================

  [..]

    Below the list of most used macros in MMC HAL driver.

    (+) __HAL_MMC_ENABLE : Enable the MMC device

    (+) __HAL_MMC_DISABLE : Disable the MMC device

    (+) __HAL_MMC_DMA_ENABLE: Enable the SDMMC DMA transfer

    (+) __HAL_MMC_DMA_DISABLE: Disable the SDMMC DMA transfer

    (+) __HAL_MMC_ENABLE_IT: Enable the MMC device interrupt

    (+) __HAL_MMC_DISABLE_IT: Disable the MMC device interrupt

    (+) __HAL_MMC_GET_FLAG:Check whether the specified MMC flag is set or not

    (+) __HAL_MMC_CLEAR_FLAG: Clear the MMC's pending flags

  [..]

    (@) You can refer to the MMC HAL driver header file for more useful macros

  *** Callback registration ***

  =============================================

  [..]

    The compilation define USE_HAL_MMC_REGISTER_CALLBACKS when set to 1

    allows the user to configure dynamically the driver callbacks.

    Use Functions @ref HAL_MMC_RegisterCallback() to register a user callback,

    it allows to register following callbacks:

      (+) TxCpltCallback : callback when a transmission transfer is completed.

      (+) RxCpltCallback : callback when a reception transfer is completed.

      (+) ErrorCallback : callback when error occurs.

      (+) AbortCpltCallback : callback when abort is completed.

      (+) MspInitCallback    : MMC MspInit.

      (+) MspDeInitCallback  : MMC MspDeInit.

    This function takes as parameters the HAL peripheral handle, the Callback ID

    and a pointer to the user callback function.

    Use function @ref HAL_MMC_UnRegisterCallback() to reset a callback to the default

    weak (surcharged) function. It allows to reset following callbacks:

      (+) TxCpltCallback : callback when a transmission transfer is completed.

      (+) RxCpltCallback : callback when a reception transfer is completed.

      (+) ErrorCallback : callback when error occurs.

      (+) AbortCpltCallback : callback when abort is completed.

      (+) MspInitCallback    : MMC MspInit.

      (+) MspDeInitCallback  : MMC MspDeInit.

    This function) takes as parameters the HAL peripheral handle and the Callback ID.

    By default, after the @ref HAL_MMC_Init and if the state is HAL_MMC_STATE_RESET

    all callbacks are reset to the corresponding legacy weak (surcharged) functions.

    Exception done for MspInit and MspDeInit callbacks that are respectively

    reset to the legacy weak (surcharged) functions in the @ref HAL_MMC_Init

    and @ref  HAL_MMC_DeInit only when these callbacks are null (not registered beforehand).

    If not, MspInit or MspDeInit are not null, the @ref HAL_MMC_Init and @ref HAL_MMC_DeInit

    keep and use the user MspInit/MspDeInit callbacks (registered beforehand)

    Callbacks can be registered/unregistered in READY state only.

    Exception done for MspInit/MspDeInit callbacks that can be registered/unregistered

    in READY or RESET state, thus registered (user) MspInit/DeInit callbacks can be used

    during the Init/DeInit.

    In that case first register the MspInit/MspDeInit user callbacks

    using @ref HAL_MMC_RegisterCallback before calling @ref HAL_MMC_DeInit

    or @ref HAL_MMC_Init function.

    When The compilation define USE_HAL_MMC_REGISTER_CALLBACKS is set to 0 or

    not defined, the callback registering feature is not available

    and weak (surcharged) callbacks are used.

  @endverbatim

  ******************************************************************************

  * @attention

  *

  * <h2><center>&copy; Copyright (c) 2018 STMicroelectronics.

  * All rights reserved.</center></h2>

  *

  * This software component is licensed by ST under BSD 3-Clause license,

  * the "License"; You may not use this file except in compliance with the

  * License. You may obtain a copy of the License at:

  *                       opensource.org/licenses/BSD-3-Clause

  *

  ******************************************************************************

  */

/* Includes ------------------------------------------------------------------*/

#include "stm32f1xx_hal.h"

/** @addtogroup STM32F1xx_HAL_Driver

  * @{

  */

/** @defgroup MMC MMC

  * @brief MMC HAL module driver

  * @{

  */

#ifdef HAL_MMC_MODULE_ENABLED

#if defined(SDIO)

/* Private typedef -----------------------------------------------------------*/

/* Private define ------------------------------------------------------------*/

/** @addtogroup MMC_Private_Defines

  * @{

  */

/**

  * @}

  */

/* Private macro -------------------------------------------------------------*/

/* Private variables ---------------------------------------------------------*/

/* Private function prototypes -----------------------------------------------*/

/* Private functions ---------------------------------------------------------*/

/** @defgroup MMC_Private_Functions MMC Private Functions

  * @{

  */

static uint32_t MMC_InitCard(MMC_HandleTypeDef *hmmc);

static uint32_t MMC_PowerON(MMC_HandleTypeDef *hmmc);

static uint32_t MMC_SendStatus(MMC_HandleTypeDef *hmmc, uint32_t *pCardStatus);

static void     MMC_PowerOFF(MMC_HandleTypeDef *hmmc);

static void     MMC_Write_IT(MMC_HandleTypeDef *hmmc);

static void     MMC_Read_IT(MMC_HandleTypeDef *hmmc);

static void     MMC_DMATransmitCplt(DMA_HandleTypeDef *hdma);

static void     MMC_DMAReceiveCplt(DMA_HandleTypeDef *hdma);

static void     MMC_DMAError(DMA_HandleTypeDef *hdma);

static void     MMC_DMATxAbort(DMA_HandleTypeDef *hdma);

static void     MMC_DMARxAbort(DMA_HandleTypeDef *hdma);

/**

  * @}

  */

/* Exported functions --------------------------------------------------------*/

/** @addtogroup MMC_Exported_Functions

  * @{

  */

/** @addtogroup MMC_Exported_Functions_Group1

 *  @brief   Initialization and de-initialization functions

 *

@verbatim

  ==============================================================================

          ##### Initialization and de-initialization functions #####

  ==============================================================================

  [..]

    This section provides functions allowing to initialize/de-initialize the MMC

    card device to be ready for use.

@endverbatim

  * @{

  */

/**

  * @brief  Initializes the MMC according to the specified parameters in the

            MMC_HandleTypeDef and create the associated handle.

  * @param  hmmc: Pointer to the MMC handle

  * @retval HAL status

  */

HAL_StatusTypeDef HAL_MMC_Init(MMC_HandleTypeDef *hmmc)

{

  /* Check the MMC handle allocation */

  if(hmmc == NULL)

  {

    return HAL_ERROR;

  }

  /* Check the parameters */

  assert_param(IS_SDIO_ALL_INSTANCE(hmmc->Instance));

  assert_param(IS_SDIO_CLOCK_EDGE(hmmc->Init.ClockEdge));

  assert_param(IS_SDIO_CLOCK_BYPASS(hmmc->Init.ClockBypass));

  assert_param(IS_SDIO_CLOCK_POWER_SAVE(hmmc->Init.ClockPowerSave));

  assert_param(IS_SDIO_BUS_WIDE(hmmc->Init.BusWide));

  assert_param(IS_SDIO_HARDWARE_FLOW_CONTROL(hmmc->Init.HardwareFlowControl));

  assert_param(IS_SDIO_CLKDIV(hmmc->Init.ClockDiv));

  if(hmmc->State == HAL_MMC_STATE_RESET)

  {

    /* Allocate lock resource and initialize it */

    hmmc->Lock = HAL_UNLOCKED;

#if defined (USE_HAL_MMC_REGISTER_CALLBACKS) && (USE_HAL_MMC_REGISTER_CALLBACKS == 1U)

    /* Reset Callback pointers in HAL_MMC_STATE_RESET only */

    hmmc->TxCpltCallback    = HAL_MMC_TxCpltCallback;

    hmmc->RxCpltCallback    = HAL_MMC_RxCpltCallback;

    hmmc->ErrorCallback     = HAL_MMC_ErrorCallback;

    hmmc->AbortCpltCallback = HAL_MMC_AbortCallback;

    if(hmmc->MspInitCallback == NULL)

    {

      hmmc->MspInitCallback = HAL_MMC_MspInit;

    }

    /* Init the low level hardware */

    hmmc->MspInitCallback(hmmc);

#else

    /* Init the low level hardware : GPIO, CLOCK, CORTEX...etc */

    HAL_MMC_MspInit(hmmc);

#endif

  }

  hmmc->State = HAL_MMC_STATE_BUSY;

  /* Initialize the Card parameters */

  if(HAL_MMC_InitCard(hmmc) == HAL_ERROR)

  {

    return HAL_ERROR;

  }

  /* Initialize the error code */

  hmmc->ErrorCode = HAL_DMA_ERROR_NONE;

  /* Initialize the MMC operation */

  hmmc->Context = MMC_CONTEXT_NONE;

  /* Initialize the MMC state */

  hmmc->State = HAL_MMC_STATE_READY;

  return HAL_OK;

}

/**

  * @brief  Initializes the MMC Card.

  * @param  hmmc: Pointer to MMC handle

  * @note   This function initializes the MMC card. It could be used when a card

            re-initialization is needed.

  * @retval HAL status

  */

HAL_StatusTypeDef HAL_MMC_InitCard(MMC_HandleTypeDef *hmmc)

{

  uint32_t errorstate;

  MMC_InitTypeDef Init;

  HAL_StatusTypeDef status;

  /* Default SDIO peripheral configuration for MMC card initialization */

  Init.ClockEdge           = SDIO_CLOCK_EDGE_RISING;

  Init.ClockBypass         = SDIO_CLOCK_BYPASS_DISABLE;

  Init.ClockPowerSave      = SDIO_CLOCK_POWER_SAVE_DISABLE;

  Init.BusWide             = SDIO_BUS_WIDE_1B;

  Init.HardwareFlowControl = SDIO_HARDWARE_FLOW_CONTROL_DISABLE;

  Init.ClockDiv            = SDIO_INIT_CLK_DIV;

  /* Initialize SDIO peripheral interface with default configuration */

  status = SDIO_Init(hmmc->Instance, Init);

  if(status == HAL_ERROR)

  {

    return HAL_ERROR;

  }

  /* Disable SDIO Clock */

  __HAL_MMC_DISABLE(hmmc);

  /* Set Power State to ON */

  status = SDIO_PowerState_ON(hmmc->Instance);

  if(status == HAL_ERROR)

  {

    return HAL_ERROR;

  }

  /* Enable MMC Clock */

  __HAL_MMC_ENABLE(hmmc);

  /* Identify card operating voltage */

  errorstate = MMC_PowerON(hmmc);

  if(errorstate != HAL_MMC_ERROR_NONE)

  {

    hmmc->State = HAL_MMC_STATE_READY;

    hmmc->ErrorCode |= errorstate;

    return HAL_ERROR;

  }

  /* Card initialization */

  errorstate = MMC_InitCard(hmmc);

  if(errorstate != HAL_MMC_ERROR_NONE)

  {

    hmmc->State = HAL_MMC_STATE_READY;

    hmmc->ErrorCode |= errorstate;

    return HAL_ERROR;

  }

  return HAL_OK;

}

/**

  * @brief  De-Initializes the MMC card.

  * @param  hmmc: Pointer to MMC handle

  * @retval HAL status

  */

HAL_StatusTypeDef HAL_MMC_DeInit(MMC_HandleTypeDef *hmmc)

{

  /* Check the MMC handle allocation */

  if(hmmc == NULL)

  {

    return HAL_ERROR;

  }

  /* Check the parameters */

  assert_param(IS_SDIO_ALL_INSTANCE(hmmc->Instance));

  hmmc->State = HAL_MMC_STATE_BUSY;

  /* Set MMC power state to off */

  MMC_PowerOFF(hmmc);

#if defined (USE_HAL_MMC_REGISTER_CALLBACKS) && (USE_HAL_MMC_REGISTER_CALLBACKS == 1U)

  if(hmmc->MspDeInitCallback == NULL)

  {

    hmmc->MspDeInitCallback = HAL_MMC_MspDeInit;

  }

  /* DeInit the low level hardware */

  hmmc->MspDeInitCallback(hmmc);

#else

  /* De-Initialize the MSP layer */

  HAL_MMC_MspDeInit(hmmc);

#endif

  hmmc->ErrorCode = HAL_MMC_ERROR_NONE;

  hmmc->State = HAL_MMC_STATE_RESET;

  return HAL_OK;

}

/**

  * @brief  Initializes the MMC MSP.

  * @param  hmmc: Pointer to MMC handle

  * @retval None

  */

__weak void HAL_MMC_MspInit(MMC_HandleTypeDef *hmmc)

{

  /* Prevent unused argument(s) compilation warning */

  UNUSED(hmmc);

  /* NOTE : This function Should not be modified, when the callback is needed,

            the HAL_MMC_MspInit could be implemented in the user file

   */

}

/**

  * @brief  De-Initialize MMC MSP.

  * @param  hmmc: Pointer to MMC handle

  * @retval None

  */

__weak void HAL_MMC_MspDeInit(MMC_HandleTypeDef *hmmc)

{

  /* Prevent unused argument(s) compilation warning */

  UNUSED(hmmc);

  /* NOTE : This function Should not be modified, when the callback is needed,

            the HAL_MMC_MspDeInit could be implemented in the user file

   */

}

/**

  * @}

  */

/** @addtogroup MMC_Exported_Functions_Group2

 *  @brief   Data transfer functions

 *

@verbatim

  ==============================================================================

                        ##### IO operation functions #####

  ==============================================================================

  [..]

    This subsection provides a set of functions allowing to manage the data

    transfer from/to MMC card.

@endverbatim

  * @{

  */

/**

  * @brief  Reads block(s) from a specified address in a card. The Data transfer

  *         is managed by polling mode.

  * @note   This API should be followed by a check on the card state through

  *         HAL_MMC_GetCardState().

  * @param  hmmc: Pointer to MMC handle

  * @param  pData: pointer to the buffer that will contain the received data

  * @param  BlockAdd: Block Address from where data is to be read

  * @param  NumberOfBlocks: Number of MMC blocks to read

  * @param  Timeout: Specify timeout value

  * @retval HAL status

  */

HAL_StatusTypeDef HAL_MMC_ReadBlocks(MMC_HandleTypeDef *hmmc, uint8_t *pData, uint32_t BlockAdd, uint32_t NumberOfBlocks, uint32_t Timeout)

{

  SDIO_DataInitTypeDef config;

  uint32_t errorstate;

  uint32_t tickstart = HAL_GetTick();

  uint32_t count, data, dataremaining;

  uint32_t add = BlockAdd;

  uint8_t *tempbuff = pData;

  if(NULL == pData)

  {

    hmmc->ErrorCode |= HAL_MMC_ERROR_PARAM;

    return HAL_ERROR;

  }

  if(hmmc->State == HAL_MMC_STATE_READY)

  {

    hmmc->ErrorCode = HAL_MMC_ERROR_NONE;

    if((BlockAdd + NumberOfBlocks) > (hmmc->MmcCard.LogBlockNbr))

    {

      hmmc->ErrorCode |= HAL_MMC_ERROR_ADDR_OUT_OF_RANGE;

      return HAL_ERROR;

    }

    hmmc->State = HAL_MMC_STATE_BUSY;

    /* Initialize data control register */

    hmmc->Instance->DCTRL = 0U;

    if ((hmmc->MmcCard.CardType) != MMC_HIGH_CAPACITY_CARD)

    {

      add *= 512U;

    }

    /* Set Block Size for Card */

    errorstate = SDMMC_CmdBlockLength(hmmc->Instance, MMC_BLOCKSIZE);

    if(errorstate != HAL_MMC_ERROR_NONE)

    {

      /* Clear all the static flags */

      __HAL_MMC_CLEAR_FLAG(hmmc, SDIO_STATIC_FLAGS);

      hmmc->ErrorCode |= errorstate;

      hmmc->State = HAL_MMC_STATE_READY;

      return HAL_ERROR;

    }

    /* Configure the MMC DPSM (Data Path State Machine) */

    config.DataTimeOut   = SDMMC_DATATIMEOUT;

    config.DataLength    = NumberOfBlocks * MMC_BLOCKSIZE;

    config.DataBlockSize = SDIO_DATABLOCK_SIZE_512B;

    config.TransferDir   = SDIO_TRANSFER_DIR_TO_SDIO;

    config.TransferMode  = SDIO_TRANSFER_MODE_BLOCK;

    config.DPSM          = SDIO_DPSM_ENABLE;

    (void)SDIO_ConfigData(hmmc->Instance, &config);

    /* Read block(s) in polling mode */

    if(NumberOfBlocks > 1U)

    {

      hmmc->Context = MMC_CONTEXT_READ_MULTIPLE_BLOCK;

      /* Read Multi Block command */

      errorstate = SDMMC_CmdReadMultiBlock(hmmc->Instance, add);

    }

    else

    {

      hmmc->Context = MMC_CONTEXT_READ_SINGLE_BLOCK;

      /* Read Single Block command */

      errorstate = SDMMC_CmdReadSingleBlock(hmmc->Instance, add);

    }

    if(errorstate != HAL_MMC_ERROR_NONE)

    {

      /* Clear all the static flags */

      __HAL_MMC_CLEAR_FLAG(hmmc, SDIO_STATIC_FLAGS);

      hmmc->ErrorCode |= errorstate;

      hmmc->State = HAL_MMC_STATE_READY;

      return HAL_ERROR;

    }

    /* Poll on SDIO flags */

    dataremaining = config.DataLength;

    while(!__HAL_MMC_GET_FLAG(hmmc, SDIO_FLAG_RXOVERR | SDIO_FLAG_DCRCFAIL | SDIO_FLAG_DTIMEOUT | SDIO_FLAG_DATAEND | SDIO_FLAG_STBITERR))

    {

      if(__HAL_MMC_GET_FLAG(hmmc, SDIO_FLAG_RXFIFOHF) && (dataremaining > 0U))

      {

        /* Read data from SDIO Rx FIFO */

        for(count = 0U; count < 8U; count++)

        {

          data = SDIO_ReadFIFO(hmmc->Instance);

          *tempbuff = (uint8_t)(data & 0xFFU);

          tempbuff++;

          dataremaining--;

          *tempbuff = (uint8_t)((data >> 8U) & 0xFFU);

          tempbuff++;

          dataremaining--;

          *tempbuff = (uint8_t)((data >> 16U) & 0xFFU);

          tempbuff++;

          dataremaining--;

          *tempbuff = (uint8_t)((data >> 24U) & 0xFFU);

          tempbuff++;

          dataremaining--;

        }

      }

      if(((HAL_GetTick()-tickstart) >=  Timeout) || (Timeout == 0U))

      {

        /* Clear all the static flags */

        __HAL_MMC_CLEAR_FLAG(hmmc, SDIO_STATIC_FLAGS);

        hmmc->ErrorCode |= HAL_MMC_ERROR_TIMEOUT;

        hmmc->State= HAL_MMC_STATE_READY;

        return HAL_TIMEOUT;

      }

    }

    /* Send stop transmission command in case of multiblock read */

    if(__HAL_MMC_GET_FLAG(hmmc, SDIO_FLAG_DATAEND) && (NumberOfBlocks > 1U))

    {

      /* Send stop transmission command */

      errorstate = SDMMC_CmdStopTransfer(hmmc->Instance);

      if(errorstate != HAL_MMC_ERROR_NONE)

      {

        /* Clear all the static flags */

        __HAL_MMC_CLEAR_FLAG(hmmc, SDIO_STATIC_FLAGS);

        hmmc->ErrorCode |= errorstate;

        hmmc->State = HAL_MMC_STATE_READY;

        return HAL_ERROR;

      }

    }

    /* Get error state */

    if(__HAL_MMC_GET_FLAG(hmmc, SDIO_FLAG_DTIMEOUT))

    {

      /* Clear all the static flags */

      __HAL_MMC_CLEAR_FLAG(hmmc, SDIO_STATIC_FLAGS);

      hmmc->ErrorCode |= HAL_MMC_ERROR_DATA_TIMEOUT;

      hmmc->State = HAL_MMC_STATE_READY;

      return HAL_ERROR;

    }

    else if(__HAL_MMC_GET_FLAG(hmmc, SDIO_FLAG_DCRCFAIL))

    {

      /* Clear all the static flags */

      __HAL_MMC_CLEAR_FLAG(hmmc, SDIO_STATIC_FLAGS);

      hmmc->ErrorCode |= HAL_MMC_ERROR_DATA_CRC_FAIL;

      hmmc->State = HAL_MMC_STATE_READY;

      return HAL_ERROR;

    }

    else if(__HAL_MMC_GET_FLAG(hmmc, SDIO_FLAG_RXOVERR))

    {

      /* Clear all the static flags */

      __HAL_MMC_CLEAR_FLAG(hmmc, SDIO_STATIC_FLAGS);

      hmmc->ErrorCode |= HAL_MMC_ERROR_RX_OVERRUN;

      hmmc->State = HAL_MMC_STATE_READY;

      return HAL_ERROR;

    }

    else

    {

      /* Nothing to do */

    }

    /* Empty FIFO if there is still any data */

    while ((__HAL_MMC_GET_FLAG(hmmc, SDIO_FLAG_RXDAVL)) && (dataremaining > 0U))

    {

      data = SDIO_ReadFIFO(hmmc->Instance);

      *tempbuff = (uint8_t)(data & 0xFFU);

      tempbuff++;

      dataremaining--;

      *tempbuff = (uint8_t)((data >> 8U) & 0xFFU);

      tempbuff++;

      dataremaining--;

      *tempbuff = (uint8_t)((data >> 16U) & 0xFFU);

      tempbuff++;

      dataremaining--;

      *tempbuff = (uint8_t)((data >> 24U) & 0xFFU);

      tempbuff++;

      dataremaining--;

      if(((HAL_GetTick()-tickstart) >=  Timeout) || (Timeout == 0U))

      {

        /* Clear all the static flags */

        __HAL_MMC_CLEAR_FLAG(hmmc, SDIO_STATIC_FLAGS);        

        hmmc->ErrorCode |= HAL_MMC_ERROR_TIMEOUT;

        hmmc->State= HAL_MMC_STATE_READY;

        return HAL_ERROR;

      }

    }

    /* Clear all the static flags */

    __HAL_MMC_CLEAR_FLAG(hmmc, SDIO_STATIC_DATA_FLAGS);

    hmmc->State = HAL_MMC_STATE_READY;

    return HAL_OK;

  }

  else

  {

    hmmc->ErrorCode |= HAL_MMC_ERROR_BUSY;

    return HAL_ERROR;

  }

}

/**

  * @brief  Allows to write block(s) to a specified address in a card. The Data

  *         transfer is managed by polling mode.

  * @note   This API should be followed by a check on the card state through

  *         HAL_MMC_GetCardState().

  * @param  hmmc: Pointer to MMC handle

  * @param  pData: pointer to the buffer that will contain the data to transmit

  * @param  BlockAdd: Block Address where data will be written

  * @param  NumberOfBlocks: Number of MMC blocks to write

  * @param  Timeout: Specify timeout value

  * @retval HAL status

  */

HAL_StatusTypeDef HAL_MMC_WriteBlocks(MMC_HandleTypeDef *hmmc, uint8_t *pData, uint32_t BlockAdd, uint32_t NumberOfBlocks, uint32_t Timeout)

{

  SDIO_DataInitTypeDef config;

  uint32_t errorstate;

  uint32_t tickstart = HAL_GetTick();

  uint32_t count, data, dataremaining;

  uint32_t add = BlockAdd;

  uint8_t *tempbuff = pData;

  if(NULL == pData)

  {

    hmmc->ErrorCode |= HAL_MMC_ERROR_PARAM;

    return HAL_ERROR;

  }

  if(hmmc->State == HAL_MMC_STATE_READY)

  {

    hmmc->ErrorCode = HAL_MMC_ERROR_NONE;

    if((BlockAdd + NumberOfBlocks) > (hmmc->MmcCard.LogBlockNbr))

    {

      hmmc->ErrorCode |= HAL_MMC_ERROR_ADDR_OUT_OF_RANGE;

      return HAL_ERROR;

    }

    hmmc->State = HAL_MMC_STATE_BUSY;

    /* Initialize data control register */

    hmmc->Instance->DCTRL = 0U;

    if ((hmmc->MmcCard.CardType) != MMC_HIGH_CAPACITY_CARD)

    {

      add *= 512U;

    }

    /* Set Block Size for Card */

    errorstate = SDMMC_CmdBlockLength(hmmc->Instance, MMC_BLOCKSIZE);

    if(errorstate != HAL_MMC_ERROR_NONE)

    {

      /* Clear all the static flags */

      __HAL_MMC_CLEAR_FLAG(hmmc, SDIO_STATIC_FLAGS);

      hmmc->ErrorCode |= errorstate;

      hmmc->State = HAL_MMC_STATE_READY;

      return HAL_ERROR;

    }

    /* Write Blocks in Polling mode */

    if(NumberOfBlocks > 1U)

    {

      hmmc->Context = MMC_CONTEXT_WRITE_MULTIPLE_BLOCK;

      /* Write Multi Block command */

      errorstate = SDMMC_CmdWriteMultiBlock(hmmc->Instance, add);

    }

    else

    {

      hmmc->Context = MMC_CONTEXT_WRITE_SINGLE_BLOCK;

      /* Write Single Block command */

      errorstate = SDMMC_CmdWriteSingleBlock(hmmc->Instance, add);

    }

    if(errorstate != HAL_MMC_ERROR_NONE)

    {

      /* Clear all the static flags */

      __HAL_MMC_CLEAR_FLAG(hmmc, SDIO_STATIC_FLAGS);

      hmmc->ErrorCode |= errorstate;

      hmmc->State = HAL_MMC_STATE_READY;

      return HAL_ERROR;

    }

    /* Configure the MMC DPSM (Data Path State Machine) */

    config.DataTimeOut   = SDMMC_DATATIMEOUT;

    config.DataLength    = NumberOfBlocks * MMC_BLOCKSIZE;

    config.DataBlockSize = SDIO_DATABLOCK_SIZE_512B;

    config.TransferDir   = SDIO_TRANSFER_DIR_TO_CARD;

    config.TransferMode  = SDIO_TRANSFER_MODE_BLOCK;

    config.DPSM          = SDIO_DPSM_ENABLE;

    (void)SDIO_ConfigData(hmmc->Instance, &config);

    /* Write block(s) in polling mode */

    dataremaining = config.DataLength;

    while(!__HAL_MMC_GET_FLAG(hmmc, SDIO_FLAG_TXUNDERR | SDIO_FLAG_DCRCFAIL | SDIO_FLAG_DTIMEOUT | SDIO_FLAG_DATAEND | SDIO_FLAG_STBITERR))

    {

      if(__HAL_MMC_GET_FLAG(hmmc, SDIO_FLAG_TXFIFOHE) && (dataremaining > 0U))

      {

        /* Write data to SDIO Tx FIFO */

        for(count = 0U; count < 8U; count++)

        {

          data = (uint32_t)(*tempbuff);

          tempbuff++;

          dataremaining--;

          data |= ((uint32_t)(*tempbuff) << 8U);

          tempbuff++;

          dataremaining--;

          data |= ((uint32_t)(*tempbuff) << 16U);

          tempbuff++;

          dataremaining--;

          data |= ((uint32_t)(*tempbuff) << 24U);

          tempbuff++;

          dataremaining--;

          (void)SDIO_WriteFIFO(hmmc->Instance, &data);

        }

      }

      if(((HAL_GetTick()-tickstart) >=  Timeout) || (Timeout == 0U))

      {

        /* Clear all the static flags */

        __HAL_MMC_CLEAR_FLAG(hmmc, SDIO_STATIC_FLAGS);

        hmmc->ErrorCode |= errorstate;

        hmmc->State = HAL_MMC_STATE_READY;

        return HAL_TIMEOUT;

      }

    }

    /* Send stop transmission command in case of multiblock write */

    if(__HAL_MMC_GET_FLAG(hmmc, SDIO_FLAG_DATAEND) && (NumberOfBlocks > 1U))

    {

      /* Send stop transmission command */

      errorstate = SDMMC_CmdStopTransfer(hmmc->Instance);

      if(errorstate != HAL_MMC_ERROR_NONE)

      {

        /* Clear all the static flags */

        __HAL_MMC_CLEAR_FLAG(hmmc, SDIO_STATIC_FLAGS);

        hmmc->ErrorCode |= errorstate;

        hmmc->State = HAL_MMC_STATE_READY;

        return HAL_ERROR;

      }

    }