EmbeddedPkg: Apply uncrustify changes
REF: https://bugzilla.tianocore.org/show_bug.cgi?id=3737 Apply uncrustify changes to .c/.h files in the EmbeddedPkg package Cc: Andrew Fish <afish@apple.com> Cc: Leif Lindholm <leif@nuviainc.com> Cc: Michael D Kinney <michael.d.kinney@intel.com> Signed-off-by: Michael Kubacki <michael.kubacki@microsoft.com> Reviewed-by: Andrew Fish <afish@apple.com>
This commit is contained in:
committed by
mergify[bot]
parent
731c67e1d7
commit
e7108d0e96
@@ -13,38 +13,38 @@
|
||||
#include "Mmc.h"
|
||||
|
||||
typedef union {
|
||||
UINT32 Raw;
|
||||
OCR Ocr;
|
||||
UINT32 Raw;
|
||||
OCR Ocr;
|
||||
} OCR_RESPONSE;
|
||||
|
||||
#define MAX_RETRY_COUNT 1000
|
||||
#define CMD_RETRY_COUNT 20
|
||||
#define RCA_SHIFT_OFFSET 16
|
||||
#define EMMC_CARD_SIZE 512
|
||||
#define EMMC_ECSD_SIZE_OFFSET 53
|
||||
#define MAX_RETRY_COUNT 1000
|
||||
#define CMD_RETRY_COUNT 20
|
||||
#define RCA_SHIFT_OFFSET 16
|
||||
#define EMMC_CARD_SIZE 512
|
||||
#define EMMC_ECSD_SIZE_OFFSET 53
|
||||
|
||||
#define EXTCSD_BUS_WIDTH 183
|
||||
#define EXTCSD_HS_TIMING 185
|
||||
#define EXTCSD_BUS_WIDTH 183
|
||||
#define EXTCSD_HS_TIMING 185
|
||||
|
||||
#define EMMC_TIMING_BACKWARD 0
|
||||
#define EMMC_TIMING_HS 1
|
||||
#define EMMC_TIMING_HS200 2
|
||||
#define EMMC_TIMING_HS400 3
|
||||
#define EMMC_TIMING_BACKWARD 0
|
||||
#define EMMC_TIMING_HS 1
|
||||
#define EMMC_TIMING_HS200 2
|
||||
#define EMMC_TIMING_HS400 3
|
||||
|
||||
#define EMMC_BUS_WIDTH_1BIT 0
|
||||
#define EMMC_BUS_WIDTH_4BIT 1
|
||||
#define EMMC_BUS_WIDTH_8BIT 2
|
||||
#define EMMC_BUS_WIDTH_DDR_4BIT 5
|
||||
#define EMMC_BUS_WIDTH_DDR_8BIT 6
|
||||
#define EMMC_BUS_WIDTH_1BIT 0
|
||||
#define EMMC_BUS_WIDTH_4BIT 1
|
||||
#define EMMC_BUS_WIDTH_8BIT 2
|
||||
#define EMMC_BUS_WIDTH_DDR_4BIT 5
|
||||
#define EMMC_BUS_WIDTH_DDR_8BIT 6
|
||||
|
||||
#define EMMC_SWITCH_ERROR (1 << 7)
|
||||
#define EMMC_SWITCH_ERROR (1 << 7)
|
||||
|
||||
#define SD_BUS_WIDTH_1BIT (1 << 0)
|
||||
#define SD_BUS_WIDTH_4BIT (1 << 2)
|
||||
#define SD_BUS_WIDTH_1BIT (1 << 0)
|
||||
#define SD_BUS_WIDTH_4BIT (1 << 2)
|
||||
|
||||
#define SD_CCC_SWITCH (1 << 10)
|
||||
#define SD_CCC_SWITCH (1 << 10)
|
||||
|
||||
#define DEVICE_STATE(x) (((x) >> 9) & 0xf)
|
||||
#define DEVICE_STATE(x) (((x) >> 9) & 0xf)
|
||||
typedef enum _EMMC_DEVICE_STATE {
|
||||
EMMC_IDLE_STATE = 0,
|
||||
EMMC_READY_STATE,
|
||||
@@ -59,41 +59,44 @@ typedef enum _EMMC_DEVICE_STATE {
|
||||
EMMC_SLP_STATE
|
||||
} EMMC_DEVICE_STATE;
|
||||
|
||||
UINT32 mEmmcRcaCount = 0;
|
||||
UINT32 mEmmcRcaCount = 0;
|
||||
|
||||
STATIC
|
||||
EFI_STATUS
|
||||
EFIAPI
|
||||
EmmcGetDeviceState (
|
||||
IN MMC_HOST_INSTANCE *MmcHostInstance,
|
||||
OUT EMMC_DEVICE_STATE *State
|
||||
IN MMC_HOST_INSTANCE *MmcHostInstance,
|
||||
OUT EMMC_DEVICE_STATE *State
|
||||
)
|
||||
{
|
||||
EFI_MMC_HOST_PROTOCOL *Host;
|
||||
EFI_STATUS Status;
|
||||
UINT32 Data, RCA;
|
||||
EFI_MMC_HOST_PROTOCOL *Host;
|
||||
EFI_STATUS Status;
|
||||
UINT32 Data, RCA;
|
||||
|
||||
if (State == NULL) {
|
||||
return EFI_INVALID_PARAMETER;
|
||||
}
|
||||
|
||||
Host = MmcHostInstance->MmcHost;
|
||||
RCA = MmcHostInstance->CardInfo.RCA << RCA_SHIFT_OFFSET;
|
||||
Host = MmcHostInstance->MmcHost;
|
||||
RCA = MmcHostInstance->CardInfo.RCA << RCA_SHIFT_OFFSET;
|
||||
Status = Host->SendCommand (Host, MMC_CMD13, RCA);
|
||||
if (EFI_ERROR (Status)) {
|
||||
DEBUG ((DEBUG_ERROR, "EmmcGetDeviceState(): Failed to get card status, Status=%r.\n", Status));
|
||||
return Status;
|
||||
}
|
||||
|
||||
Status = Host->ReceiveResponse (Host, MMC_RESPONSE_TYPE_R1, &Data);
|
||||
if (EFI_ERROR (Status)) {
|
||||
DEBUG ((DEBUG_ERROR, "EmmcGetDeviceState(): Failed to get response of CMD13, Status=%r.\n", Status));
|
||||
return Status;
|
||||
}
|
||||
|
||||
if (Data & EMMC_SWITCH_ERROR) {
|
||||
DEBUG ((DEBUG_ERROR, "EmmcGetDeviceState(): Failed to switch expected mode, Status=%r.\n", Status));
|
||||
return EFI_DEVICE_ERROR;
|
||||
}
|
||||
*State = DEVICE_STATE(Data);
|
||||
|
||||
*State = DEVICE_STATE (Data);
|
||||
return EFI_SUCCESS;
|
||||
}
|
||||
|
||||
@@ -101,24 +104,25 @@ STATIC
|
||||
EFI_STATUS
|
||||
EFIAPI
|
||||
EmmcSetEXTCSD (
|
||||
IN MMC_HOST_INSTANCE *MmcHostInstance,
|
||||
UINT32 ExtCmdIndex,
|
||||
UINT32 Value
|
||||
IN MMC_HOST_INSTANCE *MmcHostInstance,
|
||||
UINT32 ExtCmdIndex,
|
||||
UINT32 Value
|
||||
)
|
||||
{
|
||||
EFI_MMC_HOST_PROTOCOL *Host;
|
||||
EMMC_DEVICE_STATE State;
|
||||
EFI_STATUS Status;
|
||||
UINT32 Argument;
|
||||
EFI_MMC_HOST_PROTOCOL *Host;
|
||||
EMMC_DEVICE_STATE State;
|
||||
EFI_STATUS Status;
|
||||
UINT32 Argument;
|
||||
|
||||
Host = MmcHostInstance->MmcHost;
|
||||
Argument = EMMC_CMD6_ARG_ACCESS(3) | EMMC_CMD6_ARG_INDEX(ExtCmdIndex) |
|
||||
EMMC_CMD6_ARG_VALUE(Value) | EMMC_CMD6_ARG_CMD_SET(1);
|
||||
Host = MmcHostInstance->MmcHost;
|
||||
Argument = EMMC_CMD6_ARG_ACCESS (3) | EMMC_CMD6_ARG_INDEX (ExtCmdIndex) |
|
||||
EMMC_CMD6_ARG_VALUE (Value) | EMMC_CMD6_ARG_CMD_SET (1);
|
||||
Status = Host->SendCommand (Host, MMC_CMD6, Argument);
|
||||
if (EFI_ERROR (Status)) {
|
||||
DEBUG ((DEBUG_ERROR, "EmmcSetEXTCSD(): Failed to send CMD6, Status=%r.\n", Status));
|
||||
return Status;
|
||||
}
|
||||
|
||||
// Make sure device exiting prog mode
|
||||
do {
|
||||
Status = EmmcGetDeviceState (MmcHostInstance, &State);
|
||||
@@ -127,6 +131,7 @@ EmmcSetEXTCSD (
|
||||
return Status;
|
||||
}
|
||||
} while (State == EMMC_PRG_STATE);
|
||||
|
||||
return EFI_SUCCESS;
|
||||
}
|
||||
|
||||
@@ -134,15 +139,15 @@ STATIC
|
||||
EFI_STATUS
|
||||
EFIAPI
|
||||
EmmcIdentificationMode (
|
||||
IN MMC_HOST_INSTANCE *MmcHostInstance,
|
||||
IN OCR_RESPONSE Response
|
||||
IN MMC_HOST_INSTANCE *MmcHostInstance,
|
||||
IN OCR_RESPONSE Response
|
||||
)
|
||||
{
|
||||
EFI_MMC_HOST_PROTOCOL *Host;
|
||||
EFI_BLOCK_IO_MEDIA *Media;
|
||||
EFI_STATUS Status;
|
||||
EMMC_DEVICE_STATE State;
|
||||
UINT32 RCA;
|
||||
EFI_MMC_HOST_PROTOCOL *Host;
|
||||
EFI_BLOCK_IO_MEDIA *Media;
|
||||
EFI_STATUS Status;
|
||||
EMMC_DEVICE_STATE State;
|
||||
UINT32 RCA;
|
||||
|
||||
Host = MmcHostInstance->MmcHost;
|
||||
Media = MmcHostInstance->BlockIo.Media;
|
||||
@@ -162,8 +167,8 @@ EmmcIdentificationMode (
|
||||
|
||||
// Assign a relative address value to the card
|
||||
MmcHostInstance->CardInfo.RCA = ++mEmmcRcaCount; // TODO: might need a more sophisticated way of doing this
|
||||
RCA = MmcHostInstance->CardInfo.RCA << RCA_SHIFT_OFFSET;
|
||||
Status = Host->SendCommand (Host, MMC_CMD3, RCA);
|
||||
RCA = MmcHostInstance->CardInfo.RCA << RCA_SHIFT_OFFSET;
|
||||
Status = Host->SendCommand (Host, MMC_CMD3, RCA);
|
||||
if (EFI_ERROR (Status)) {
|
||||
DEBUG ((DEBUG_ERROR, "EmmcIdentificationMode(): RCA set error, Status=%r.\n", Status));
|
||||
return Status;
|
||||
@@ -188,7 +193,7 @@ EmmcIdentificationMode (
|
||||
DEBUG ((DEBUG_ERROR, "EmmcIdentificationMode(): Card selection error, Status=%r.\n", Status));
|
||||
}
|
||||
|
||||
if (MMC_HOST_HAS_SETIOS(Host)) {
|
||||
if (MMC_HOST_HAS_SETIOS (Host)) {
|
||||
// Set 1-bit bus width
|
||||
Status = Host->SetIos (Host, 0, 1, EMMCBACKWARD);
|
||||
if (EFI_ERROR (Status)) {
|
||||
@@ -209,6 +214,7 @@ EmmcIdentificationMode (
|
||||
if (MmcHostInstance->CardInfo.ECSDData == NULL) {
|
||||
return EFI_OUT_OF_RESOURCES;
|
||||
}
|
||||
|
||||
Status = Host->SendCommand (Host, MMC_CMD8, 0);
|
||||
if (EFI_ERROR (Status)) {
|
||||
DEBUG ((DEBUG_ERROR, "EmmcIdentificationMode(): ECSD fetch error, Status=%r.\n", Status));
|
||||
@@ -230,11 +236,11 @@ EmmcIdentificationMode (
|
||||
} while (State == EMMC_DATA_STATE);
|
||||
|
||||
// Set up media
|
||||
Media->BlockSize = EMMC_CARD_SIZE; // 512-byte support is mandatory for eMMC cards
|
||||
Media->MediaId = MmcHostInstance->CardInfo.CIDData.PSN;
|
||||
Media->ReadOnly = MmcHostInstance->CardInfo.CSDData.PERM_WRITE_PROTECT;
|
||||
Media->BlockSize = EMMC_CARD_SIZE; // 512-byte support is mandatory for eMMC cards
|
||||
Media->MediaId = MmcHostInstance->CardInfo.CIDData.PSN;
|
||||
Media->ReadOnly = MmcHostInstance->CardInfo.CSDData.PERM_WRITE_PROTECT;
|
||||
Media->LogicalBlocksPerPhysicalBlock = 1;
|
||||
Media->IoAlign = 4;
|
||||
Media->IoAlign = 4;
|
||||
// Compute last block using bits [215:212] of the ECSD
|
||||
Media->LastBlock = MmcHostInstance->CardInfo.ECSDData->SECTOR_COUNT - 1; // eMMC isn't supposed to report this for
|
||||
// Cards <2GB in size, but the model does.
|
||||
@@ -251,23 +257,25 @@ FreePageExit:
|
||||
STATIC
|
||||
EFI_STATUS
|
||||
InitializeEmmcDevice (
|
||||
IN MMC_HOST_INSTANCE *MmcHostInstance
|
||||
IN MMC_HOST_INSTANCE *MmcHostInstance
|
||||
)
|
||||
{
|
||||
EFI_MMC_HOST_PROTOCOL *Host;
|
||||
EFI_STATUS Status = EFI_SUCCESS;
|
||||
ECSD *ECSDData;
|
||||
UINT32 BusClockFreq, Idx, BusMode;
|
||||
UINT32 TimingMode[4] = {EMMCHS52DDR1V2, EMMCHS52DDR1V8, EMMCHS52, EMMCHS26};
|
||||
EFI_MMC_HOST_PROTOCOL *Host;
|
||||
EFI_STATUS Status = EFI_SUCCESS;
|
||||
ECSD *ECSDData;
|
||||
UINT32 BusClockFreq, Idx, BusMode;
|
||||
UINT32 TimingMode[4] = { EMMCHS52DDR1V2, EMMCHS52DDR1V8, EMMCHS52, EMMCHS26 };
|
||||
|
||||
Host = MmcHostInstance->MmcHost;
|
||||
Host = MmcHostInstance->MmcHost;
|
||||
ECSDData = MmcHostInstance->CardInfo.ECSDData;
|
||||
if (ECSDData->DEVICE_TYPE == EMMCBACKWARD)
|
||||
return EFI_SUCCESS;
|
||||
|
||||
if (!MMC_HOST_HAS_SETIOS(Host)) {
|
||||
if (ECSDData->DEVICE_TYPE == EMMCBACKWARD) {
|
||||
return EFI_SUCCESS;
|
||||
}
|
||||
|
||||
if (!MMC_HOST_HAS_SETIOS (Host)) {
|
||||
return EFI_SUCCESS;
|
||||
}
|
||||
|
||||
Status = EmmcSetEXTCSD (MmcHostInstance, EXTCSD_HS_TIMING, EMMC_TIMING_HS);
|
||||
if (EFI_ERROR (Status)) {
|
||||
DEBUG ((DEBUG_ERROR, "InitializeEmmcDevice(): Failed to switch high speed mode, Status:%r.\n", Status));
|
||||
@@ -276,52 +284,56 @@ InitializeEmmcDevice (
|
||||
|
||||
for (Idx = 0; Idx < 4; Idx++) {
|
||||
switch (TimingMode[Idx]) {
|
||||
case EMMCHS52DDR1V2:
|
||||
case EMMCHS52DDR1V8:
|
||||
case EMMCHS52:
|
||||
BusClockFreq = 52000000;
|
||||
break;
|
||||
case EMMCHS26:
|
||||
BusClockFreq = 26000000;
|
||||
break;
|
||||
default:
|
||||
return EFI_UNSUPPORTED;
|
||||
}
|
||||
Status = Host->SetIos (Host, BusClockFreq, 8, TimingMode[Idx]);
|
||||
if (!EFI_ERROR (Status)) {
|
||||
switch (TimingMode[Idx]) {
|
||||
case EMMCHS52DDR1V2:
|
||||
case EMMCHS52DDR1V8:
|
||||
BusMode = EMMC_BUS_WIDTH_DDR_8BIT;
|
||||
break;
|
||||
case EMMCHS52:
|
||||
BusClockFreq = 52000000;
|
||||
break;
|
||||
case EMMCHS26:
|
||||
BusMode = EMMC_BUS_WIDTH_8BIT;
|
||||
BusClockFreq = 26000000;
|
||||
break;
|
||||
default:
|
||||
return EFI_UNSUPPORTED;
|
||||
}
|
||||
|
||||
Status = Host->SetIos (Host, BusClockFreq, 8, TimingMode[Idx]);
|
||||
if (!EFI_ERROR (Status)) {
|
||||
switch (TimingMode[Idx]) {
|
||||
case EMMCHS52DDR1V2:
|
||||
case EMMCHS52DDR1V8:
|
||||
BusMode = EMMC_BUS_WIDTH_DDR_8BIT;
|
||||
break;
|
||||
case EMMCHS52:
|
||||
case EMMCHS26:
|
||||
BusMode = EMMC_BUS_WIDTH_8BIT;
|
||||
break;
|
||||
default:
|
||||
return EFI_UNSUPPORTED;
|
||||
}
|
||||
|
||||
Status = EmmcSetEXTCSD (MmcHostInstance, EXTCSD_BUS_WIDTH, BusMode);
|
||||
if (EFI_ERROR (Status)) {
|
||||
DEBUG ((DEBUG_ERROR, "InitializeEmmcDevice(): Failed to set EXTCSD bus width, Status:%r\n", Status));
|
||||
}
|
||||
|
||||
return Status;
|
||||
}
|
||||
}
|
||||
|
||||
return Status;
|
||||
}
|
||||
|
||||
STATIC
|
||||
UINT32
|
||||
CreateSwitchCmdArgument (
|
||||
IN UINT32 Mode,
|
||||
IN UINT8 Group,
|
||||
IN UINT8 Value
|
||||
IN UINT32 Mode,
|
||||
IN UINT8 Group,
|
||||
IN UINT8 Value
|
||||
)
|
||||
{
|
||||
UINT32 Argument;
|
||||
UINT32 Argument;
|
||||
|
||||
Argument = Mode << 31 | 0x00FFFFFF;
|
||||
Argument = Mode << 31 | 0x00FFFFFF;
|
||||
Argument &= ~(0xF << (Group * 4));
|
||||
Argument |= Value << (Group * 4);
|
||||
|
||||
@@ -331,51 +343,52 @@ CreateSwitchCmdArgument (
|
||||
STATIC
|
||||
EFI_STATUS
|
||||
InitializeSdMmcDevice (
|
||||
IN MMC_HOST_INSTANCE *MmcHostInstance
|
||||
IN MMC_HOST_INSTANCE *MmcHostInstance
|
||||
)
|
||||
{
|
||||
UINT32 CmdArg;
|
||||
UINT32 Response[4];
|
||||
UINT32 Buffer[128];
|
||||
UINT32 Speed;
|
||||
UINTN BlockSize;
|
||||
UINTN CardSize;
|
||||
UINTN NumBlocks;
|
||||
BOOLEAN CccSwitch;
|
||||
SCR Scr;
|
||||
EFI_STATUS Status;
|
||||
EFI_MMC_HOST_PROTOCOL *MmcHost;
|
||||
UINT32 CmdArg;
|
||||
UINT32 Response[4];
|
||||
UINT32 Buffer[128];
|
||||
UINT32 Speed;
|
||||
UINTN BlockSize;
|
||||
UINTN CardSize;
|
||||
UINTN NumBlocks;
|
||||
BOOLEAN CccSwitch;
|
||||
SCR Scr;
|
||||
EFI_STATUS Status;
|
||||
EFI_MMC_HOST_PROTOCOL *MmcHost;
|
||||
|
||||
Speed = SD_DEFAULT_SPEED;
|
||||
Speed = SD_DEFAULT_SPEED;
|
||||
MmcHost = MmcHostInstance->MmcHost;
|
||||
|
||||
// Send a command to get Card specific data
|
||||
CmdArg = MmcHostInstance->CardInfo.RCA << 16;
|
||||
Status = MmcHost->SendCommand (MmcHost, MMC_CMD9, CmdArg);
|
||||
if (EFI_ERROR (Status)) {
|
||||
DEBUG((DEBUG_ERROR, "InitializeSdMmcDevice(MMC_CMD9): Error, Status=%r\n", Status));
|
||||
DEBUG ((DEBUG_ERROR, "InitializeSdMmcDevice(MMC_CMD9): Error, Status=%r\n", Status));
|
||||
return Status;
|
||||
}
|
||||
|
||||
// Read Response
|
||||
Status = MmcHost->ReceiveResponse (MmcHost, MMC_RESPONSE_TYPE_CSD, Response);
|
||||
if (EFI_ERROR (Status)) {
|
||||
DEBUG((DEBUG_ERROR, "InitializeSdMmcDevice(): Failed to receive CSD, Status=%r\n", Status));
|
||||
DEBUG ((DEBUG_ERROR, "InitializeSdMmcDevice(): Failed to receive CSD, Status=%r\n", Status));
|
||||
return Status;
|
||||
}
|
||||
|
||||
PrintCSD (Response);
|
||||
if (MMC_CSD_GET_CCC(Response) & SD_CCC_SWITCH) {
|
||||
if (MMC_CSD_GET_CCC (Response) & SD_CCC_SWITCH) {
|
||||
CccSwitch = TRUE;
|
||||
} else {
|
||||
CccSwitch = FALSE;
|
||||
}
|
||||
|
||||
if (MmcHostInstance->CardInfo.CardType == SD_CARD_2_HIGH) {
|
||||
CardSize = HC_MMC_CSD_GET_DEVICESIZE (Response);
|
||||
CardSize = HC_MMC_CSD_GET_DEVICESIZE (Response);
|
||||
NumBlocks = ((CardSize + 1) * 1024);
|
||||
BlockSize = 1 << MMC_CSD_GET_READBLLEN (Response);
|
||||
} else {
|
||||
CardSize = MMC_CSD_GET_DEVICESIZE (Response);
|
||||
CardSize = MMC_CSD_GET_DEVICESIZE (Response);
|
||||
NumBlocks = (CardSize + 1) * (1 << (MMC_CSD_GET_DEVICESIZEMULT (Response) + 2));
|
||||
BlockSize = 1 << MMC_CSD_GET_READBLLEN (Response);
|
||||
}
|
||||
@@ -395,7 +408,7 @@ InitializeSdMmcDevice (
|
||||
CmdArg = MmcHostInstance->CardInfo.RCA << 16;
|
||||
Status = MmcHost->SendCommand (MmcHost, MMC_CMD7, CmdArg);
|
||||
if (EFI_ERROR (Status)) {
|
||||
DEBUG((DEBUG_ERROR, "InitializeSdMmcDevice(MMC_CMD7): Error and Status = %r\n", Status));
|
||||
DEBUG ((DEBUG_ERROR, "InitializeSdMmcDevice(MMC_CMD7): Error and Status = %r\n", Status));
|
||||
return Status;
|
||||
}
|
||||
|
||||
@@ -404,11 +417,13 @@ InitializeSdMmcDevice (
|
||||
DEBUG ((DEBUG_ERROR, "%a (MMC_CMD55): Error and Status = %r\n", __FUNCTION__, Status));
|
||||
return Status;
|
||||
}
|
||||
|
||||
Status = MmcHost->ReceiveResponse (MmcHost, MMC_RESPONSE_TYPE_R1, Response);
|
||||
if (EFI_ERROR (Status)) {
|
||||
DEBUG ((DEBUG_ERROR, "%a (MMC_CMD55): Error and Status = %r\n", __FUNCTION__, Status));
|
||||
return Status;
|
||||
}
|
||||
|
||||
if ((Response[0] & MMC_STATUS_APP_CMD) == 0) {
|
||||
return EFI_SUCCESS;
|
||||
}
|
||||
@@ -424,40 +439,42 @@ InitializeSdMmcDevice (
|
||||
DEBUG ((DEBUG_ERROR, "%a(MMC_ACMD51): ReadBlockData Error and Status = %r\n", __func__, Status));
|
||||
return Status;
|
||||
}
|
||||
|
||||
CopyMem (&Scr, Buffer, 8);
|
||||
if (Scr.SD_SPEC == 2) {
|
||||
if (Scr.SD_SPEC3 == 1) {
|
||||
if (Scr.SD_SPEC4 == 1) {
|
||||
if (Scr.SD_SPEC4 == 1) {
|
||||
DEBUG ((DEBUG_INFO, "Found SD Card for Spec Version 4.xx\n"));
|
||||
} else {
|
||||
} else {
|
||||
DEBUG ((DEBUG_INFO, "Found SD Card for Spec Version 3.0x\n"));
|
||||
}
|
||||
}
|
||||
} else {
|
||||
if (Scr.SD_SPEC4 == 0) {
|
||||
if (Scr.SD_SPEC4 == 0) {
|
||||
DEBUG ((DEBUG_INFO, "Found SD Card for Spec Version 2.0\n"));
|
||||
} else {
|
||||
DEBUG ((DEBUG_ERROR, "Found invalid SD Card\n"));
|
||||
}
|
||||
} else {
|
||||
DEBUG ((DEBUG_ERROR, "Found invalid SD Card\n"));
|
||||
}
|
||||
}
|
||||
} else {
|
||||
if ((Scr.SD_SPEC3 == 0) && (Scr.SD_SPEC4 == 0)) {
|
||||
if (Scr.SD_SPEC == 1) {
|
||||
DEBUG ((DEBUG_INFO, "Found SD Card for Spec Version 1.10\n"));
|
||||
} else {
|
||||
DEBUG ((DEBUG_INFO, "Found SD Card for Spec Version 1.0\n"));
|
||||
}
|
||||
DEBUG ((DEBUG_INFO, "Found SD Card for Spec Version 1.10\n"));
|
||||
} else {
|
||||
DEBUG ((DEBUG_INFO, "Found SD Card for Spec Version 1.0\n"));
|
||||
}
|
||||
} else {
|
||||
DEBUG ((DEBUG_ERROR, "Found invalid SD Card\n"));
|
||||
}
|
||||
}
|
||||
}
|
||||
|
||||
if (CccSwitch) {
|
||||
/* SD Switch, Mode:0, Group:0, Value:0 */
|
||||
CmdArg = CreateSwitchCmdArgument(0, 0, 0);
|
||||
CmdArg = CreateSwitchCmdArgument (0, 0, 0);
|
||||
Status = MmcHost->SendCommand (MmcHost, MMC_CMD6, CmdArg);
|
||||
if (EFI_ERROR (Status)) {
|
||||
DEBUG ((DEBUG_ERROR, "%a (MMC_CMD6): Error and Status = %r\n", __FUNCTION__, Status));
|
||||
return Status;
|
||||
return Status;
|
||||
} else {
|
||||
Status = MmcHost->ReadBlockData (MmcHost, 0, SWITCH_CMD_DATA_LENGTH, Buffer);
|
||||
if (EFI_ERROR (Status)) {
|
||||
@@ -472,7 +489,7 @@ InitializeSdMmcDevice (
|
||||
Speed = SD_HIGH_SPEED;
|
||||
|
||||
/* SD Switch, Mode:1, Group:0, Value:1 */
|
||||
CmdArg = CreateSwitchCmdArgument(1, 0, 1);
|
||||
CmdArg = CreateSwitchCmdArgument (1, 0, 1);
|
||||
Status = MmcHost->SendCommand (MmcHost, MMC_CMD6, CmdArg);
|
||||
if (EFI_ERROR (Status)) {
|
||||
DEBUG ((DEBUG_ERROR, "%a (MMC_CMD6): Error and Status = %r\n", __FUNCTION__, Status));
|
||||
@@ -485,12 +502,13 @@ InitializeSdMmcDevice (
|
||||
}
|
||||
|
||||
if ((Buffer[4] & SWITCH_CMD_SUCCESS_MASK) != 0x01000000) {
|
||||
DEBUG((DEBUG_ERROR, "Problem switching SD card into high-speed mode\n"));
|
||||
DEBUG ((DEBUG_ERROR, "Problem switching SD card into high-speed mode\n"));
|
||||
return Status;
|
||||
}
|
||||
}
|
||||
}
|
||||
}
|
||||
|
||||
if (Scr.SD_BUS_WIDTHS & SD_BUS_WIDTH_4BIT) {
|
||||
CmdArg = MmcHostInstance->CardInfo.RCA << 16;
|
||||
Status = MmcHost->SendCommand (MmcHost, MMC_CMD55, CmdArg);
|
||||
@@ -498,6 +516,7 @@ InitializeSdMmcDevice (
|
||||
DEBUG ((DEBUG_ERROR, "%a (MMC_CMD55): Error and Status = %r\n", __FUNCTION__, Status));
|
||||
return Status;
|
||||
}
|
||||
|
||||
/* Width: 4 */
|
||||
Status = MmcHost->SendCommand (MmcHost, MMC_CMD6, 2);
|
||||
if (EFI_ERROR (Status)) {
|
||||
@@ -505,13 +524,15 @@ InitializeSdMmcDevice (
|
||||
return Status;
|
||||
}
|
||||
}
|
||||
if (MMC_HOST_HAS_SETIOS(MmcHost)) {
|
||||
|
||||
if (MMC_HOST_HAS_SETIOS (MmcHost)) {
|
||||
Status = MmcHost->SetIos (MmcHost, Speed, BUSWIDTH_4, EMMCBACKWARD);
|
||||
if (EFI_ERROR (Status)) {
|
||||
DEBUG ((DEBUG_ERROR, "%a (SetIos): Error and Status = %r\n", __FUNCTION__, Status));
|
||||
return Status;
|
||||
}
|
||||
}
|
||||
|
||||
return EFI_SUCCESS;
|
||||
}
|
||||
|
||||
@@ -519,20 +540,20 @@ STATIC
|
||||
EFI_STATUS
|
||||
EFIAPI
|
||||
MmcIdentificationMode (
|
||||
IN MMC_HOST_INSTANCE *MmcHostInstance
|
||||
IN MMC_HOST_INSTANCE *MmcHostInstance
|
||||
)
|
||||
{
|
||||
EFI_STATUS Status;
|
||||
UINT32 Response[4];
|
||||
UINTN Timeout;
|
||||
UINTN CmdArg;
|
||||
BOOLEAN IsHCS;
|
||||
EFI_MMC_HOST_PROTOCOL *MmcHost;
|
||||
OCR_RESPONSE OcrResponse;
|
||||
EFI_STATUS Status;
|
||||
UINT32 Response[4];
|
||||
UINTN Timeout;
|
||||
UINTN CmdArg;
|
||||
BOOLEAN IsHCS;
|
||||
EFI_MMC_HOST_PROTOCOL *MmcHost;
|
||||
OCR_RESPONSE OcrResponse;
|
||||
|
||||
MmcHost = MmcHostInstance->MmcHost;
|
||||
CmdArg = 0;
|
||||
IsHCS = FALSE;
|
||||
CmdArg = 0;
|
||||
IsHCS = FALSE;
|
||||
|
||||
if (MmcHost == NULL) {
|
||||
return EFI_INVALID_PARAMETER;
|
||||
@@ -553,6 +574,7 @@ MmcIdentificationMode (
|
||||
DEBUG ((DEBUG_ERROR, "MmcIdentificationMode(MMC_CMD0): Error, Status=%r.\n", Status));
|
||||
return Status;
|
||||
}
|
||||
|
||||
Status = MmcNotifyState (MmcHostInstance, MmcIdleState);
|
||||
if (EFI_ERROR (Status)) {
|
||||
DEBUG ((DEBUG_ERROR, "MmcIdentificationMode() : Error MmcIdleState, Status=%r.\n", Status));
|
||||
@@ -564,30 +586,36 @@ MmcIdentificationMode (
|
||||
Timeout = MAX_RETRY_COUNT;
|
||||
do {
|
||||
Status = MmcHost->SendCommand (MmcHost, MMC_CMD1, EMMC_CMD1_CAPACITY_GREATER_THAN_2GB);
|
||||
if (EFI_ERROR (Status))
|
||||
if (EFI_ERROR (Status)) {
|
||||
break;
|
||||
}
|
||||
|
||||
Status = MmcHost->ReceiveResponse (MmcHost, MMC_RESPONSE_TYPE_OCR, (UINT32 *)&OcrResponse);
|
||||
if (EFI_ERROR (Status)) {
|
||||
DEBUG ((DEBUG_ERROR, "MmcIdentificationMode() : Failed to receive OCR, Status=%r.\n", Status));
|
||||
return Status;
|
||||
}
|
||||
|
||||
Timeout--;
|
||||
} while (!OcrResponse.Ocr.PowerUp && (Timeout > 0));
|
||||
|
||||
if (Status == EFI_SUCCESS) {
|
||||
if (!OcrResponse.Ocr.PowerUp) {
|
||||
DEBUG ((DEBUG_ERROR, "MmcIdentificationMode(MMC_CMD1): Card initialisation failure, Status=%r.\n", Status));
|
||||
return EFI_DEVICE_ERROR;
|
||||
}
|
||||
|
||||
OcrResponse.Ocr.PowerUp = 0;
|
||||
if (OcrResponse.Raw == EMMC_CMD1_CAPACITY_GREATER_THAN_2GB) {
|
||||
MmcHostInstance->CardInfo.OCRData.AccessMode = BIT1;
|
||||
}
|
||||
else {
|
||||
} else {
|
||||
MmcHostInstance->CardInfo.OCRData.AccessMode = 0x0;
|
||||
}
|
||||
|
||||
// Check whether MMC or eMMC
|
||||
if (OcrResponse.Raw == EMMC_CMD1_CAPACITY_GREATER_THAN_2GB ||
|
||||
OcrResponse.Raw == EMMC_CMD1_CAPACITY_LESS_THAN_2GB) {
|
||||
if ((OcrResponse.Raw == EMMC_CMD1_CAPACITY_GREATER_THAN_2GB) ||
|
||||
(OcrResponse.Raw == EMMC_CMD1_CAPACITY_LESS_THAN_2GB))
|
||||
{
|
||||
return EmmcIdentificationMode (MmcHostInstance, OcrResponse);
|
||||
}
|
||||
}
|
||||
@@ -604,12 +632,13 @@ MmcIdentificationMode (
|
||||
Status = MmcHost->SendCommand (MmcHost, MMC_CMD8, CmdArg);
|
||||
if (Status == EFI_SUCCESS) {
|
||||
DEBUG ((DEBUG_ERROR, "Card is SD2.0 => Supports high capacity\n"));
|
||||
IsHCS = TRUE;
|
||||
IsHCS = TRUE;
|
||||
Status = MmcHost->ReceiveResponse (MmcHost, MMC_RESPONSE_TYPE_R7, Response);
|
||||
if (EFI_ERROR (Status)) {
|
||||
DEBUG ((DEBUG_ERROR, "MmcIdentificationMode() : Failed to receive response to CMD8, Status=%r.\n", Status));
|
||||
return Status;
|
||||
}
|
||||
|
||||
PrintResponseR1 (Response[0]);
|
||||
// Check if it is valid response
|
||||
if (Response[0] != CmdArg) {
|
||||
@@ -634,10 +663,11 @@ MmcIdentificationMode (
|
||||
}
|
||||
|
||||
// Note: The first time CmdArg will be zero
|
||||
CmdArg = ((UINTN *) &(MmcHostInstance->CardInfo.OCRData))[0];
|
||||
CmdArg = ((UINTN *)&(MmcHostInstance->CardInfo.OCRData))[0];
|
||||
if (IsHCS) {
|
||||
CmdArg |= BIT30;
|
||||
}
|
||||
|
||||
Status = MmcHost->SendCommand (MmcHost, MMC_ACMD41, CmdArg);
|
||||
if (!EFI_ERROR (Status)) {
|
||||
Status = MmcHost->ReceiveResponse (MmcHost, MMC_RESPONSE_TYPE_OCR, Response);
|
||||
@@ -645,7 +675,8 @@ MmcIdentificationMode (
|
||||
DEBUG ((DEBUG_ERROR, "MmcIdentificationMode() : Failed to receive OCR, Status=%r.\n", Status));
|
||||
return Status;
|
||||
}
|
||||
((UINT32 *) &(MmcHostInstance->CardInfo.OCRData))[0] = Response[0];
|
||||
|
||||
((UINT32 *)&(MmcHostInstance->CardInfo.OCRData))[0] = Response[0];
|
||||
}
|
||||
} else {
|
||||
DEBUG ((DEBUG_INFO, "Card should be MMC\n"));
|
||||
@@ -658,7 +689,8 @@ MmcIdentificationMode (
|
||||
DEBUG ((DEBUG_ERROR, "MmcIdentificationMode() : Failed to receive OCR, Status=%r.\n", Status));
|
||||
return Status;
|
||||
}
|
||||
((UINT32 *) &(MmcHostInstance->CardInfo.OCRData))[0] = Response[0];
|
||||
|
||||
((UINT32 *)&(MmcHostInstance->CardInfo.OCRData))[0] = Response[0];
|
||||
}
|
||||
}
|
||||
|
||||
@@ -671,6 +703,7 @@ MmcIdentificationMode (
|
||||
MmcHostInstance->CardInfo.CardType = SD_CARD_2_HIGH;
|
||||
DEBUG ((DEBUG_ERROR, "High capacity card.\n"));
|
||||
}
|
||||
|
||||
break; // The MMC/SD card is ready. Continue the Identification Mode
|
||||
}
|
||||
} else {
|
||||
@@ -697,6 +730,7 @@ MmcIdentificationMode (
|
||||
DEBUG ((DEBUG_ERROR, "MmcIdentificationMode(MMC_CMD2): Error\n"));
|
||||
return Status;
|
||||
}
|
||||
|
||||
Status = MmcHost->ReceiveResponse (MmcHost, MMC_RESPONSE_TYPE_CID, Response);
|
||||
if (EFI_ERROR (Status)) {
|
||||
DEBUG ((DEBUG_ERROR, "MmcIdentificationMode() : Failed to receive CID, Status=%r.\n", Status));
|
||||
@@ -728,6 +762,7 @@ MmcIdentificationMode (
|
||||
DEBUG ((DEBUG_ERROR, "MmcIdentificationMode() : Failed to receive RCA, Status=%r.\n", Status));
|
||||
return Status;
|
||||
}
|
||||
|
||||
PrintRCA (Response[0]);
|
||||
|
||||
// For MMC card, RCA is assigned by CMD3 while CMD3 dumps the RCA for SD card
|
||||
@@ -736,6 +771,7 @@ MmcIdentificationMode (
|
||||
} else {
|
||||
MmcHostInstance->CardInfo.RCA = CmdArg;
|
||||
}
|
||||
|
||||
Status = MmcNotifyState (MmcHostInstance, MmcStandByState);
|
||||
if (EFI_ERROR (Status)) {
|
||||
DEBUG ((DEBUG_ERROR, "MmcIdentificationMode() : Error MmcStandByState\n"));
|
||||
@@ -747,25 +783,25 @@ MmcIdentificationMode (
|
||||
|
||||
EFI_STATUS
|
||||
InitializeMmcDevice (
|
||||
IN MMC_HOST_INSTANCE *MmcHostInstance
|
||||
IN MMC_HOST_INSTANCE *MmcHostInstance
|
||||
)
|
||||
{
|
||||
EFI_STATUS Status;
|
||||
EFI_MMC_HOST_PROTOCOL *MmcHost;
|
||||
UINTN BlockCount;
|
||||
EFI_STATUS Status;
|
||||
EFI_MMC_HOST_PROTOCOL *MmcHost;
|
||||
UINTN BlockCount;
|
||||
|
||||
BlockCount = 1;
|
||||
MmcHost = MmcHostInstance->MmcHost;
|
||||
MmcHost = MmcHostInstance->MmcHost;
|
||||
|
||||
Status = MmcIdentificationMode (MmcHostInstance);
|
||||
if (EFI_ERROR (Status)) {
|
||||
DEBUG((DEBUG_ERROR, "InitializeMmcDevice(): Error in Identification Mode, Status=%r\n", Status));
|
||||
DEBUG ((DEBUG_ERROR, "InitializeMmcDevice(): Error in Identification Mode, Status=%r\n", Status));
|
||||
return Status;
|
||||
}
|
||||
|
||||
Status = MmcNotifyState (MmcHostInstance, MmcTransferState);
|
||||
if (EFI_ERROR (Status)) {
|
||||
DEBUG((DEBUG_ERROR, "InitializeMmcDevice(): Error MmcTransferState, Status=%r\n", Status));
|
||||
DEBUG ((DEBUG_ERROR, "InitializeMmcDevice(): Error MmcTransferState, Status=%r\n", Status));
|
||||
return Status;
|
||||
}
|
||||
|
||||
@@ -774,6 +810,7 @@ InitializeMmcDevice (
|
||||
} else {
|
||||
Status = InitializeEmmcDevice (MmcHostInstance);
|
||||
}
|
||||
|
||||
if (EFI_ERROR (Status)) {
|
||||
return Status;
|
||||
}
|
||||
@@ -781,8 +818,12 @@ InitializeMmcDevice (
|
||||
// Set Block Length
|
||||
Status = MmcHost->SendCommand (MmcHost, MMC_CMD16, MmcHostInstance->BlockIo.Media->BlockSize);
|
||||
if (EFI_ERROR (Status)) {
|
||||
DEBUG((DEBUG_ERROR, "InitializeMmcDevice(MMC_CMD16): Error MmcHostInstance->BlockIo.Media->BlockSize: %d and Error = %r\n",
|
||||
MmcHostInstance->BlockIo.Media->BlockSize, Status));
|
||||
DEBUG ((
|
||||
DEBUG_ERROR,
|
||||
"InitializeMmcDevice(MMC_CMD16): Error MmcHostInstance->BlockIo.Media->BlockSize: %d and Error = %r\n",
|
||||
MmcHostInstance->BlockIo.Media->BlockSize,
|
||||
Status
|
||||
));
|
||||
return Status;
|
||||
}
|
||||
|
||||
@@ -790,7 +831,7 @@ InitializeMmcDevice (
|
||||
if (MmcHostInstance->CardInfo.CardType == MMC_CARD) {
|
||||
Status = MmcHost->SendCommand (MmcHost, MMC_CMD23, BlockCount);
|
||||
if (EFI_ERROR (Status)) {
|
||||
DEBUG((DEBUG_ERROR, "InitializeMmcDevice(MMC_CMD23): Error, Status=%r\n", Status));
|
||||
DEBUG ((DEBUG_ERROR, "InitializeMmcDevice(MMC_CMD23): Error, Status=%r\n", Status));
|
||||
return Status;
|
||||
}
|
||||
}
|
||||
|
Reference in New Issue
Block a user