EmbeddedPkg/Universal/MmcDxe/MmcBlockIo.c

   1 /** @file
   2 *
   3 *  Copyright (c) 2011, ARM Limited. All rights reserved.
   4 *
   5 *  This program and the accompanying materials
   6 *  are licensed and made available under the terms and conditions of the BSD License
   7 *  which accompanies this distribution.  The full text of the license may be found at
   8 *  http://opensource.org/licenses/bsd-license.php
   9 *
  10 *  THE PROGRAM IS DISTRIBUTED UNDER THE BSD LICENSE ON AN "AS IS" BASIS,
  11 *  WITHOUT WARRANTIES OR REPRESENTATIONS OF ANY KIND, EITHER EXPRESS OR IMPLIED.
  12 *
  13 **/
  14
  15 #include <Protocol/MmcHost.h>
  16 #include <Library/DebugLib.h>
  17 #include <Library/BaseMemoryLib.h>
  18 #include <Library/TimerLib.h>
  19
  20 #include "Mmc.h"
  21
  22 // Untested ...
  23 //#define USE_STREAM
  24
  25 #define MAX_RETRY_COUNT  1000
  26 #define CMD_RETRY_COUNT  20
  27
  28 EFI_STATUS
  29 MmcNotifyState (
  30   IN MMC_HOST_INSTANCE *MmcHostInstance,
  31   IN MMC_STATE State
  32   )
  33 {
  34   MmcHostInstance->State = State;
  35   return MmcHostInstance->MmcHost->NotifyState(State);
  36 }
  37
  38 VOID
  39 PrintOCR (
  40   IN UINT32 Ocr
  41   )
  42 {
  43   UINTN minv, maxv, volts;
  44   UINTN loop;
  45
  46   minv  = 36;  // 3.6
  47   maxv  = 20;  // 2.0
  48   volts = 20;  // 2.0
  49
  50   // The MMC register bits [23:8] indicate the working range of the card
  51   for (loop = 8; loop < 24; loop++) {
  52     if (Ocr & (1 << loop)) {
  53       if (minv > volts) minv = volts;
  54       if (maxv < volts) maxv = volts + 1;
  55     }
  56     volts = volts + 1;
  57   }
  58
  59   DEBUG((EFI_D_ERROR, "- PrintOCR Ocr (0x%X)\n",Ocr));
  60   DEBUG((EFI_D_ERROR, "\t- Card operating voltage: %d.%d to %d.%d\n", minv/10, minv % 10, maxv/10, maxv % 10));
  61   if (((Ocr >> 29) & 3) == 0) {
  62     DEBUG((EFI_D_ERROR, "\t- AccessMode: Byte Mode\n"));
  63   } else {
  64     DEBUG((EFI_D_ERROR, "\t- AccessMode: Block Mode (0x%X)\n",((Ocr >> 29) & 3)));
  65   }
  66
  67   if (Ocr & MMC_OCR_POWERUP) {
  68     DEBUG((EFI_D_ERROR, "\t- PowerUp\n"));
  69   } else {
  70     DEBUG((EFI_D_ERROR, "\t- Voltage Not Supported\n"));
  71   }
  72 }
  73
  74 VOID PrintCID (
  75   IN UINT32* Cid
  76   )
  77 {
  78   DEBUG((EFI_D_ERROR, "- PrintCID\n"));
  79   DEBUG((EFI_D_ERROR, "\t- Manufacturing date: %d/%d\n",(Cid[0] >> 8) & 0xF,(Cid[0] >> 12) & 0xFF));
  80   DEBUG((EFI_D_ERROR, "\t- Product serial number: 0x%X%X\n",Cid[1] & 0xFFFFFF,(Cid[0] >> 24) & 0xFF));
  81   DEBUG((EFI_D_ERROR, "\t- Product revision: %d\n",Cid[1] >> 24));
  82   //DEBUG((EFI_D_ERROR, "\t- Product name: %s\n",(char*)(Cid + 2)));
  83   DEBUG((EFI_D_ERROR, "\t- OEM ID: %c%c\n",(Cid[3] >> 8) & 0xFF,(Cid[3] >> 16) & 0xFF));
  84 }
  85
  86 VOID
  87 PrintCSD (
  88   IN UINT32* Csd
  89   )
  90 {
  91   UINTN Value;
  92 #if !defined(MDEPKG_NDEBUG)
  93   CONST CHAR8* str_unit[] = { "100kbit/s","1Mbit/s","10Mbit/s","100MBit/s","Unkbown","Unkbown","Unkbown","Unkbown" };
  94   CONST CHAR8* str_value[] = { "1.0","1.2","1.3","1.5","2.0","2.5","3.0","3.5","4.0","4.5","5.0","Unknown","Unknown","Unknown","Unknown" };
  95 #endif
  96
  97   if (((Csd[2] >> 30) & 0x3) == 0) {
  98     DEBUG((EFI_D_ERROR, "- PrintCSD Version 1.01-1.10/Version 2.00/Standard Capacity\n"));
  99   } else if (((Csd[2] >> 30) & 0x3) == 1) {
 100     DEBUG((EFI_D_ERROR, "- PrintCSD Version 2.00/High Capacity\n"));
 101   } else {
 102     DEBUG((EFI_D_ERROR, "- PrintCSD Version Higher than v3.3\n"));
 103   }
 104
 105   DEBUG((EFI_D_ERROR, "\t- Supported card command class: 0x%X\n",MMC_CSD_GET_CCC(Csd)));
 106   DEBUG((EFI_D_ERROR, "\t- Speed: %a %a\n",str_value[(MMC_CSD_GET_TRANSPEED(Csd) >> 3) & 0xF],str_unit[MMC_CSD_GET_TRANSPEED(Csd) & 7]));
 107   DEBUG((EFI_D_ERROR, "\t- Maximum Read Data Block: %d\n",2 << (MMC_CSD_GET_READBLLEN(Csd)-1)));
 108   DEBUG((EFI_D_ERROR, "\t- Maximum Write Data Block: %d\n",2 << (MMC_CSD_GET_WRITEBLLEN(Csd)-1)));
 109
 110   if (!MMC_CSD_GET_FILEFORMATGRP(Csd)) {
 111     Value = MMC_CSD_GET_FILEFORMAT(Csd);
 112     if (Value == 0)         DEBUG((EFI_D_ERROR, "\t- Format(0): Hard disk-like file system with partition table\n"));
 113     else if (Value == 1)    DEBUG((EFI_D_ERROR, "\t- Format(1): DOS FAT (floppy-like) with boot sector only (no partition table)\n"));
 114     else if (Value == 2)    DEBUG((EFI_D_ERROR, "\t- Format(2): Universal File Format\n"));
 115     else                    DEBUG((EFI_D_ERROR, "\t- Format(3): Others/Unknown\n"));
 116   } else {
 117     DEBUG((EFI_D_ERROR, "\t- Format: Reserved\n"));
 118   }
 119 }
 120
 121 VOID
 122 PrintRCA (
 123   IN UINT32 Rca
 124   )
 125 {
 126   DEBUG((EFI_D_ERROR, "- PrintRCA: 0x%X\n",Rca));
 127   DEBUG((EFI_D_ERROR, "\t- Status: 0x%X\n",Rca & 0xFFFF));
 128   DEBUG((EFI_D_ERROR, "\t- RCA: 0x%X\n",(Rca >> 16) & 0xFFFF));
 129 }
 130
 131 VOID
 132 PrintResponseR1 (
 133   IN  UINT32 Response
 134   )
 135 {
 136   DEBUG((EFI_D_INFO, "Response: 0x%X\n",Response));
 137   if (Response & (1 << 8))                  DEBUG((EFI_D_INFO, "\t- READY_FOR_DATA\n"));
 138
 139   if (((Response >> 9) & 0xF) == 0)         DEBUG((EFI_D_INFO, "\t- State: Idle\n"));
 140   else if (((Response >> 9) & 0xF) == 1)    DEBUG((EFI_D_INFO, "\t- State: Ready\n"));
 141   else if (((Response >> 9) & 0xF) == 2)    DEBUG((EFI_D_INFO, "\t- State: Ident\n"));
 142   else if (((Response >> 9) & 0xF) == 3)    DEBUG((EFI_D_INFO, "\t- State: StandBy\n"));
 143   else if (((Response >> 9) & 0xF) == 4)    DEBUG((EFI_D_INFO, "\t- State: Tran\n"));
 144   else if (((Response >> 9) & 0xF) == 5)    DEBUG((EFI_D_INFO, "\t- State: Data\n"));
 145   else if (((Response >> 9) & 0xF) == 6)    DEBUG((EFI_D_INFO, "\t- State: Rcv\n"));
 146   else if (((Response >> 9) & 0xF) == 7)    DEBUG((EFI_D_INFO, "\t- State: Prg\n"));
 147   else if (((Response >> 9) & 0xF) == 8)    DEBUG((EFI_D_INFO, "\t- State: Dis\n"));
 148   else                                      DEBUG((EFI_D_INFO, "\t- State: Reserved\n"));
 149 }
 150
 151 EFI_STATUS
 152 EFIAPI
 153 MmcGetCardStatus(
 154         IN MMC_HOST_INSTANCE     *MmcHostInstance
 155   )
 156 {
 157   EFI_STATUS              Status;
 158   UINT32                  Response[4];
 159   UINTN                   CmdArg;
 160   EFI_MMC_HOST_PROTOCOL   *MmcHost;
 161
 162   Status = EFI_SUCCESS;
 163   MmcHost = MmcHostInstance->MmcHost;
 164   CmdArg = 0;
 165
 166   if (MmcHost == NULL) {
 167     return EFI_INVALID_PARAMETER;
 168   }
 169   if(MmcHostInstance->State != MmcHwInitializationState){
 170     //Get the Status of the card.
 171     CmdArg = MmcHostInstance->CardInfo.RCA << 16;
 172     Status = MmcHost->SendCommand(MMC_CMD13, CmdArg);
 173     if (EFI_ERROR(Status)) {
 174       DEBUG((EFI_D_ERROR, "MmcGetCardStatus(MMC_CMD13): Error and Status = %r\n", Status));
 175       ASSERT(0);
 176       return Status;
 177     }
 178
 179     //Read Response
 180     MmcHost->ReceiveResponse(MMC_RESPONSE_TYPE_R1,Response);
 181     PrintResponseR1(Response[0]);
 182   }
 183
 184   return Status;
 185 }
 186
 187 EFI_STATUS
 188 EFIAPI
 189 MmcIdentificationMode (
 190   IN MMC_HOST_INSTANCE     *MmcHostInstance
 191   )
 192 {
 193   EFI_STATUS              Status;
 194   UINT32                  Response[4];
 195   UINTN                   Timeout;
 196   UINTN                   CmdArg;
 197   BOOLEAN                 IsHCS;
 198   EFI_MMC_HOST_PROTOCOL   *MmcHost;
 199
 200   MmcHost = MmcHostInstance->MmcHost;
 201   CmdArg = 0;
 202   IsHCS = FALSE;
 203
 204   if (MmcHost == NULL) {
 205     return EFI_INVALID_PARAMETER;
 206   }
 207
 208   // We can get into this function if we restart the identification mode
 209   if (MmcHostInstance->State == MmcHwInitializationState) {
 210     // Initialize the MMC Host HW
 211     Status = MmcNotifyState (MmcHostInstance, MmcHwInitializationState);
 212     if (EFI_ERROR(Status)) {
 213       DEBUG((EFI_D_ERROR, "MmcIdentificationMode() : Error MmcHwInitializationState\n"));
 214       return Status;
 215     }
 216   } else {
 217     //Note: Could even be used in all cases. But it looks this command could put the state machine into inactive for some cards
 218     Status = MmcHost->SendCommand(MMC_CMD0, 0);
 219     if (EFI_ERROR(Status)) {
 220       DEBUG((EFI_D_ERROR, "MmcIdentificationMode(MMC_CMD0): Error\n"));
 221       return Status;
 222     }
 223   }
 224
 225   Status = MmcNotifyState (MmcHostInstance, MmcIdleState);
 226   if (EFI_ERROR(Status)) {
 227     DEBUG((EFI_D_ERROR, "MmcIdentificationMode() : Error MmcIdleState\n"));
 228     return Status;
 229   }
 230
 231   // Are we using SDIO ?
 232   Status = MmcHost->SendCommand(MMC_CMD5, 0);
 233   if (Status == EFI_SUCCESS) {
 234     DEBUG((EFI_D_ERROR, "MmcIdentificationMode(MMC_CMD5): Error - SDIO not supported.\n"));
 235     return EFI_UNSUPPORTED;
 236   }
 237
 238   // Check which kind of card we are using. Ver2.00 or later SD Memory Card (PL180 is SD v1.1)
 239   CmdArg = (0x0UL << 12 | BIT8 | 0xCEUL << 0);
 240   Status = MmcHost->SendCommand(MMC_CMD8, CmdArg);
 241   if (Status == EFI_SUCCESS) {
 242     DEBUG ((EFI_D_ERROR, "Card is SD2.0 => Supports high capacity\n"));
 243     IsHCS = TRUE;
 244     MmcHost->ReceiveResponse(MMC_RESPONSE_TYPE_R7,Response);
 245     PrintResponseR1(Response[0]);
 246     //check if it is valid response
 247     if(Response[0] != CmdArg){
 248       DEBUG ((EFI_D_ERROR, "The Card is not usable\n"));
 249       return EFI_UNSUPPORTED;
 250     }
 251   } else {
 252     DEBUG ((EFI_D_ERROR, "Not a SD2.0 Card\n"));
 253   }
 254
 255   // We need to wait for the MMC or SD card is ready => (gCardInfo.OCRData.Busy == 1)
 256   Timeout = MAX_RETRY_COUNT;
 257   while (Timeout > 0) {
 258     // SD Card or MMC Card ? CMD55 indicates to the card that the next command is an application specific command
 259     Status = MmcHost->SendCommand(MMC_CMD55, 0);
 260     if (Status == EFI_SUCCESS) {
 261         DEBUG ((EFI_D_INFO, "Card should be SD\n"));
 262         if (IsHCS) {
 263             MmcHostInstance->CardInfo.CardType = SD_CARD_2;
 264         } else {
 265             MmcHostInstance->CardInfo.CardType = SD_CARD;
 266         }
 267
 268         // Note: The first time CmdArg will be zero
 269         CmdArg = ((UINTN *) &(MmcHostInstance->CardInfo.OCRData))[0];
 270         if (IsHCS) {
 271             CmdArg |= BIT30;
 272         }
 273         Status = MmcHost->SendCommand(MMC_ACMD41, CmdArg);
 274         if (!EFI_ERROR(Status)) {
 275           MmcHost->ReceiveResponse(MMC_RESPONSE_TYPE_OCR,Response);
 276           ((UINT32 *) &(MmcHostInstance->CardInfo.OCRData))[0] = Response[0];
 277         }
 278     } else {
 279         DEBUG ((EFI_D_INFO, "Card should be MMC\n"));
 280         MmcHostInstance->CardInfo.CardType = MMC_CARD;
 281
 282         Status = MmcHost->SendCommand(MMC_CMD1, 0x800000);
 283         if (!EFI_ERROR(Status)) {
 284           MmcHost->ReceiveResponse(MMC_RESPONSE_TYPE_OCR,Response);
 285           ((UINT32 *) &(MmcHostInstance->CardInfo.OCRData))[0] = Response[0];
 286         }
 287     }
 288
 289     if (!EFI_ERROR(Status)) {
 290       if (MmcHostInstance->CardInfo.OCRData.Busy == 0) {
 291           MicroSecondDelay(1);
 292           Timeout--;
 293       } else {
 294           if ((MmcHostInstance->CardInfo.CardType == SD_CARD_2) && (MmcHostInstance->CardInfo.OCRData.AccessMode & BIT1)) {
 295               MmcHostInstance->CardInfo.CardType = SD_CARD_2_HIGH;
 296               DEBUG ((EFI_D_ERROR, "High capacity card.\n"));
 297           }
 298           break;  // The MMC/SD card is ready. Continue the Identification Mode
 299       }
 300     } else {
 301       MicroSecondDelay(1);
 302       Timeout--;
 303     }
 304   }
 305
 306   if (Timeout == 0) {
 307     DEBUG((EFI_D_ERROR, "MmcIdentificationMode(): No Card\n"));
 308     ASSERT(0);
 309     return EFI_NO_MEDIA;
 310   } else {
 311     PrintOCR(Response[0]);
 312   }
 313
 314   Status = MmcNotifyState (MmcHostInstance, MmcReadyState);
 315   if (EFI_ERROR(Status)) {
 316     DEBUG((EFI_D_ERROR, "MmcIdentificationMode() : Error MmcReadyState\n"));
 317     return Status;
 318   }
 319
 320   Status = MmcHost->SendCommand(MMC_CMD2, 0);
 321   if (EFI_ERROR(Status)) {
 322     DEBUG((EFI_D_ERROR, "MmcIdentificationMode(MMC_CMD2): Error\n"));
 323     ASSERT(0);
 324     return Status;
 325   }
 326   MmcHost->ReceiveResponse(MMC_RESPONSE_TYPE_CID,Response);
 327   PrintCID(Response);
 328
 329   Status = MmcNotifyState (MmcHostInstance, MmcIdentificationState);
 330   if (EFI_ERROR(Status)) {
 331     DEBUG((EFI_D_ERROR, "MmcIdentificationMode() : Error MmcIdentificationState\n"));
 332     return Status;
 333   }
 334
 335   //
 336   // Note, SD specifications say that "if the command execution causes a state change, it
 337   // will be visible to the host in the response to the next command"
 338   // The status returned for this CMD3 will be 2 - identification
 339   //
 340   CmdArg = 1;
 341   Status = MmcHost->SendCommand(MMC_CMD3, CmdArg);
 342   if (EFI_ERROR(Status)) {
 343     DEBUG((EFI_D_ERROR, "MmcIdentificationMode(MMC_CMD3): Error\n"));
 344     return Status;
 345   }
 346
 347   MmcHost->ReceiveResponse(MMC_RESPONSE_TYPE_RCA,Response);
 348   PrintRCA(Response[0]);
 349
 350   // For MMC card, RCA is assigned by CMD3 while CMD3 dumps the RCA for SD card
 351   if (MmcHostInstance->CardInfo.CardType != MMC_CARD) {
 352     MmcHostInstance->CardInfo.RCA = Response[0] >> 16;
 353   } else {
 354     MmcHostInstance->CardInfo.RCA = CmdArg;
 355   }
 356
 357   Status = MmcNotifyState (MmcHostInstance, MmcStandByState);
 358   if (EFI_ERROR(Status)) {
 359     DEBUG((EFI_D_ERROR, "MmcIdentificationMode() : Error MmcStandByState\n"));
 360     return Status;
 361   }
 362
 363   return EFI_SUCCESS;
 364 }
 365
 366 EFI_STATUS
 367 EFIAPI
 368 MmcReset (
 369   IN EFI_BLOCK_IO_PROTOCOL    *This,
 370   IN BOOLEAN                  ExtendedVerification
 371   )
 372 {
 373   MMC_HOST_INSTANCE       *MmcHostInstance;
 374
 375   MmcHostInstance = MMC_HOST_INSTANCE_FROM_BLOCK_IO_THIS(This);
 376
 377   if (MmcHostInstance->MmcHost == NULL) {
 378     // Nothing to do
 379     return EFI_SUCCESS;
 380   }
 381
 382   // If a card is not present then clear all media settings
 383   if (!MmcHostInstance->MmcHost->IsCardPresent()) {
 384     MmcHostInstance->BlockIo.Media->MediaPresent = FALSE;
 385     MmcHostInstance->BlockIo.Media->LastBlock    = 0;
 386     MmcHostInstance->BlockIo.Media->BlockSize    = 512;  // Should be zero but there is a bug in DiskIo
 387     MmcHostInstance->BlockIo.Media->ReadOnly     = FALSE;
 388
 389     // Indicate that the driver requires initialization
 390     MmcHostInstance->State = MmcHwInitializationState;
 391
 392     return EFI_SUCCESS;
 393   }
 394
 395   // Implement me. Either send a CMD0 (could not work for some MMC host) or just turn off/turn
 396   //      on power and restart Identification mode
 397   return EFI_SUCCESS;
 398 }
 399
 400 EFI_STATUS
 401 MmcDetectCard (
 402   EFI_MMC_HOST_PROTOCOL     *MmcHost
 403   )
 404 {
 405   if (!MmcHost->IsCardPresent()) {
 406     return EFI_NO_MEDIA;
 407   } else {
 408     return EFI_SUCCESS;
 409   }
 410 }
 411
 412 #define MMCI0_BLOCKLEN 512
 413 #define MMCI0_TIMEOUT  10000
 414
 415 EFI_STATUS
 416 MmcIoBlocks (
 417   IN EFI_BLOCK_IO_PROTOCOL    *This,
 418   IN UINTN                    Transfer,
 419   IN UINT32                   MediaId,
 420   IN EFI_LBA                  Lba,
 421   IN UINTN                    BufferSize,
 422   OUT VOID                    *Buffer
 423   )
 424 {
 425   UINT32                  Response[4];
 426   EFI_STATUS              Status;
 427   UINTN                   CardSize, NumBlocks, BlockSize, CmdArg;
 428   INTN                    Timeout;
 429   UINTN                   Cmd;
 430   MMC_HOST_INSTANCE       *MmcHostInstance;
 431   EFI_MMC_HOST_PROTOCOL   *MmcHost;
 432   UINTN                   BytesRemainingToBeTransfered;
 433   UINTN                   BlockCount = 1;
 434
 435   MmcHostInstance = MMC_HOST_INSTANCE_FROM_BLOCK_IO_THIS(This);
 436   ASSERT(MmcHostInstance != 0);
 437   MmcHost = MmcHostInstance->MmcHost;
 438   ASSERT(MmcHost);
 439
 440   if ((MmcHost == 0)|| (Buffer == NULL)) {
 441     return EFI_INVALID_PARAMETER;
 442   }
 443
 444   // Check if a Card is Present
 445   if (!MmcHostInstance->BlockIo.Media->MediaPresent) {
 446     return EFI_NO_MEDIA;
 447   }
 448
 449   // If the driver has not been initialized yet then go into Identification Mode
 450   if (MmcHostInstance->State == MmcHwInitializationState) {
 451     MmcIdentificationMode (MmcHostInstance);
 452
 453     //Send a command to get Card specific data
 454     CmdArg = MmcHostInstance->CardInfo.RCA << 16;
 455     Status = MmcHost->SendCommand(MMC_CMD9, CmdArg);
 456     if (EFI_ERROR(Status)) {
 457       DEBUG((EFI_D_ERROR, "MmcIdentificationMode(MMC_CMD9): Error, Status=%r\n", Status));
 458       ASSERT(0);
 459       return Status;
 460     }
 461     //Read Response
 462     MmcHost->ReceiveResponse(MMC_RESPONSE_TYPE_CSD,Response);
 463     PrintCSD(Response);
 464
 465     if (MmcHostInstance->CardInfo.CardType == SD_CARD_2_HIGH) {
 466       CardSize = HC_MMC_CSD_GET_DEVICESIZE(Response);
 467       NumBlocks = ((CardSize + 1) * 1024);
 468       BlockSize = 1 << MMC_CSD_GET_READBLLEN(Response);
 469     } else {
 470       CardSize = MMC_CSD_GET_DEVICESIZE(Response);
 471       NumBlocks = (CardSize + 1) * (1 << (MMC_CSD_GET_DEVICESIZEMULT(Response) + 2));
 472       BlockSize = 1 << MMC_CSD_GET_READBLLEN(Response);
 473     }
 474
 475     //For >=2G card, BlockSize may be 1K, but the transfer size is 512 bytes.
 476     if (BlockSize > 512) {
 477       NumBlocks = MultU64x32(NumBlocks, BlockSize/512);
 478       BlockSize = 512;
 479     }
 480
 481     MmcHostInstance->BlockIo.Media->LastBlock    = (NumBlocks - 1);
 482     MmcHostInstance->BlockIo.Media->BlockSize    = BlockSize;
 483     MmcHostInstance->BlockIo.Media->ReadOnly     = MmcHost->IsReadOnly();
 484     MmcHostInstance->BlockIo.Media->MediaPresent = TRUE;
 485     MmcHostInstance->BlockIo.Media->MediaId++;
 486
 487     CmdArg = MmcHostInstance->CardInfo.RCA << 16;
 488     Status = MmcHost->SendCommand(MMC_CMD7, CmdArg);
 489     if (EFI_ERROR(Status)) {
 490       DEBUG((EFI_D_ERROR, "MmcIdentificationMode(MMC_CMD7): Error and Status = %r\n", Status));
 491       ASSERT(0);
 492       return Status;
 493     }
 494
 495     Status = MmcNotifyState (MmcHostInstance, MmcTransferState);
 496     if (EFI_ERROR(Status)) {
 497       DEBUG((EFI_D_ERROR, "MmcIdentificationMode() : Error MmcTransferState\n"));
 498       return Status;
 499     }
 500
 501     // Set Block Length
 502     Status = MmcHost->SendCommand(MMC_CMD16, This->Media->BlockSize);
 503     if (EFI_ERROR(Status)) {
 504       DEBUG((EFI_D_ERROR, "MmcIdentificationMode(MMC_CMD16): Error This->Media->BlockSize: %d and Error = %r\n",This->Media->BlockSize, Status));
 505       return Status;
 506     }
 507
 508     // Block Count (not used). Could return an error for SD card
 509     if (MmcHostInstance->CardInfo.CardType == MMC_CARD) {
 510       MmcHost->SendCommand(MMC_CMD23, BlockCount);
 511     }
 512   } else {
 513     // Maybe test if the card has changed to update gMmcMedia information
 514     if (MmcHostInstance->State == MmcTransferState) {
 515       //DEBUG((EFI_D_ERROR, "MmcIdentificationMode() : MmcTransferState\n"));
 516     } else if (MmcHostInstance->State == MmcStandByState) {
 517       DEBUG((EFI_D_ERROR, "MmcIdentificationMode() : MmcStandByState\n"));
 518     } else {
 519       ASSERT(0);
 520     }
 521   }
 522
 523   // All blocks must be within the device
 524   if ((Lba + (BufferSize / This->Media->BlockSize)) > (This->Media->LastBlock + 1)){
 525     ASSERT(0);
 526     return EFI_INVALID_PARAMETER;
 527   }
 528
 529   // The buffer size must not be zero and it must be an exact multiple of the block size
 530   if ((BufferSize == 0) || ((BufferSize % This->Media->BlockSize) != 0)) {
 531     ASSERT(0);
 532     return EFI_BAD_BUFFER_SIZE;
 533   }
 534
 535   if (This->Media->MediaId != MediaId) {
 536     return EFI_MEDIA_CHANGED;
 537   }
 538
 539   if((Transfer == MMC_IOBLOCKS_WRITE) && (This->Media->ReadOnly == TRUE)) {
 540     return EFI_WRITE_PROTECTED;
 541   }
 542
 543   BytesRemainingToBeTransfered = BufferSize;
 544   while (BytesRemainingToBeTransfered > 0) {
 545
 546     // Check if the Card is in Ready status
 547     CmdArg = MmcHostInstance->CardInfo.RCA << 16;
 548     Response[0] = 0;
 549     Timeout = 20;
 550     while(!(Response[0] & MMC_R0_READY_FOR_DATA) && (MMC_R0_CURRENTSTATE(Response) != MMC_R0_STATE_TRAN) && Timeout--) {
 551       Status = MmcHost->SendCommand(MMC_CMD13, CmdArg);
 552       if (!EFI_ERROR(Status)) {
 553         MmcHost->ReceiveResponse(MMC_RESPONSE_TYPE_R1,Response);
 554       }
 555     }
 556
 557     if (0 == Timeout) {
 558       DEBUG((EFI_D_ERROR, "The Card is busy\n"));
 559       return EFI_NOT_READY;
 560     }
 561
 562     //Set command argument based on the card access mode (Byte mode or Block mode)
 563     if (MmcHostInstance->CardInfo.OCRData.AccessMode & BIT1) {
 564       CmdArg = Lba;
 565     } else {
 566       CmdArg = Lba * This->Media->BlockSize;
 567     }
 568
 569     if (Transfer == MMC_IOBLOCKS_READ) {
 570 #ifndef USE_STREAM
 571       // Read a single block
 572       Cmd = MMC_CMD17;
 573 #else
 574       //TODO: Should we support read stream (MMC_CMD11)
 575 #endif
 576     } else {
 577 #ifndef USE_STREAM
 578       // Write a single block
 579       Cmd = MMC_CMD24;
 580 #else
 581       //TODO: Should we support write stream (MMC_CMD20)
 582 #endif
 583     }
 584     Status = MmcHost->SendCommand(Cmd, CmdArg);
 585     if (EFI_ERROR(Status)) {
 586       DEBUG((EFI_D_ERROR, "MmcIdentificationMode(MMC_CMD%d): Error %r\n",Cmd, Status));
 587       return Status;
 588     }
 589
 590     if (Transfer == MMC_IOBLOCKS_READ) {
 591 #ifndef USE_STREAM
 592       // Read one block of Data
 593       Status = MmcHost->ReadBlockData(Lba,This->Media->BlockSize,Buffer);
 594       if (EFI_ERROR(Status)) {
 595         DEBUG((EFI_D_BLKIO, "MmcIdentificationMode(): Error Read Block Data and Status = %r\n", Status));
 596         return Status;
 597       }
 598 #else
 599       //TODO: Read a steam
 600       ASSERT(0);
 601 #endif
 602       Status = MmcNotifyState (MmcHostInstance, MmcProgrammingState);
 603       if (EFI_ERROR(Status)) {
 604         DEBUG((EFI_D_ERROR, "MmcIdentificationMode() : Error MmcProgrammingState\n"));
 605         return Status;
 606       }
 607     } else {
 608 #ifndef USE_STREAM
 609       // Write one block of Data
 610       Status = MmcHost->WriteBlockData(Lba,This->Media->BlockSize,Buffer);
 611       if (EFI_ERROR(Status)) {
 612         DEBUG((EFI_D_BLKIO, "MmcIdentificationMode(): Error Write Block Data and Status = %r\n", Status));
 613         return Status;
 614       }
 615 #else
 616       //TODO: Write a steam
 617       ASSERT(0);
 618 #endif
 619     }
 620
 621     // Command 12 - Stop transmission (ends read)
 622     Status = MmcHost->SendCommand(MMC_CMD12, 0);
 623     if (!EFI_ERROR(Status)) {
 624       MmcHost->ReceiveResponse(MMC_RESPONSE_TYPE_R1b,Response);
 625     }
 626
 627     // Command 13 - Read status and wait for programming to complete (return to tran)
 628     Timeout = MMCI0_TIMEOUT;
 629     CmdArg = MmcHostInstance->CardInfo.RCA << 16;
 630     Response[0] = 0;
 631     while(!(Response[0] & MMC_R0_READY_FOR_DATA) && (MMC_R0_CURRENTSTATE(Response) != MMC_R0_STATE_TRAN) && Timeout--) {
 632       Status = MmcHost->SendCommand(MMC_CMD13, CmdArg);
 633       if (!EFI_ERROR(Status)) {
 634         MmcHost->ReceiveResponse(MMC_RESPONSE_TYPE_R1,Response);
 635       }
 636       NanoSecondDelay(100);
 637       Timeout--;
 638     }
 639
 640     Status = MmcNotifyState (MmcHostInstance, MmcTransferState);
 641     if (EFI_ERROR(Status)) {
 642       DEBUG((EFI_D_ERROR, "MmcIdentificationMode() : Error MmcTransferState\n"));
 643       return Status;
 644     }
 645
 646     BytesRemainingToBeTransfered -= This->Media->BlockSize;
 647     Lba    += BlockCount;
 648     Buffer = (UINT8 *)Buffer + This->Media->BlockSize;
 649   }
 650
 651   return EFI_SUCCESS;
 652 }
 653
 654 EFI_STATUS
 655 EFIAPI
 656 MmcReadBlocks (
 657   IN EFI_BLOCK_IO_PROTOCOL    *This,
 658   IN UINT32                   MediaId,
 659   IN EFI_LBA                  Lba,
 660   IN UINTN                    BufferSize,
 661   OUT VOID                    *Buffer
 662   )
 663 {
 664   return MmcIoBlocks (This, MMC_IOBLOCKS_READ, MediaId, Lba, BufferSize, Buffer);
 665 }
 666
 667 EFI_STATUS
 668 EFIAPI
 669 MmcWriteBlocks (
 670   IN EFI_BLOCK_IO_PROTOCOL    *This,
 671   IN UINT32                   MediaId,
 672   IN EFI_LBA                  Lba,
 673   IN UINTN                    BufferSize,
 674   IN VOID                     *Buffer
 675   )
 676 {
 677   return MmcIoBlocks (This, MMC_IOBLOCKS_WRITE, MediaId, Lba, BufferSize, Buffer);
 678 }
 679
 680 EFI_STATUS
 681 EFIAPI
 682 MmcFlushBlocks (
 683   IN EFI_BLOCK_IO_PROTOCOL  *This
 684   )
 685 {
 686   return EFI_SUCCESS;
 687 }
 688