[mirror_edk2.git] / EmbeddedPkg / Universal / MmcDxe / MmcBlockIo.c

/** @file\r
*\r
*  Copyright (c) 2011-2013, ARM Limited. All rights reserved.\r
*  \r
*  This program and the accompanying materials                          \r
*  are licensed and made available under the terms and conditions of the BSD License         \r
*  which accompanies this distribution.  The full text of the license may be found at        \r
*  http://opensource.org/licenses/bsd-license.php                                            \r
*\r
*  THE PROGRAM IS DISTRIBUTED UNDER THE BSD LICENSE ON AN "AS IS" BASIS,                     \r
*  WITHOUT WARRANTIES OR REPRESENTATIONS OF ANY KIND, EITHER EXPRESS OR IMPLIED.             \r
*\r
**/\r
\r
#include <Protocol/MmcHost.h>\r
#include <Library/DebugLib.h>\r
#include <Library/BaseMemoryLib.h>\r
#include <Library/TimerLib.h>\r
\r
#include "Mmc.h"\r
\r
// Untested ...\r
//#define USE_STREAM\r
\r
#define MAX_RETRY_COUNT  1000\r
#define CMD_RETRY_COUNT  20\r
\r
EFI_STATUS\r
MmcNotifyState (\r
  IN MMC_HOST_INSTANCE *MmcHostInstance,\r
  IN MMC_STATE State\r
  )\r
{\r
  MmcHostInstance->State = State;\r
  return MmcHostInstance->MmcHost->NotifyState (MmcHostInstance->MmcHost, State);\r
}\r
\r
VOID\r
PrintOCR (\r
  IN UINT32 Ocr\r
  )\r
{\r
  UINTN MinV;\r
  UINTN MaxV;\r
  UINTN Volts;\r
  UINTN Loop;\r
\r
  MinV  = 36;  // 3.6\r
  MaxV  = 20;  // 2.0\r
  Volts = 20;  // 2.0\r
\r
  // The MMC register bits [23:8] indicate the working range of the card\r
  for (Loop = 8; Loop < 24; Loop++) {\r
    if (Ocr & (1 << Loop)) {\r
      if (MinV > Volts) MinV = Volts;\r
      if (MaxV < Volts) MaxV = Volts + 1;\r
    }\r
    Volts = Volts + 1;\r
  }\r
\r
  DEBUG ((EFI_D_ERROR, "- PrintOCR Ocr (0x%X)\n",Ocr));\r
  DEBUG ((EFI_D_ERROR, "\t- Card operating voltage: %d.%d to %d.%d\n", MinV/10, MinV % 10, MaxV/10, MaxV % 10));\r
  if (((Ocr >> 29) & 3) == 0) {\r
    DEBUG ((EFI_D_ERROR, "\t- AccessMode: Byte Mode\n"));\r
  } else {\r
    DEBUG ((EFI_D_ERROR, "\t- AccessMode: Block Mode (0x%X)\n", ((Ocr >> 29) & 3)));\r
  }\r
\r
  if (Ocr & MMC_OCR_POWERUP) {\r
    DEBUG ((EFI_D_ERROR, "\t- PowerUp\n"));\r
  } else {\r
    DEBUG ((EFI_D_ERROR, "\t- Voltage Not Supported\n"));\r
  }\r
}\r
\r
VOID PrintCID (\r
  IN UINT32* Cid\r
  )\r
{\r
  DEBUG ((EFI_D_ERROR, "- PrintCID\n"));\r
  DEBUG ((EFI_D_ERROR, "\t- Manufacturing date: %d/%d\n", (Cid[0] >> 8) & 0xF, (Cid[0] >> 12) & 0xFF));\r
  DEBUG ((EFI_D_ERROR, "\t- Product serial number: 0x%X%X\n", Cid[1] & 0xFFFFFF, (Cid[0] >> 24) & 0xFF));\r
  DEBUG ((EFI_D_ERROR, "\t- Product revision: %d\n", Cid[1] >> 24));\r
  //DEBUG ((EFI_D_ERROR, "\t- Product name: %s\n", (char*)(Cid + 2)));\r
  DEBUG ((EFI_D_ERROR, "\t- OEM ID: %c%c\n", (Cid[3] >> 8) & 0xFF, (Cid[3] >> 16) & 0xFF));\r
}\r
\r
#if !defined(MDEPKG_NDEBUG)\r
CONST CHAR8* mStrUnit[] = { "100kbit/s", "1Mbit/s", "10Mbit/s", "100MBit/s",\r
                            "Unknown", "Unknown", "Unknown", "Unknown" };\r
