]> git.proxmox.com Git - mirror_edk2.git/blobdiff - EmbeddedPkg/Universal/MmcDxe/MmcBlockIo.c
EmbeddedPkg/MmcDxe: Update Mmc code to conform to coding standard
[mirror_edk2.git] / EmbeddedPkg / Universal / MmcDxe / MmcBlockIo.c
index ede8f20fe46b71af65288087ac614ee5b5e8c095..57fa14e42e43b6e9e65828b3a393fe961818f7cb 100644 (file)
@@ -1,14 +1,14 @@
 /** @file\r
 *\r
-*  Copyright (c) 2011-2012, 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
+*  Copyright (c) 2011-2013, ARM Limited. All rights reserved.\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
+*  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
@@ -19,9 +19,6 @@
 \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
@@ -40,36 +37,36 @@ PrintOCR (
   IN UINT32 Ocr\r
   )\r
 {\r
-  UINTN minv;\r
-  UINTN maxv;\r
-  UINTN volts;\r
-  UINTN loop;\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
+  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
+  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
+    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
+  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
+    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
+    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
+    DEBUG ((EFI_D_ERROR, "\t- PowerUp\n"));\r
   } else {\r
-    DEBUG((EFI_D_ERROR, "\t- Voltage Not Supported\n"));\r
+    DEBUG ((EFI_D_ERROR, "\t- Voltage Not Supported\n"));\r
   }\r
 }\r
 \r
@@ -77,17 +74,19 @@ VOID PrintCID (
   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
+  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","Unkbown","Unkbown","Unkbown","Unkbown" };\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","Unknown","Unknown","Unknown","Unknown" };\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
@@ -98,26 +97,26 @@ PrintCSD (
   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
+    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
+    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
+    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
+  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
+  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
+    DEBUG ((EFI_D_ERROR, "\t- Format: Reserved\n"));\r
   }\r
 }\r
 \r
@@ -126,9 +125,9 @@ PrintRCA (
   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
+  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
@@ -136,24 +135,26 @@ PrintResponseR1 (
   IN  UINT32 Response\r
   )\r
 {\r
-  DEBUG((EFI_D_INFO, "Response: 0x%X\n",Response));\r
-  if (Response & MMC_R0_READY_FOR_DATA)     DEBUG((EFI_D_INFO, "\t- READY_FOR_DATA\n"));\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
+  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
+MmcGetCardStatus (\r
        IN MMC_HOST_INSTANCE     *MmcHostInstance\r
   )\r
 {\r
@@ -169,18 +170,18 @@ MmcGetCardStatus(
   if (MmcHost == NULL) {\r
     return EFI_INVALID_PARAMETER;\r
   }\r
-  if(MmcHostInstance->State != MmcHwInitializationState){\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
+    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
+    MmcHost->ReceiveResponse (MmcHost, MMC_RESPONSE_TYPE_R1, Response);\r
+    PrintResponseR1 (Response[0]);\r
   }\r
 \r
   return Status;\r
@@ -211,29 +212,28 @@ MmcIdentificationMode (
   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
-  } else {\r
-    //Note: Could even be used in all cases. But it looks this command could put the state machine into inactive for some cards\r
-    Status = MmcHost->SendCommand (MmcHost, MMC_CMD0, 0);\r
-    if (EFI_ERROR(Status)) {\r
-      DEBUG((EFI_D_ERROR, "MmcIdentificationMode(MMC_CMD0): Error\n"));\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
+  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
+    DEBUG ((EFI_D_ERROR, "MmcIdentificationMode(MMC_CMD5): Error - SDIO not supported.\n"));\r
     return EFI_UNSUPPORTED;\r
   }\r
 \r
@@ -243,10 +243,10 @@ MmcIdentificationMode (
   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
+    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
+    if (Response[0] != CmdArg) {\r
       DEBUG ((EFI_D_ERROR, "The Card is not usable\n"));\r
       return EFI_UNSUPPORTED;\r
     }\r
@@ -260,75 +260,75 @@ MmcIdentificationMode (
     // 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
+      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
+      // 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
+      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
+      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 (!EFI_ERROR (Status)) {\r
       if (!MmcHostInstance->CardInfo.OCRData.PowerUp) {\r
-          MicroSecondDelay(1);\r
-          Timeout--;\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
+        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
+      MicroSecondDelay (1);\r
       Timeout--;\r
     }\r
   }\r
 \r
   if (Timeout == 0) {\r
-    DEBUG((EFI_D_ERROR, "MmcIdentificationMode(): No Card\n"));\r
+    DEBUG ((EFI_D_ERROR, "MmcIdentificationMode(): No Card\n"));\r
     return EFI_NO_MEDIA;\r
   } else {\r
-    PrintOCR(Response[0]);\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
+  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
+  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
+  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
+  if (EFI_ERROR (Status)) {\r
+    DEBUG ((EFI_D_ERROR, "MmcIdentificationMode() : Error MmcIdentificationState\n"));\r
     return Status;\r
   }\r
 \r
@@ -339,13 +339,13 @@ MmcIdentificationMode (
   //\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
+  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
+  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
@@ -355,8 +355,8 @@ MmcIdentificationMode (
   }\r
 \r
   Status = MmcNotifyState (MmcHostInstance, MmcStandByState);\r
-  if (EFI_ERROR(Status)) {\r
-    DEBUG((EFI_D_ERROR, "MmcIdentificationMode() : Error MmcStandByState\n"));\r
+  if (EFI_ERROR (Status)) {\r
+    DEBUG ((EFI_D_ERROR, "MmcIdentificationMode() : Error MmcStandByState\n"));\r
     return Status;\r
   }\r
 \r
@@ -371,8 +371,9 @@ EFI_STATUS InitializeMmcDevice (
   EFI_STATUS              Status;\r
   UINTN                   CardSize, NumBlocks, BlockSize, CmdArg;\r
   EFI_MMC_HOST_PROTOCOL   *MmcHost;\r
-  UINTN                   BlockCount = 1;\r
-  \r
+  UINTN                   BlockCount;\r
+\r
+  BlockCount = 1;\r
   MmcHost = MmcHostInstance->MmcHost;\r
 \r
   MmcIdentificationMode (MmcHostInstance);\r
@@ -380,27 +381,27 @@ EFI_STATUS InitializeMmcDevice (
   //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
+  if (EFI_ERROR (Status)) {\r
+    DEBUG((EFI_D_ERROR, "InitializeMmcDevice(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
+  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
+    CardSize = HC_MMC_CSD_GET_DEVICESIZE (Response);\r
     NumBlocks = ((CardSize + 1) * 1024);\r
-    BlockSize = 1 << MMC_CSD_GET_READBLLEN(Response);\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
+    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
+    NumBlocks = MultU64x32 (NumBlocks, BlockSize/512);\r
     BlockSize = 512;\r
   }\r
 \r
@@ -412,21 +413,22 @@ EFI_STATUS InitializeMmcDevice (
 \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
+  if (EFI_ERROR (Status)) {\r
+    DEBUG((EFI_D_ERROR, "InitializeMmcDevice(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
+  if (EFI_ERROR (Status)) {\r
+    DEBUG((EFI_D_ERROR, "InitializeMmcDevice(): 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
+  if (EFI_ERROR (Status)) {\r
+    DEBUG((EFI_D_ERROR, "InitializeMmcDevice(MMC_CMD16): Error MmcHostInstance->BlockIo.Media->BlockSize: %d and Error = %r\n",\r
+                        MmcHostInstance->BlockIo.Media->BlockSize, Status));\r
     return Status;\r
   }\r
 \r
@@ -447,7 +449,7 @@ MmcReset (
 {\r
   MMC_HOST_INSTANCE       *MmcHostInstance;\r
 \r
-  MmcHostInstance = MMC_HOST_INSTANCE_FROM_BLOCK_IO_THIS(This);\r
+  MmcHostInstance = MMC_HOST_INSTANCE_FROM_BLOCK_IO_THIS (This);\r
 \r
   if (MmcHostInstance->MmcHost == NULL) {\r
     // Nothing to do\r
@@ -505,14 +507,19 @@ MmcIoBlocks (
   MMC_HOST_INSTANCE       *MmcHostInstance;\r
   EFI_MMC_HOST_PROTOCOL   *MmcHost;\r
   UINTN                   BytesRemainingToBeTransfered;\r
-  UINTN                   BlockCount = 1;\r
+  UINTN                   BlockCount;\r
 \r
-  MmcHostInstance = MMC_HOST_INSTANCE_FROM_BLOCK_IO_THIS(This);\r
-  ASSERT(MmcHostInstance != 0);\r
+  BlockCount = 1;\r
+  MmcHostInstance = MMC_HOST_INSTANCE_FROM_BLOCK_IO_THIS (This);\r
+  ASSERT (MmcHostInstance != NULL);\r
   MmcHost = MmcHostInstance->MmcHost;\r
-  ASSERT(MmcHost);\r
+  ASSERT (MmcHost);\r
+\r
+  if (This->Media->MediaId != MediaId) {\r
+    return EFI_MEDIA_CHANGED;\r
+  }\r
 \r
-  if ((MmcHost == 0)|| (Buffer == NULL)) {\r
+  if ((MmcHost == NULL) || (Buffer == NULL)) {\r
     return EFI_INVALID_PARAMETER;\r
   }\r
 \r
@@ -522,21 +529,27 @@ MmcIoBlocks (
   }\r
 \r
   // All blocks must be within the device\r
-  if ((Lba + (BufferSize / This->Media->BlockSize)) > (This->Media->LastBlock + 1)){\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
+  if ((Transfer == MMC_IOBLOCKS_WRITE) && (This->Media->ReadOnly == TRUE)) {\r
+    return EFI_WRITE_PROTECTED;\r
   }\r
 \r
-  if (This->Media->MediaId != MediaId) {\r
-    return EFI_MEDIA_CHANGED;\r
+  // Reading 0 Byte is valid\r
+  if (BufferSize == 0) {\r
+    return EFI_SUCCESS;\r
   }\r
 \r
-  if((Transfer == MMC_IOBLOCKS_WRITE) && (This->Media->ReadOnly == TRUE)) {\r
-    return EFI_WRITE_PROTECTED;\r
+  // The buffer size must be an exact multiple of the block size\r
+  if ((BufferSize % This->Media->BlockSize) != 0) {\r
+    return EFI_BAD_BUFFER_SIZE;\r
+  }\r
+\r
+  // Check the alignment\r
+  if ((This->Media->IoAlign > 2) && (((UINTN)Buffer & (This->Media->IoAlign - 1)) != 0)) {\r
+    return EFI_INVALID_PARAMETER;\r
   }\r
 \r
   BytesRemainingToBeTransfered = BufferSize;\r
@@ -547,16 +560,16 @@ MmcIoBlocks (
     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
+          && (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 (!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
+      DEBUG ((EFI_D_ERROR, "The Card is busy\n"));\r
       return EFI_NOT_READY;\r
     }\r
 \r
@@ -568,61 +581,43 @@ MmcIoBlocks (
     }\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
+    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
+      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
+      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
+      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
+    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
@@ -630,22 +625,21 @@ MmcIoBlocks (
     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
+          && (MMC_R0_CURRENTSTATE (Response) != MMC_R0_STATE_TRAN)\r
           && Timeout--) {\r
       Status = MmcHost->SendCommand (MmcHost, MMC_CMD13, CmdArg);\r
-      if (!EFI_ERROR(Status)) {\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
-      Timeout--;\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
+    if (EFI_ERROR (Status)) {\r
+      DEBUG ((EFI_D_ERROR, "MmcIoBlocks() : Error MmcTransferState\n"));\r
       return Status;\r
     }\r
 \r
@@ -691,4 +685,3 @@ MmcFlushBlocks (
 {\r
   return EFI_SUCCESS;\r
 }\r
-\r