]> git.proxmox.com Git - mirror_edk2.git/blobdiff - EmbeddedPkg/Universal/MmcDxe/MmcIdentification.c
SD : Updated CMD 6 implememtation.
[mirror_edk2.git] / EmbeddedPkg / Universal / MmcDxe / MmcIdentification.c
old mode 100644 (file)
new mode 100755 (executable)
index decfd54..f661a0c
 *\r
 **/\r
 \r
+#include <Library/BaseMemoryLib.h>\r
+#include <Library/MemoryAllocationLib.h>\r
+#include <Library/TimerLib.h>\r
+\r
 #include "Mmc.h"\r
 \r
 typedef union {\r
@@ -41,6 +45,11 @@ typedef union {
 \r
 #define EMMC_SWITCH_ERROR       (1 << 7)\r
 \r
+#define SD_BUS_WIDTH_1BIT       (1 << 0)\r
+#define SD_BUS_WIDTH_4BIT       (1 << 2)\r
+\r
+#define SD_CCC_SWITCH           (1 << 10)\r
+\r
 #define DEVICE_STATE(x)         (((x) >> 9) & 0xf)\r
 typedef enum _EMMC_DEVICE_STATE {\r
   EMMC_IDLE_STATE = 0,\r
@@ -202,15 +211,19 @@ EmmcIdentificationMode (
   }\r
 \r
   // Fetch ECSD\r
-  Status = Host->SendCommand (Host, MMC_CMD8, RCA);\r
+  MmcHostInstance->CardInfo.ECSDData = AllocatePages (EFI_SIZE_TO_PAGES (sizeof (ECSD)));\r
+  if (MmcHostInstance->CardInfo.ECSDData == NULL) {\r
+    return EFI_OUT_OF_RESOURCES;\r
+  }\r
+  Status = Host->SendCommand (Host, MMC_CMD8, 0);\r
   if (EFI_ERROR (Status)) {\r
     DEBUG ((EFI_D_ERROR, "EmmcIdentificationMode(): ECSD fetch error, Status=%r.\n", Status));\r
   }\r
 \r
-  Status = Host->ReadBlockData (Host, 0, 512, (UINT32 *)&(MmcHostInstance->CardInfo.ECSDData));\r
+  Status = Host->ReadBlockData (Host, 0, 512, (UINT32 *)MmcHostInstance->CardInfo.ECSDData);\r
   if (EFI_ERROR (Status)) {\r
     DEBUG ((EFI_D_ERROR, "EmmcIdentificationMode(): ECSD read error, Status=%r.\n", Status));\r
-    return Status;\r
+    goto FreePageExit;\r
   }\r
 \r
   // Make sure device exiting data mode\r
@@ -218,7 +231,7 @@ EmmcIdentificationMode (
     Status = EmmcGetDeviceState (MmcHostInstance, &State);\r
     if (EFI_ERROR (Status)) {\r
       DEBUG ((EFI_D_ERROR, "EmmcIdentificationMode(): Failed to get device state, Status=%r.\n", Status));\r
-      return Status;\r
+      goto FreePageExit;\r
     }\r
   } while (State == EMMC_DATA_STATE);\r
 \r
@@ -229,12 +242,16 @@ EmmcIdentificationMode (
   Media->LogicalBlocksPerPhysicalBlock = 1;\r
   Media->IoAlign = 4;\r
   // Compute last block using bits [215:212] of the ECSD\r
-  Media->LastBlock = MmcHostInstance->CardInfo.ECSDData.SECTOR_COUNT - 1; // eMMC isn't supposed to report this for\r
+  Media->LastBlock = MmcHostInstance->CardInfo.ECSDData->SECTOR_COUNT - 1; // eMMC isn't supposed to report this for\r
   // Cards <2GB in size, but the model does.\r
 \r
   // Setup card type\r
   MmcHostInstance->CardInfo.CardType = EMMC_CARD;\r
   return EFI_SUCCESS;\r
+\r
+FreePageExit:\r
+  FreePages (MmcHostInstance->CardInfo.ECSDData, EFI_SIZE_TO_PAGES (sizeof (ECSD)));\r
+  return Status;\r
 }\r
 \r
 STATIC\r
@@ -246,11 +263,11 @@ InitializeEmmcDevice (
   EFI_MMC_HOST_PROTOCOL *Host;\r
   EFI_STATUS Status = EFI_SUCCESS;\r
   ECSD       *ECSDData;\r
-  UINT32     BusClockFreq, Idx;\r
+  UINT32     BusClockFreq, Idx, BusMode;\r
   UINT32     TimingMode[4] = {EMMCHS52DDR1V2, EMMCHS52DDR1V8, EMMCHS52, EMMCHS26};\r
 \r
   Host  = MmcHostInstance->MmcHost;\r
-  ECSDData = &MmcHostInstance->CardInfo.ECSDData;\r
+  ECSDData = MmcHostInstance->CardInfo.ECSDData;\r
   if (ECSDData->DEVICE_TYPE == EMMCBACKWARD)\r
     return EFI_SUCCESS;\r
 \r
@@ -278,7 +295,19 @@ InitializeEmmcDevice (
     }\r
     Status = Host->SetIos (Host, BusClockFreq, 8, TimingMode[Idx]);\r
     if (!EFI_ERROR (Status)) {\r
-      Status = EmmcSetEXTCSD (MmcHostInstance, EXTCSD_BUS_WIDTH, EMMC_BUS_WIDTH_DDR_8BIT);\r
+      switch (TimingMode[Idx]) {\r
+      case EMMCHS52DDR1V2:\r
+      case EMMCHS52DDR1V8:\r
+        BusMode = EMMC_BUS_WIDTH_DDR_8BIT;\r
+        break;\r
+      case EMMCHS52:\r
+      case EMMCHS26:\r
+        BusMode = EMMC_BUS_WIDTH_8BIT;\r
+        break;\r
+      default:\r
+        return EFI_UNSUPPORTED;\r
+      }\r
+      Status = EmmcSetEXTCSD (MmcHostInstance, EXTCSD_BUS_WIDTH, BusMode);\r
       if (EFI_ERROR (Status)) {\r
         DEBUG ((DEBUG_ERROR, "InitializeEmmcDevice(): Failed to set EXTCSD bus width, Status:%r\n", Status));\r
       }\r
@@ -288,6 +317,23 @@ InitializeEmmcDevice (
   return Status;\r
 }\r
 \r
+STATIC\r
+UINT32\r
+CreateSwitchCmdArgument (\r
+  IN  UINT32 Mode,\r
+  IN  UINT8  Group,\r
+  IN  UINT8  Value\r
+  )\r
+{\r
+  UINT32 Argument;\r
+\r
+  Argument = Mode << 31 | 0x00FFFFFF;\r
+  Argument &= ~(0xF << (Group * 4));\r
+  Argument |= Value << (Group * 4);\r
+\r
+  return Argument;\r
+}\r
+\r
 STATIC\r
 EFI_STATUS\r
 InitializeSdMmcDevice (\r
@@ -296,12 +342,17 @@ InitializeSdMmcDevice (
 {\r
   UINT32        CmdArg;\r
   UINT32        Response[4];\r
+  UINT32        Buffer[128];\r
+  UINT32        Speed;\r
   UINTN         BlockSize;\r
   UINTN         CardSize;\r
   UINTN         NumBlocks;\r
+  BOOLEAN       CccSwitch;\r
+  SCR           Scr;\r
   EFI_STATUS    Status;\r
   EFI_MMC_HOST_PROTOCOL     *MmcHost;\r
 \r
+  Speed = SD_DEFAULT_SPEED;\r
   MmcHost = MmcHostInstance->MmcHost;\r
 \r
   // Send a command to get Card specific data\r
@@ -319,6 +370,11 @@ InitializeSdMmcDevice (
     return Status;\r
   }\r
   PrintCSD (Response);\r
+  if (MMC_CSD_GET_CCC(Response) & SD_CCC_SWITCH) {\r
+    CccSwitch = TRUE;\r
+  } else {\r
+    CccSwitch = FALSE;\r
+  }\r
 \r
   if (MmcHostInstance->CardInfo.CardType == SD_CARD_2_HIGH) {\r
     CardSize = HC_MMC_CSD_GET_DEVICESIZE (Response);\r
@@ -349,6 +405,120 @@ InitializeSdMmcDevice (
     return Status;\r
   }\r
 \r
+  Status = MmcHost->SendCommand (MmcHost, MMC_CMD55, CmdArg);\r
+  if (EFI_ERROR (Status)) {\r
+    DEBUG ((DEBUG_ERROR, "%a (MMC_CMD55): Error and Status = %r\n", __FUNCTION__, Status));\r
+    return Status;\r
+  }\r
+  Status = MmcHost->ReceiveResponse (MmcHost, MMC_RESPONSE_TYPE_R1, Response);\r
+  if (EFI_ERROR (Status)) {\r
+    DEBUG ((DEBUG_ERROR, "%a (MMC_CMD55): Error and Status = %r\n", __FUNCTION__, Status));\r
+    return Status;\r
+  }\r
+  if ((Response[0] & MMC_STATUS_APP_CMD) == 0) {\r
+    return EFI_SUCCESS;\r
+  }\r
+\r
+  /* SCR */\r
+  Status = MmcHost->SendCommand (MmcHost, MMC_ACMD51, 0);\r
+  if (EFI_ERROR (Status)) {\r
+    DEBUG ((EFI_D_ERROR, "%a(MMC_ACMD51): Error and Status = %r\n", __func__, Status));\r
+    return Status;\r
+  } else {\r
+    Status = MmcHost->ReadBlockData (MmcHost, 0, 8, Buffer);\r
+    if (EFI_ERROR (Status)) {\r
+      DEBUG ((EFI_D_ERROR, "%a(MMC_ACMD51): ReadBlockData Error and Status = %r\n", __func__, Status));\r
+      return Status;\r
+    }\r
+    CopyMem (&Scr, Buffer, 8);\r
+    if (Scr.SD_SPEC == 2) {\r
+      if (Scr.SD_SPEC3 == 1) {\r
+       if (Scr.SD_SPEC4 == 1) {\r
+          DEBUG ((EFI_D_INFO, "Found SD Card for Spec Version 4.xx\n"));\r
+       } else {\r
+          DEBUG ((EFI_D_INFO, "Found SD Card for Spec Version 3.0x\n"));\r
+       }\r
+      } else {\r
+       if (Scr.SD_SPEC4 == 0) {\r
+          DEBUG ((EFI_D_INFO, "Found SD Card for Spec Version 2.0\n"));\r
+       } else {\r
+         DEBUG ((EFI_D_ERROR, "Found invalid SD Card\n"));\r
+       }\r
+      }\r
+    } else {\r
+      if ((Scr.SD_SPEC3 == 0) && (Scr.SD_SPEC4 == 0)) {\r
+        if (Scr.SD_SPEC == 1) {\r
+         DEBUG ((EFI_D_INFO, "Found SD Card for Spec Version 1.10\n"));\r
+       } else {\r
+         DEBUG ((EFI_D_INFO, "Found SD Card for Spec Version 1.0\n"));\r
+       }\r
+      } else {\r
+        DEBUG ((EFI_D_ERROR, "Found invalid SD Card\n"));\r
+      }\r
+    }\r
+  }\r
+  if (CccSwitch) {\r
+    /* SD Switch, Mode:0, Group:0, Value:0 */\r
+    CmdArg = CreateSwitchCmdArgument(0, 0, 0);\r
+    Status = MmcHost->SendCommand (MmcHost, MMC_CMD6, CmdArg);\r
+    if (EFI_ERROR (Status)) {\r
+      DEBUG ((DEBUG_ERROR, "%a (MMC_CMD6): Error and Status = %r\n", __FUNCTION__, Status));\r
+       return Status;\r
+    } else {\r
+      Status = MmcHost->ReadBlockData (MmcHost, 0, SWITCH_CMD_DATA_LENGTH, Buffer);\r
+      if (EFI_ERROR (Status)) {\r
+        DEBUG ((DEBUG_ERROR, "%a (MMC_CMD6): ReadBlockData Error and Status = %r\n", __FUNCTION__, Status));\r
+        return Status;\r
+      }\r
+    }\r
+\r
+    if (!(Buffer[3] & SD_HIGH_SPEED_SUPPORTED)) {\r
+      DEBUG ((DEBUG_ERROR, "%a : High Speed not supported by Card %r\n", __FUNCTION__, Status));\r
+      return Status;\r
+    }\r
+\r
+    Speed = SD_HIGH_SPEED;\r
+\r
+    /* SD Switch, Mode:1, Group:0, Value:1 */\r
+    CmdArg = CreateSwitchCmdArgument(1, 0, 1);\r
+    Status = MmcHost->SendCommand (MmcHost, MMC_CMD6, CmdArg);\r
+    if (EFI_ERROR (Status)) {\r
+      DEBUG ((DEBUG_ERROR, "%a (MMC_CMD6): Error and Status = %r\n", __FUNCTION__, Status));\r
+       return Status;\r
+    } else {\r
+      Status = MmcHost->ReadBlockData (MmcHost, 0, SWITCH_CMD_DATA_LENGTH, Buffer);\r
+      if (EFI_ERROR (Status)) {\r
+        DEBUG ((DEBUG_ERROR, "%a (MMC_CMD6): ReadBlockData Error and Status = %r\n", __FUNCTION__, Status));\r
+        return Status;\r
+      }\r
+\r
+      if ((Buffer[4] & SWITCH_CMD_SUCCESS_MASK) != 0x01000000) {\r
+        DEBUG((DEBUG_ERROR, "Problem switching SD card into high-speed mode\n"));\r
+        return Status;\r
+      }\r
+    }\r
+  }\r
+  if (Scr.SD_BUS_WIDTHS & SD_BUS_WIDTH_4BIT) {\r
+    CmdArg = MmcHostInstance->CardInfo.RCA << 16;\r
+    Status = MmcHost->SendCommand (MmcHost, MMC_CMD55, CmdArg);\r
+    if (EFI_ERROR (Status)) {\r
+      DEBUG ((DEBUG_ERROR, "%a (MMC_CMD55): Error and Status = %r\n", __FUNCTION__, Status));\r
+      return Status;\r
+    }\r
+    /* Width: 4 */\r
+    Status = MmcHost->SendCommand (MmcHost, MMC_CMD6, 2);\r
+    if (EFI_ERROR (Status)) {\r
+      DEBUG ((DEBUG_ERROR, "%a (MMC_CMD6): Error and Status = %r\n", __FUNCTION__, Status));\r
+      return Status;\r
+    }\r
+  }\r
+  if (MMC_HOST_HAS_SETIOS(MmcHost)) {\r
+    Status = MmcHost->SetIos (MmcHost, Speed, BUSWIDTH_4, EMMCBACKWARD);\r
+    if (EFI_ERROR (Status)) {\r
+      DEBUG ((DEBUG_ERROR, "%a (SetIos): Error and Status = %r\n", __FUNCTION__, Status));\r
+      return Status;\r
+    }\r
+  }\r
   return EFI_SUCCESS;\r
 }\r
 \r