CONST CHAR8* mStrValue[] = { "1.0", "1.2", "1.3", "1.5", "2.0", "2.5", "3.0", "3.5", "4.0", "4.5", "5.0",\r
                             "Unknown", "Unknown", "Unknown", "Unknown" };\r
#endif\r
\r
VOID\r
PrintCSD (\r
  IN UINT32* Csd\r
  )\r
{\r
  UINTN Value;\r
\r
  if (((Csd[2] >> 30) & 0x3) == 0) {\r
    DEBUG ((EFI_D_ERROR, "- PrintCSD Version 1.01-1.10/Version 2.00/Standard Capacity\n"));\r
  } else if (((Csd[2] >> 30) & 0x3) == 1) {\r
    DEBUG ((EFI_D_ERROR, "- PrintCSD Version 2.00/High Capacity\n"));\r
  } else {\r
    DEBUG ((EFI_D_ERROR, "- PrintCSD Version Higher than v3.3\n"));\r
  }\r
\r
  DEBUG ((EFI_D_ERROR, "\t- Supported card command class: 0x%X\n", MMC_CSD_GET_CCC(Csd)));\r
  DEBUG ((EFI_D_ERROR, "\t- Speed: %a %a\n",mStrValue[(MMC_CSD_GET_TRANSPEED(Csd) >> 3) & 0xF],mStrUnit[MMC_CSD_GET_TRANSPEED(Csd) & 7]));\r
  DEBUG ((EFI_D_ERROR, "\t- Maximum Read Data Block: %d\n",2 << (MMC_CSD_GET_READBLLEN(Csd)-1)));\r
  DEBUG ((EFI_D_ERROR, "\t- Maximum Write Data Block: %d\n",2 << (MMC_CSD_GET_WRITEBLLEN(Csd)-1)));\r
\r
  if (!MMC_CSD_GET_FILEFORMATGRP(Csd)) {\r
    Value = MMC_CSD_GET_FILEFORMAT (Csd);\r
    if (Value == 0)         DEBUG ((EFI_D_ERROR, "\t- Format (0): Hard disk-like file system with partition table\n"));\r
    else if (Value == 1)    DEBUG ((EFI_D_ERROR, "\t- Format (1): DOS FAT (floppy-like) with boot sector only (no partition table)\n"));\r
    else if (Value == 2)    DEBUG ((EFI_D_ERROR, "\t- Format (2): Universal File Format\n"));\r
    else                    DEBUG ((EFI_D_ERROR, "\t- Format (3): Others/Unknown\n"));\r
  } else {\r
    DEBUG ((EFI_D_ERROR, "\t- Format: Reserved\n"));\r
  }\r
}\r
\r
VOID\r
PrintRCA (\r
  IN UINT32 Rca\r
  )\r
{\r
  DEBUG ((EFI_D_ERROR, "- PrintRCA: 0x%X\n", Rca));\r
  DEBUG ((EFI_D_ERROR, "\t- Status: 0x%X\n", Rca & 0xFFFF));\r
  DEBUG ((EFI_D_ERROR, "\t- RCA: 0x%X\n", (Rca >> 16) & 0xFFFF));\r
}\r
\r
VOID\r
PrintResponseR1 (\r
  IN  UINT32 Response\r
  )\r
{\r
  DEBUG ((EFI_D_INFO, "Response: 0x%X\n", Response));\r
  if (Response & MMC_R0_READY_FOR_DATA) {\r
    DEBUG ((EFI_D_INFO, "\t- READY_FOR_DATA\n"));\r
  }\r
\r
  if (((Response >> 9) & 0xF) == 0)         DEBUG ((EFI_D_INFO, "\t- State: Idle\n"));\r
  else if (((Response >> 9) & 0xF) == 1)    DEBUG ((EFI_D_INFO, "\t- State: Ready\n"));\r
  else if (((Response >> 9) & 0xF) == 2)    DEBUG ((EFI_D_INFO, "\t- State: Ident\n"));\r
  else if (((Response >> 9) & 0xF) == 3)    DEBUG ((EFI_D_INFO, "\t- State: StandBy\n"));\r
  else if (((Response >> 9) & 0xF) == 4)    DEBUG ((EFI_D_INFO, "\t- State: Tran\n"));\r
  else if (((Response >> 9) & 0xF) == 5)    DEBUG ((EFI_D_INFO, "\t- State: Data\n"));\r
  else if (((Response >> 9) & 0xF) == 6)    DEBUG ((EFI_D_INFO, "\t- State: Rcv\n"));\r
  else if (((Response >> 9) & 0xF) == 7)    DEBUG ((EFI_D_INFO, "\t- State: Prg\n"));\r
  else if (((Response >> 9) & 0xF) == 8)    DEBUG ((EFI_D_INFO, "\t- State: Dis\n"));\r
  else                                      DEBUG ((EFI_D_INFO, "\t- State: Reserved\n"));\r
}\r
\r
EFI_STATUS\r
EFIAPI\r
MmcGetCardStatus(\r
	IN MMC_HOST_INSTANCE     *MmcHostInstance\r
  )\r
{\r
  EFI_STATUS              Status;\r
  UINT32                  Response[4];\r
  UINTN                   CmdArg;\r
  EFI_MMC_HOST_PROTOCOL   *MmcHost;\r
\r
  Status = EFI_SUCCESS;\r
  MmcHost = MmcHostInstance->MmcHost;\r
  CmdArg = 0;\r
\r
  if (MmcHost == NULL) {\r
    return EFI_INVALID_PARAMETER;\r
  }\r
  if(MmcHostInstance->State != MmcHwInitializationState){\r
    //Get the Status of the card.\r
    CmdArg = MmcHostInstance->CardInfo.RCA << 16;\r
    Status = MmcHost->SendCommand (MmcHost, MMC_CMD13, CmdArg);\r
    if (EFI_ERROR (Status)) {\r
      DEBUG ((EFI_D_ERROR, "MmcGetCardStatus(MMC_CMD13): Error and Status = %r\n", Status));\r
      return Status;\r
    }\r
\r
    //Read Response\r
    MmcHost->ReceiveResponse (MmcHost, MMC_RESPONSE_TYPE_R1, Response);\r
    PrintResponseR1 (Response[0]);\r
  }\r
\r
  return Status;\r
}\r
\r
EFI_STATUS\r
EFIAPI\r
MmcIdentificationMode (\r
  IN MMC_HOST_INSTANCE     *MmcHostInstance\r
  )\r
{\r
  EFI_STATUS              Status;\r
  UINT32                  Response[4];\r
  UINTN                   Timeout;\r
  UINTN                   CmdArg;\r
  BOOLEAN                 IsHCS;\r
  EFI_MMC_HOST_PROTOCOL   *MmcHost;\r
\r
  MmcHost = MmcHostInstance->MmcHost;\r
  CmdArg = 0;\r
  IsHCS = FALSE;\r
\r
  if (MmcHost == NULL) {\r
    return EFI_INVALID_PARAMETER;\r
  }\r
\r
  // We can get into this function if we restart the identification mode\r
  if (MmcHostInstance->State == MmcHwInitializationState) {\r
    // Initialize the MMC Host HW\r
    Status = MmcNotifyState (MmcHostInstance, MmcHwInitializationState);\r
    if (EFI_ERROR (Status)) {\r
      DEBUG ((EFI_D_ERROR, "MmcIdentificationMode() : Error MmcHwInitializationState\n"));\r
      return Status;\r
    }\r
  }\r
\r
  Status = MmcHost->SendCommand (MmcHost, MMC_CMD0, 0);\r
  if (EFI_ERROR (Status)) {\r
    DEBUG ((EFI_D_ERROR, "MmcIdentificationMode(MMC_CMD0): Error\n"));\r
    return Status;\r
  }\r
\r
  Status = MmcNotifyState (MmcHostInstance, MmcIdleState);\r
  if (EFI_ERROR (Status)) {\r
    DEBUG ((EFI_D_ERROR, "MmcIdentificationMode() : Error MmcIdleState\n"));\r
    return Status;\r
  }\r
\r
  // Are we using SDIO ?\r
  Status = MmcHost->SendCommand (MmcHost, MMC_CMD5, 0);\r
  if (Status == EFI_SUCCESS) {\r
    DEBUG ((EFI_D_ERROR, "MmcIdentificationMode(MMC_CMD5): Error - SDIO not supported.\n"));\r
    return EFI_UNSUPPORTED;\r
  }\r
\r
  // Check which kind of card we are using. Ver2.00 or later SD Memory Card (PL180 is SD v1.1)\r
  CmdArg = (0x0UL << 12 | BIT8 | 0xCEUL << 0);\r
  Status = MmcHost->SendCommand (MmcHost, MMC_CMD8, CmdArg);\r
  if (Status == EFI_SUCCESS) {\r
    DEBUG ((EFI_D_ERROR, "Card is SD2.0 => Supports high capacity\n"));\r
    IsHCS = TRUE;\r
    MmcHost->ReceiveResponse (MmcHost, MMC_RESPONSE_TYPE_R7, Response);\r
    PrintResponseR1 (Response[0]);\r
    //check if it is valid response\r
    if(Response[0] != CmdArg){\r
      DEBUG ((EFI_D_ERROR, "The Card is not usable\n"));\r
      return EFI_UNSUPPORTED;\r
    }\r
  } else {\r
    DEBUG ((EFI_D_ERROR, "Not a SD2.0 Card\n"));\r
  }\r
\r
  // We need to wait for the MMC or SD card is ready => (gCardInfo.OCRData.PowerUp == 1)\r
  Timeout = MAX_RETRY_COUNT;\r
  while (Timeout > 0) {\r
    // SD Card or MMC Card ? CMD55 indicates to the card that the next command is an application specific command\r
    Status = MmcHost->SendCommand (MmcHost, MMC_CMD55, 0);\r
    if (Status == EFI_SUCCESS) {\r
        DEBUG ((EFI_D_INFO, "Card should be SD\n"));\r
        if (IsHCS) {\r
            MmcHostInstance->CardInfo.CardType = SD_CARD_2;\r
        } else {\r
            MmcHostInstance->CardInfo.CardType = SD_CARD;\r
        }\r
\r
        // Note: The first time CmdArg will be zero\r
        CmdArg = ((UINTN *) &(MmcHostInstance->CardInfo.OCRData))[0];\r
        if (IsHCS) {\r
            CmdArg |= BIT30;\r
        }\r
        Status = MmcHost->SendCommand (MmcHost, MMC_ACMD41, CmdArg);\r
        if (!EFI_ERROR (Status)) {\r
          MmcHost->ReceiveResponse (MmcHost, MMC_RESPONSE_TYPE_OCR, Response);\r
          ((UINT32 *) &(MmcHostInstance->CardInfo.OCRData))[0] = Response[0];\r
        }\r
    } else {\r
        DEBUG ((EFI_D_INFO, "Card should be MMC\n"));\r
        MmcHostInstance->CardInfo.CardType = MMC_CARD;\r
\r
        Status = MmcHost->SendCommand (MmcHost, MMC_CMD1, 0x800000);\r
        if (!EFI_ERROR (Status)) {\r
          MmcHost->ReceiveResponse (MmcHost, MMC_RESPONSE_TYPE_OCR, Response);\r
          ((UINT32 *) &(MmcHostInstance->CardInfo.OCRData))[0] = Response[0];\r
        }\r
    }\r
\r
    if (!EFI_ERROR (Status)) {\r
      if (!MmcHostInstance->CardInfo.OCRData.PowerUp) {\r
          MicroSecondDelay (1);\r
          Timeout--;\r
      } else {\r
          if ((MmcHostInstance->CardInfo.CardType == SD_CARD_2) && (MmcHostInstance->CardInfo.OCRData.AccessMode & BIT1)) {\r
              MmcHostInstance->CardInfo.CardType = SD_CARD_2_HIGH;\r
              DEBUG ((EFI_D_ERROR, "High capacity card.\n"));\r
          }\r
          break;  // The MMC/SD card is ready. Continue the Identification Mode\r
      }\r
    } else {\r
      MicroSecondDelay (1);\r
      Timeout--;\r
    }\r
  }\r
\r
  if (Timeout == 0) {\r
    DEBUG ((EFI_D_ERROR, "MmcIdentificationMode(): No Card\n"));\r
    return EFI_NO_MEDIA;\r
  } else {\r
    PrintOCR (Response[0]);\r
  }\r
\r
  Status = MmcNotifyState (MmcHostInstance, MmcReadyState);\r
  if (EFI_ERROR (Status)) {\r
    DEBUG ((EFI_D_ERROR, "MmcIdentificationMode() : Error MmcReadyState\n"));\r
    return Status;\r
  }\r
\r
  Status = MmcHost->SendCommand (MmcHost, MMC_CMD2, 0);\r
  if (EFI_ERROR (Status)) {\r
    DEBUG ((EFI_D_ERROR, "MmcIdentificationMode(MMC_CMD2): Error\n"));\r
    return Status;\r
  }\r
  MmcHost->ReceiveResponse (MmcHost, MMC_RESPONSE_TYPE_CID, Response);\r
  PrintCID(Response);\r
\r
  Status = MmcNotifyState (MmcHostInstance, MmcIdentificationState);\r
  if (EFI_ERROR (Status)) {\r
    DEBUG ((EFI_D_ERROR, "MmcIdentificationMode() : Error MmcIdentificationState\n"));\r
    return Status;\r
  }\r
\r
  //\r
  // Note, SD specifications say that "if the command execution causes a state change, it\r
  // will be visible to the host in the response to the next command"\r
  // The status returned for this CMD3 will be 2 - identification\r
  //\r
  CmdArg = 1;\r
  Status = MmcHost->SendCommand (MmcHost, MMC_CMD3, CmdArg);\r
  if (EFI_ERROR (Status)) {\r
    DEBUG ((EFI_D_ERROR, "MmcIdentificationMode(MMC_CMD3): Error\n"));\r
    return Status;\r
  }\r
\r
  MmcHost->ReceiveResponse (MmcHost, MMC_RESPONSE_TYPE_RCA, Response);\r
  PrintRCA (Response[0]);\r
\r
  // For MMC card, RCA is assigned by CMD3 while CMD3 dumps the RCA for SD card\r
  if (MmcHostInstance->CardInfo.CardType != MMC_CARD) {\r
    MmcHostInstance->CardInfo.RCA = Response[0] >> 16;\r
  } else {\r
    MmcHostInstance->CardInfo.RCA = CmdArg;\r
  }\r
\r
  Status = MmcNotifyState (MmcHostInstance, MmcStandByState);\r
  if (EFI_ERROR (Status)) {\r
    DEBUG ((EFI_D_ERROR, "MmcIdentificationMode() : Error MmcStandByState\n"));\r
    return Status;\r
  }\r
\r
  return EFI_SUCCESS;\r
}\r
\r
EFI_STATUS InitializeMmcDevice (\r
  IN  MMC_HOST_INSTANCE   *MmcHostInstance\r
  )\r
{\r
  UINT32                  Response[4];\r
  EFI_STATUS              Status;\r
  UINTN                   CardSize, NumBlocks, BlockSize, CmdArg;\r
  EFI_MMC_HOST_PROTOCOL   *MmcHost;\r
  UINTN                   BlockCount = 1;\r
  \r
  MmcHost = MmcHostInstance->MmcHost;\r
\r
  MmcIdentificationMode (MmcHostInstance);\r
\r
  //Send a command to get Card specific data\r
  CmdArg = MmcHostInstance->CardInfo.RCA << 16;\r
  Status = MmcHost->SendCommand (MmcHost, MMC_CMD9, CmdArg);\r
  if (EFI_ERROR (Status)) {\r
    DEBUG ((EFI_D_ERROR, "MmcIdentificationMode(MMC_CMD9): Error, Status=%r\n", Status));\r
    return Status;\r
  }\r
  //Read Response\r
  MmcHost->ReceiveResponse (MmcHost, MMC_RESPONSE_TYPE_CSD, Response);\r
  PrintCSD(Response);\r
\r
  if (MmcHostInstance->CardInfo.CardType == SD_CARD_2_HIGH) {\r
    CardSize = HC_MMC_CSD_GET_DEVICESIZE (Response);\r
    NumBlocks = ((CardSize + 1) * 1024);\r
    BlockSize = 1 << MMC_CSD_GET_READBLLEN(Response);\r
  } else {\r
    CardSize = MMC_CSD_GET_DEVICESIZE (Response);\r
    NumBlocks = (CardSize + 1) * (1 << (MMC_CSD_GET_DEVICESIZEMULT (Response) + 2));\r
    BlockSize = 1 << MMC_CSD_GET_READBLLEN(Response);\r
  }\r
\r
  //For >=2G card, BlockSize may be 1K, but the transfer size is 512 bytes.\r
  if (BlockSize > 512) {\r
    NumBlocks = MultU64x32 (NumBlocks, BlockSize/512);\r
    BlockSize = 512;\r
  }\r
\r
  MmcHostInstance->BlockIo.Media->LastBlock    = (NumBlocks - 1);\r
  MmcHostInstance->BlockIo.Media->BlockSize    = BlockSize;\r
  MmcHostInstance->BlockIo.Media->ReadOnly     = MmcHost->IsReadOnly (MmcHost);\r
  MmcHostInstance->BlockIo.Media->MediaPresent = TRUE;\r
  MmcHostInstance->BlockIo.Media->MediaId++;\r
\r
  CmdArg = MmcHostInstance->CardInfo.RCA << 16;\r
  Status = MmcHost->SendCommand (MmcHost, MMC_CMD7, CmdArg);\r
  if (EFI_ERROR (Status)) {\r
    DEBUG ((EFI_D_ERROR, "MmcIdentificationMode(MMC_CMD7): Error and Status = %r\n", Status));\r
    return Status;\r
  }\r
\r
  Status = MmcNotifyState (MmcHostInstance, MmcTransferState);\r
  if (EFI_ERROR (Status)) {\r
    DEBUG ((EFI_D_ERROR, "MmcIdentificationMode() : Error MmcTransferState\n"));\r
    return Status;\r
  }\r
\r
  // Set Block Length\r
  Status = MmcHost->SendCommand (MmcHost, MMC_CMD16, MmcHostInstance->BlockIo.Media->BlockSize);\r
  if (EFI_ERROR (Status)) {\r
    DEBUG ((EFI_D_ERROR, "MmcIdentificationMode(MMC_CMD16): Error MmcHostInstance->BlockIo.Media->BlockSize: %d and Error = %r\n", MmcHostInstance->BlockIo.Media->BlockSize, Status));\r
    return Status;\r
  }\r
\r
  // Block Count (not used). Could return an error for SD card\r
  if (MmcHostInstance->CardInfo.CardType == MMC_CARD) {\r
    MmcHost->SendCommand (MmcHost, MMC_CMD23, BlockCount);\r
  }\r
\r
  return EFI_SUCCESS;\r
}\r
\r
EFI_STATUS\r
EFIAPI\r
MmcReset (\r
  IN EFI_BLOCK_IO_PROTOCOL    *This,\r
  IN BOOLEAN                  ExtendedVerification\r
  )\r
{\r
  MMC_HOST_INSTANCE       *MmcHostInstance;\r
\r
  MmcHostInstance = MMC_HOST_INSTANCE_FROM_BLOCK_IO_THIS (This);\r
\r
  if (MmcHostInstance->MmcHost == NULL) {\r
    // Nothing to do\r
    return EFI_SUCCESS;\r
  }\r
\r
  // If a card is not present then clear all media settings\r
  if (!MmcHostInstance->MmcHost->IsCardPresent (MmcHostInstance->MmcHost)) {\r
    MmcHostInstance->BlockIo.Media->MediaPresent = FALSE;\r
    MmcHostInstance->BlockIo.Media->LastBlock    = 0;\r
    MmcHostInstance->BlockIo.Media->BlockSize    = 512;  // Should be zero but there is a bug in DiskIo\r
    MmcHostInstance->BlockIo.Media->ReadOnly     = FALSE;\r
\r
    // Indicate that the driver requires initialization\r
    MmcHostInstance->State = MmcHwInitializationState;\r
\r
    return EFI_SUCCESS;\r
  }\r
\r
  // Implement me. Either send a CMD0 (could not work for some MMC host) or just turn off/turn\r
  //      on power and restart Identification mode\r
  return EFI_SUCCESS;\r
}\r
\r
EFI_STATUS\r
MmcDetectCard (\r
  EFI_MMC_HOST_PROTOCOL     *MmcHost\r
  )\r
{\r
  if (!MmcHost->IsCardPresent (MmcHost)) {\r
    return EFI_NO_MEDIA;\r
  } else {\r
    return EFI_SUCCESS;\r
  }\r
}\r
\r
#define MMCI0_BLOCKLEN 512\r
#define MMCI0_TIMEOUT  10000\r
\r
EFI_STATUS\r
MmcIoBlocks (\r
  IN EFI_BLOCK_IO_PROTOCOL    *This,\r
  IN UINTN                    Transfer,\r
  IN UINT32                   MediaId,\r
  IN EFI_LBA                  Lba,\r
  IN UINTN                    BufferSize,\r
  OUT VOID                    *Buffer\r
  )\r
{\r
  UINT32                  Response[4];\r
  EFI_STATUS              Status;\r
  UINTN                   CmdArg;\r
  INTN                    Timeout;\r
  UINTN                   Cmd;\r
  MMC_HOST_INSTANCE       *MmcHostInstance;\r
  EFI_MMC_HOST_PROTOCOL   *MmcHost;\r
  UINTN                   BytesRemainingToBeTransfered;\r
  UINTN                   BlockCount = 1;\r
\r
  MmcHostInstance = MMC_HOST_INSTANCE_FROM_BLOCK_IO_THIS (This);\r
  ASSERT (MmcHostInstance != 0);\r
  MmcHost = MmcHostInstance->MmcHost;\r
  ASSERT (MmcHost);\r
\r
  if ((MmcHost == 0)|| (Buffer == NULL)) {\r
    return EFI_INVALID_PARAMETER;\r
  }\r
\r
  // Check if a Card is Present\r
  if (!MmcHostInstance->BlockIo.Media->MediaPresent) {\r
    return EFI_NO_MEDIA;\r
  }\r
\r
  // All blocks must be within the device\r
  if ((Lba + (BufferSize / This->Media->BlockSize)) > (This->Media->LastBlock + 1)){\r
    return EFI_INVALID_PARAMETER;\r
  }\r
\r
  // The buffer size must not be zero and it must be an exact multiple of the block size\r
  if ((BufferSize == 0) || ((BufferSize % This->Media->BlockSize) != 0)) {\r
    return EFI_BAD_BUFFER_SIZE;\r
  }\r
\r
  if (This->Media->MediaId != MediaId) {\r
    return EFI_MEDIA_CHANGED;\r
  }\r
\r
  if((Transfer == MMC_IOBLOCKS_WRITE) && (This->Media->ReadOnly == TRUE)) {\r
    return EFI_WRITE_PROTECTED;\r
  }\r
\r
  BytesRemainingToBeTransfered = BufferSize;\r
  while (BytesRemainingToBeTransfered > 0) {\r
\r
    // Check if the Card is in Ready status\r
    CmdArg = MmcHostInstance->CardInfo.RCA << 16;\r
    Response[0] = 0;\r
    Timeout = 20;\r
    while(   (!(Response[0] & MMC_R0_READY_FOR_DATA))\r
          && (MMC_R0_CURRENTSTATE (Response) != MMC_R0_STATE_TRAN)\r
          && Timeout--) {\r
      Status = MmcHost->SendCommand (MmcHost, MMC_CMD13, CmdArg);\r
      if (!EFI_ERROR (Status)) {\r
        MmcHost->ReceiveResponse (MmcHost, MMC_RESPONSE_TYPE_R1, Response);\r
      }\r
    }\r
\r
    if (0 == Timeout) {\r
      DEBUG ((EFI_D_ERROR, "The Card is busy\n"));\r
      return EFI_NOT_READY;\r
    }\r
\r
    //Set command argument based on the card access mode (Byte mode or Block mode)\r
    if (MmcHostInstance->CardInfo.OCRData.AccessMode & BIT1) {\r
      CmdArg = Lba;\r
    } else {\r
      CmdArg = Lba * This->Media->BlockSize;\r
    }\r
\r
    if (Transfer == MMC_IOBLOCKS_READ) {\r
#ifndef USE_STREAM\r
      // Read a single block\r
      Cmd = MMC_CMD17;\r
#else\r
      //TODO: Should we support read stream (MMC_CMD11)\r
#endif\r
    } else {\r
#ifndef USE_STREAM\r
      // Write a single block\r
      Cmd = MMC_CMD24;\r
#else\r
      //TODO: Should we support write stream (MMC_CMD20)\r
#endif\r
    }\r
    Status = MmcHost->SendCommand (MmcHost, Cmd, CmdArg);\r
    if (EFI_ERROR (Status)) {\r
      DEBUG ((EFI_D_ERROR, "MmcIoBlocks(MMC_CMD%d): Error %r\n", Cmd, Status));\r
      return Status;\r
    }\r
\r
    if (Transfer == MMC_IOBLOCKS_READ) {\r
#ifndef USE_STREAM\r
      // Read one block of Data\r
      Status = MmcHost->ReadBlockData (MmcHost, Lba, This->Media->BlockSize, Buffer);\r
      if (EFI_ERROR (Status)) {\r
        DEBUG ((EFI_D_BLKIO, "MmcIoBlocks(): Error Read Block Data and Status = %r\n", Status));\r
        return Status;\r
      }\r
#else\r
      //TODO: Read a stream\r
      ASSERT (0);\r
#endif\r
      Status = MmcNotifyState (MmcHostInstance, MmcProgrammingState);\r
      if (EFI_ERROR (Status)) {\r
        DEBUG ((EFI_D_ERROR, "MmcIoBlocks() : Error MmcProgrammingState\n"));\r
        return Status;\r
      }\r
    } else {\r
#ifndef USE_STREAM\r
      // Write one block of Data\r
      Status = MmcHost->WriteBlockData (MmcHost, Lba, This->Media->BlockSize, Buffer);\r
      if (EFI_ERROR (Status)) {\r
        DEBUG ((EFI_D_BLKIO, "MmcIoBlocks(): Error Write Block Data and Status = %r\n", Status));\r
        return Status;\r
      }\r
#else\r
      //TODO: Write a stream\r
      ASSERT (0);\r
#endif\r
    }\r
\r
    // Command 12 - Stop transmission (ends read)\r
    Status = MmcHost->SendCommand (MmcHost, MMC_CMD12, 0);\r
    if (!EFI_ERROR (Status)) {\r
      MmcHost->ReceiveResponse (MmcHost, MMC_RESPONSE_TYPE_R1b, Response);\r
    }\r
\r
    // Command 13 - Read status and wait for programming to complete (return to tran)\r
    Timeout = MMCI0_TIMEOUT;\r
    CmdArg = MmcHostInstance->CardInfo.RCA << 16;\r
    Response[0] = 0;\r
    while(   (!(Response[0] & MMC_R0_READY_FOR_DATA))\r
          && (MMC_R0_CURRENTSTATE (Response) != MMC_R0_STATE_TRAN)\r
          && Timeout--) {\r
      Status = MmcHost->SendCommand (MmcHost, MMC_CMD13, CmdArg);\r
      if (!EFI_ERROR (Status)) {\r
        MmcHost->ReceiveResponse (MmcHost, MMC_RESPONSE_TYPE_R1, Response);\r
        if ((Response[0] & MMC_R0_READY_FOR_DATA)) {\r
          break;  // Prevents delay once finished\r
        }\r
      }\r
      NanoSecondDelay (100);\r
    }\r
\r
    Status = MmcNotifyState (MmcHostInstance, MmcTransferState);\r
    if (EFI_ERROR (Status)) {\r
      DEBUG ((EFI_D_ERROR, "MmcIoBlocks() : Error MmcTransferState\n"));\r
      return Status;\r
    }\r
\r
    BytesRemainingToBeTransfered -= This->Media->BlockSize;\r
    Lba    += BlockCount;\r
    Buffer = (UINT8 *)Buffer + This->Media->BlockSize;\r
  }\r
\r
  return EFI_SUCCESS;\r
}\r
\r
EFI_STATUS\r
EFIAPI\r
MmcReadBlocks (\r
  IN EFI_BLOCK_IO_PROTOCOL    *This,\r
  IN UINT32                   MediaId,\r
  IN EFI_LBA                  Lba,\r
  IN UINTN                    BufferSize,\r
  OUT VOID                    *Buffer\r
  )\r
{\r
  return MmcIoBlocks (This, MMC_IOBLOCKS_READ, MediaId, Lba, BufferSize, Buffer);\r
}\r
\r
EFI_STATUS\r
EFIAPI\r
MmcWriteBlocks (\r
  IN EFI_BLOCK_IO_PROTOCOL    *This,\r
  IN UINT32                   MediaId,\r
  IN EFI_LBA                  Lba,\r
  IN UINTN                    BufferSize,\r
  IN VOID                     *Buffer\r
  )\r
{\r
  return MmcIoBlocks (This, MMC_IOBLOCKS_WRITE, MediaId, Lba, BufferSize, Buffer);\r
}\r
\r
EFI_STATUS\r
EFIAPI\r
MmcFlushBlocks (\r
  IN EFI_BLOCK_IO_PROTOCOL  *This\r
  )\r
{\r
  return EFI_SUCCESS;\r
}\r