EmbeddedPkg/MmcDxe: invoke SetIos() protocol method to set speed and width

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

diff --git a/EmbeddedPkg/Universal/MmcDxe/MmcIdentification.c b/EmbeddedPkg/Universal/MmcDxe/MmcIdentification.c
index 9aefb264a87df6e1b5d2c8cdcb7f93faa5425246..decfd543cc2c4938d21d942732d333de9212ef00 100644 (file)
--- a/EmbeddedPkg/Universal/MmcDxe/MmcIdentification.c
+++ b/EmbeddedPkg/Universal/MmcDxe/MmcIdentification.c
@@ -25,8 +25,108 @@ typedef union {
 #define EMMC_CARD_SIZE          512\r
 #define EMMC_ECSD_SIZE_OFFSET   53\r
 \r
 #define EMMC_CARD_SIZE          512\r
 #define EMMC_ECSD_SIZE_OFFSET   53\r
 \r

+#define EXTCSD_BUS_WIDTH        183\r
+#define EXTCSD_HS_TIMING        185\r
+\r
+#define EMMC_TIMING_BACKWARD    0\r
+#define EMMC_TIMING_HS          1\r
+#define EMMC_TIMING_HS200       2\r
+#define EMMC_TIMING_HS400       3\r
+\r
+#define EMMC_BUS_WIDTH_1BIT     0\r
+#define EMMC_BUS_WIDTH_4BIT     1\r
+#define EMMC_BUS_WIDTH_8BIT     2\r
+#define EMMC_BUS_WIDTH_DDR_4BIT 5\r
+#define EMMC_BUS_WIDTH_DDR_8BIT 6\r
+\r
+#define EMMC_SWITCH_ERROR       (1 << 7)\r
+\r
+#define DEVICE_STATE(x)         (((x) >> 9) & 0xf)\r
+typedef enum _EMMC_DEVICE_STATE {\r
+  EMMC_IDLE_STATE = 0,\r
+  EMMC_READY_STATE,\r
+  EMMC_IDENT_STATE,\r
+  EMMC_STBY_STATE,\r
+  EMMC_TRAN_STATE,\r
+  EMMC_DATA_STATE,\r
+  EMMC_RCV_STATE,\r
+  EMMC_PRG_STATE,\r
+  EMMC_DIS_STATE,\r
+  EMMC_BTST_STATE,\r
+  EMMC_SLP_STATE\r
+} EMMC_DEVICE_STATE;\r
+\r

 UINT32 mEmmcRcaCount = 0;\r
 \r
 UINT32 mEmmcRcaCount = 0;\r
 \r

+STATIC\r
+EFI_STATUS\r
+EFIAPI\r
+EmmcGetDeviceState (\r
+  IN  MMC_HOST_INSTANCE    *MmcHostInstance,\r
+  OUT EMMC_DEVICE_STATE    *State\r
+  )\r
+{\r
+  EFI_MMC_HOST_PROTOCOL *Host;\r
+  EFI_STATUS Status;\r
+  UINT32     Data, RCA;\r
+\r
+  if (State == NULL) {\r
+    return EFI_INVALID_PARAMETER;\r
+  }\r
+\r
+  Host = MmcHostInstance->MmcHost;\r
+  RCA = MmcHostInstance->CardInfo.RCA << RCA_SHIFT_OFFSET;\r
+  Status = Host->SendCommand (Host, MMC_CMD13, RCA);\r
+  if (EFI_ERROR (Status)) {\r
+    DEBUG ((EFI_D_ERROR, "EmmcGetDeviceState(): Failed to get card status, Status=%r.\n", Status));\r
+    return Status;\r
+  }\r
+  Status = Host->ReceiveResponse (Host, MMC_RESPONSE_TYPE_R1, &Data);\r
+  if (EFI_ERROR (Status)) {\r
+    DEBUG ((EFI_D_ERROR, "EmmcGetDeviceState(): Failed to get response of CMD13, Status=%r.\n", Status));\r
+    return Status;\r
+  }\r
+  if (Data & EMMC_SWITCH_ERROR) {\r
+    DEBUG ((EFI_D_ERROR, "EmmcGetDeviceState(): Failed to switch expected mode, Status=%r.\n", Status));\r
+    return EFI_DEVICE_ERROR;\r
+  }\r
+  *State = DEVICE_STATE(Data);\r
+  return EFI_SUCCESS;\r
+}\r
+\r
+STATIC\r
+EFI_STATUS\r
+EFIAPI\r
+EmmcSetEXTCSD (\r
+  IN MMC_HOST_INSTANCE     *MmcHostInstance,\r
+  UINT32                   ExtCmdIndex,\r
+  UINT32                   Value\r
+  )\r
+{\r
+  EFI_MMC_HOST_PROTOCOL *Host;\r
+  EMMC_DEVICE_STATE     State;\r
+  EFI_STATUS Status;\r
+  UINT32     Argument;\r
+\r
+  Host  = MmcHostInstance->MmcHost;\r
+  Argument = EMMC_CMD6_ARG_ACCESS(3) | EMMC_CMD6_ARG_INDEX(ExtCmdIndex) |\r
+             EMMC_CMD6_ARG_VALUE(Value) | EMMC_CMD6_ARG_CMD_SET(1);\r
+  Status = Host->SendCommand (Host, MMC_CMD6, Argument);\r
+  if (EFI_ERROR (Status)) {\r
+    DEBUG ((EFI_D_ERROR, "EmmcSetEXTCSD(): Failed to send CMD6, Status=%r.\n", Status));\r
+    return Status;\r
+  }\r
+  // Make sure device exiting prog mode\r
+  do {\r
+    Status = EmmcGetDeviceState (MmcHostInstance, &State);\r
+    if (EFI_ERROR (Status)) {\r
+      DEBUG ((EFI_D_ERROR, "EmmcSetEXTCSD(): Failed to get device state, Status=%r.\n", Status));\r
+      return Status;\r
+    }\r
+  } while (State == EMMC_PRG_STATE);\r
+  return EFI_SUCCESS;\r
+}\r
+\r

 STATIC\r
 EFI_STATUS\r
 EFIAPI\r
 STATIC\r
 EFI_STATUS\r
 EFIAPI\r


@@ -38,6 +138,7 @@ EmmcIdentificationMode (
   EFI_MMC_HOST_PROTOCOL *Host;\r
   EFI_BLOCK_IO_MEDIA    *Media;\r
   EFI_STATUS Status;\r
   EFI_MMC_HOST_PROTOCOL *Host;\r
   EFI_BLOCK_IO_MEDIA    *Media;\r
   EFI_STATUS Status;\r

+  EMMC_DEVICE_STATE     State;\r

   UINT32     RCA;\r
 \r
   Host  = MmcHostInstance->MmcHost;\r
   UINT32     RCA;\r
 \r
   Host  = MmcHostInstance->MmcHost;\r


@@ -84,6 +185,22 @@ EmmcIdentificationMode (
     DEBUG ((EFI_D_ERROR, "EmmcIdentificationMode(): Card selection error, Status=%r.\n", Status));\r
   }\r
 \r
     DEBUG ((EFI_D_ERROR, "EmmcIdentificationMode(): Card selection error, Status=%r.\n", Status));\r
   }\r
 \r

+  if (MMC_HOST_HAS_SETIOS(Host)) {\r
+    // Set 1-bit bus width\r
+    Status = Host->SetIos (Host, 0, 1, EMMCBACKWARD);\r
+    if (EFI_ERROR (Status)) {\r
+      DEBUG ((EFI_D_ERROR, "EmmcIdentificationMode(): Set 1-bit bus width error, Status=%r.\n", Status));\r
+      return Status;\r
+    }\r
+\r
+    // Set 1-bit bus width for EXTCSD\r
+    Status = EmmcSetEXTCSD (MmcHostInstance, EXTCSD_BUS_WIDTH, EMMC_BUS_WIDTH_1BIT);\r
+    if (EFI_ERROR (Status)) {\r
+      DEBUG ((EFI_D_ERROR, "EmmcIdentificationMode(): Set extcsd bus width error, Status=%r.\n", Status));\r
+      return Status;\r
+    }\r
+  }\r
+\r

   // Fetch ECSD\r
   Status = Host->SendCommand (Host, MMC_CMD8, RCA);\r
   if (EFI_ERROR (Status)) {\r
   // Fetch ECSD\r
   Status = Host->SendCommand (Host, MMC_CMD8, RCA);\r
   if (EFI_ERROR (Status)) {\r


@@ -96,6 +213,15 @@ EmmcIdentificationMode (
     return Status;\r
   }\r
 \r
     return Status;\r
   }\r
 \r

+  // Make sure device exiting data mode\r
+  do {\r
+    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
+    }\r
+  } while (State == EMMC_DATA_STATE);\r
+\r

   // Set up media\r
   Media->BlockSize = EMMC_CARD_SIZE; // 512-byte support is mandatory for eMMC cards\r
   Media->MediaId = MmcHostInstance->CardInfo.CIDData.PSN;\r
   // Set up media\r
   Media->BlockSize = EMMC_CARD_SIZE; // 512-byte support is mandatory for eMMC cards\r
   Media->MediaId = MmcHostInstance->CardInfo.CIDData.PSN;\r


@@ -111,6 +237,57 @@ EmmcIdentificationMode (
   return EFI_SUCCESS;\r
 }\r
 \r
   return EFI_SUCCESS;\r
 }\r
 \r

+STATIC\r
+EFI_STATUS\r
+InitializeEmmcDevice (\r
+  IN  MMC_HOST_INSTANCE   *MmcHostInstance\r
+  )\r
+{\r
+  EFI_MMC_HOST_PROTOCOL *Host;\r
+  EFI_STATUS Status = EFI_SUCCESS;\r
+  ECSD       *ECSDData;\r
+  UINT32     BusClockFreq, Idx;\r
+  UINT32     TimingMode[4] = {EMMCHS52DDR1V2, EMMCHS52DDR1V8, EMMCHS52, EMMCHS26};\r
+\r
+  Host  = MmcHostInstance->MmcHost;\r
+  ECSDData = &MmcHostInstance->CardInfo.ECSDData;\r
+  if (ECSDData->DEVICE_TYPE == EMMCBACKWARD)\r
+    return EFI_SUCCESS;\r
+\r
+  if (!MMC_HOST_HAS_SETIOS(Host)) {\r
+    return EFI_SUCCESS;\r
+  }\r
+  Status = EmmcSetEXTCSD (MmcHostInstance, EXTCSD_HS_TIMING, EMMC_TIMING_HS);\r
+  if (EFI_ERROR (Status)) {\r
+    DEBUG ((DEBUG_ERROR, "InitializeEmmcDevice(): Failed to switch high speed mode, Status:%r.\n", Status));\r
+    return Status;\r
+  }\r
+\r
+  for (Idx = 0; Idx < 4; Idx++) {\r
+    switch (TimingMode[Idx]) {\r
+    case EMMCHS52DDR1V2:\r
+    case EMMCHS52DDR1V8:\r
+    case EMMCHS52:\r
+      BusClockFreq = 52000000;\r
+      break;\r
+    case EMMCHS26:\r
+      BusClockFreq = 26000000;\r
+      break;\r
+    default:\r
+      return EFI_UNSUPPORTED;\r
+    }\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
+      if (EFI_ERROR (Status)) {\r
+        DEBUG ((DEBUG_ERROR, "InitializeEmmcDevice(): Failed to set EXTCSD bus width, Status:%r\n", Status));\r
+      }\r
+      return Status;\r
+    }\r
+  }\r
+  return Status;\r
+}\r
+\r

 STATIC\r
 EFI_STATUS\r
 InitializeSdMmcDevice (\r
 STATIC\r
 EFI_STATUS\r
 InitializeSdMmcDevice (\r


@@ -431,9 +608,11 @@ InitializeMmcDevice (
 \r
   if (MmcHostInstance->CardInfo.CardType != EMMC_CARD) {\r
     Status = InitializeSdMmcDevice (MmcHostInstance);\r
 \r
   if (MmcHostInstance->CardInfo.CardType != EMMC_CARD) {\r
     Status = InitializeSdMmcDevice (MmcHostInstance);\r

-    if (EFI_ERROR (Status)) {\r
-      return Status;\r
-    }\r
+  } else {\r
+    Status = InitializeEmmcDevice (MmcHostInstance);\r
+  }\r
+  if (EFI_ERROR (Status)) {\r
+    return Status;\r

   }\r
 \r
   // Set Block Length\r
   }\r
 \r
   // Set Block Length\r