MdeModulePkg/SdMmc: Add EDKII SD/MMC stack
This stack includes: 1. Dxe phase support by: 1) SdMmcPciHcDxe driver to consume PciIo and produce SdMmcPassThru. 2) SdDxe driver to consume SdMmcPassThru to produce BlkIo1/BlkIo2. 3) EmmcDxe driver to consume SdMmcPassThru to produce BlkIo1/BlkIo2/SSP. 2. Pei phase support 1) SdBlockIoPei driver to consume SdMmcHostController Ppi and produce VirutalBlkIo1&2. 2) EmmcBlockIoPei driver to consume SdMmcHostController Ppi and produce VirutalBlkIo1&2. 3) SdMmcPciHcPei driver to produce SdMmcHostController Ppi. Contributed-under: TianoCore Contribution Agreement 1.0 Signed-off-by: Feng Tian <feng.tian@intel.com> Reviewed-by: Hao Wu <hao.a.wu@intel.com>
This commit is contained in:
212
MdeModulePkg/Bus/Pci/SdMmcPciHcPei/SdMmcPciHcPei.c
Normal file
212
MdeModulePkg/Bus/Pci/SdMmcPciHcPei/SdMmcPciHcPei.c
Normal file
@@ -0,0 +1,212 @@
|
||||
/** @file
|
||||
SdMmcPciHcPei driver is used to provide platform-dependent info, mainly SD/MMC
|
||||
host controller MMIO base, to upper layer SD/MMC drivers.
|
||||
|
||||
Copyright (c) 2015, Intel Corporation. All rights reserved.<BR>
|
||||
This program and the accompanying materials
|
||||
are licensed and made available under the terms and conditions of the BSD License
|
||||
which accompanies this distribution. The full text of the license may be found at
|
||||
http://opensource.org/licenses/bsd-license.php.
|
||||
|
||||
THE PROGRAM IS DISTRIBUTED UNDER THE BSD LICENSE ON AN "AS IS" BASIS,
|
||||
WITHOUT WARRANTIES OR REPRESENTATIONS OF ANY KIND, EITHER EXPRESS OR IMPLIED.
|
||||
|
||||
**/
|
||||
|
||||
#include "SdMmcPciHcPei.h"
|
||||
|
||||
EDKII_SD_MMC_HOST_CONTROLLER_PPI mSdMmcHostControllerPpi = { GetSdMmcHcMmioBar };
|
||||
|
||||
EFI_PEI_PPI_DESCRIPTOR mPpiList = {
|
||||
(EFI_PEI_PPI_DESCRIPTOR_PPI | EFI_PEI_PPI_DESCRIPTOR_TERMINATE_LIST),
|
||||
&gEdkiiPeiSdMmcHostControllerPpiGuid,
|
||||
&mSdMmcHostControllerPpi
|
||||
};
|
||||
|
||||
/**
|
||||
Get the MMIO base address of SD/MMC host controller.
|
||||
|
||||
@param[in] This The protocol instance pointer.
|
||||
@param[in] ControllerId The ID of the SD/MMC host controller.
|
||||
@param[in,out] MmioBar The pointer to store the array of available
|
||||
SD/MMC host controller slot MMIO base addresses.
|
||||
The entry number of the array is specified by BarNum.
|
||||
@param[out] BarNum The pointer to store the supported bar number.
|
||||
|
||||
@retval EFI_SUCCESS The operation succeeds.
|
||||
@retval EFI_INVALID_PARAMETER The parameters are invalid.
|
||||
|
||||
**/
|
||||
EFI_STATUS
|
||||
EFIAPI
|
||||
GetSdMmcHcMmioBar (
|
||||
IN EDKII_SD_MMC_HOST_CONTROLLER_PPI *This,
|
||||
IN UINT8 ControllerId,
|
||||
IN OUT UINTN **MmioBar,
|
||||
OUT UINT8 *BarNum
|
||||
)
|
||||
{
|
||||
SD_MMC_HC_PEI_PRIVATE_DATA *Private;
|
||||
|
||||
if ((This == NULL) || (MmioBar == NULL) || (BarNum == NULL)) {
|
||||
return EFI_INVALID_PARAMETER;
|
||||
}
|
||||
|
||||
Private = SD_MMC_HC_PEI_PRIVATE_DATA_FROM_THIS (This);
|
||||
|
||||
if (ControllerId >= Private->TotalSdMmcHcs) {
|
||||
return EFI_INVALID_PARAMETER;
|
||||
}
|
||||
|
||||
*MmioBar = &Private->MmioBar[ControllerId].MmioBarAddr[0];
|
||||
*BarNum = (UINT8)Private->MmioBar[ControllerId].SlotNum;
|
||||
return EFI_SUCCESS;
|
||||
}
|
||||
|
||||
/**
|
||||
The user code starts with this function.
|
||||
|
||||
@param FileHandle Handle of the file being invoked.
|
||||
@param PeiServices Describes the list of possible PEI Services.
|
||||
|
||||
@retval EFI_SUCCESS The driver is successfully initialized.
|
||||
@retval Others Can't initialize the driver.
|
||||
|
||||
**/
|
||||
EFI_STATUS
|
||||
EFIAPI
|
||||
InitializeSdMmcHcPeim (
|
||||
IN EFI_PEI_FILE_HANDLE FileHandle,
|
||||
IN CONST EFI_PEI_SERVICES **PeiServices
|
||||
)
|
||||
{
|
||||
EFI_BOOT_MODE BootMode;
|
||||
EFI_STATUS Status;
|
||||
UINT16 Bus;
|
||||
UINT16 Device;
|
||||
UINT16 Function;
|
||||
UINT32 Size;
|
||||
UINT64 MmioSize;
|
||||
UINT8 SubClass;
|
||||
UINT8 BaseClass;
|
||||
UINT8 SlotInfo;
|
||||
UINT8 SlotNum;
|
||||
UINT8 FirstBar;
|
||||
UINT8 Index;
|
||||
UINT8 Slot;
|
||||
UINT32 BarAddr;
|
||||
SD_MMC_HC_PEI_PRIVATE_DATA *Private;
|
||||
|
||||
//
|
||||
// Shadow this PEIM to run from memory
|
||||
//
|
||||
if (!EFI_ERROR (PeiServicesRegisterForShadow (FileHandle))) {
|
||||
return EFI_SUCCESS;
|
||||
}
|
||||
|
||||
Status = PeiServicesGetBootMode (&BootMode);
|
||||
///
|
||||
/// We do not expose this in S3 boot path, because it is only for recovery.
|
||||
///
|
||||
if (BootMode == BOOT_ON_S3_RESUME) {
|
||||
return EFI_SUCCESS;
|
||||
}
|
||||
|
||||
Private = (SD_MMC_HC_PEI_PRIVATE_DATA *) AllocateZeroPool (sizeof (SD_MMC_HC_PEI_PRIVATE_DATA));
|
||||
if (Private == NULL) {
|
||||
DEBUG ((EFI_D_ERROR, "Failed to allocate memory for SD_MMC_HC_PEI_PRIVATE_DATA! \n"));
|
||||
return EFI_OUT_OF_RESOURCES;
|
||||
}
|
||||
|
||||
Private->Signature = SD_MMC_HC_PEI_SIGNATURE;
|
||||
Private->SdMmcHostControllerPpi = mSdMmcHostControllerPpi;
|
||||
Private->PpiList = mPpiList;
|
||||
Private->PpiList.Ppi = &Private->SdMmcHostControllerPpi;
|
||||
|
||||
BarAddr = PcdGet32 (PcdSdMmcPciHostControllerMmioBase);
|
||||
for (Bus = 0; Bus < 256; Bus++) {
|
||||
for (Device = 0; Device < 32; Device++) {
|
||||
for (Function = 0; Function < 8; Function++) {
|
||||
SubClass = PciRead8 (PCI_LIB_ADDRESS (Bus, Device, Function, 0x0A));
|
||||
BaseClass = PciRead8 (PCI_LIB_ADDRESS (Bus, Device, Function, 0x0B));
|
||||
|
||||
if ((SubClass == PCI_SUBCLASS_SD_HOST_CONTROLLER) && (BaseClass == PCI_CLASS_SYSTEM_PERIPHERAL)) {
|
||||
//
|
||||
// Get the SD/MMC Pci host controller's Slot Info.
|
||||
//
|
||||
SlotInfo = PciRead8 (PCI_LIB_ADDRESS (Bus, Device, Function, SD_MMC_HC_PEI_SLOT_OFFSET));
|
||||
FirstBar = (*(SD_MMC_HC_PEI_SLOT_INFO*)&SlotInfo).FirstBar;
|
||||
SlotNum = (*(SD_MMC_HC_PEI_SLOT_INFO*)&SlotInfo).SlotNum + 1;
|
||||
ASSERT ((FirstBar + SlotNum) < MAX_SD_MMC_SLOTS);
|
||||
|
||||
for (Index = 0, Slot = FirstBar; Slot < (FirstBar + SlotNum); Index++, Slot++) {
|
||||
//
|
||||
// Get the SD/MMC Pci host controller's MMIO region size.
|
||||
//
|
||||
PciAnd16 (PCI_LIB_ADDRESS (Bus, Device, Function, PCI_COMMAND_OFFSET), (UINT16)~(EFI_PCI_COMMAND_BUS_MASTER | EFI_PCI_COMMAND_MEMORY_SPACE));
|
||||
PciWrite32 (PCI_LIB_ADDRESS (Bus, Device, Function, PCI_BASE_ADDRESSREG_OFFSET + 4 * Slot), 0xFFFFFFFF);
|
||||
Size = PciRead32 (PCI_LIB_ADDRESS (Bus, Device, Function, PCI_BASE_ADDRESSREG_OFFSET + 4 * Slot));
|
||||
|
||||
switch (Size & 0x07) {
|
||||
case 0x0:
|
||||
//
|
||||
// Memory space: anywhere in 32 bit address space
|
||||
//
|
||||
MmioSize = (~(Size & 0xFFFFFFF0)) + 1;
|
||||
break;
|
||||
case 0x4:
|
||||
//
|
||||
// Memory space: anywhere in 64 bit address space
|
||||
//
|
||||
MmioSize = Size & 0xFFFFFFF0;
|
||||
PciWrite32 (PCI_LIB_ADDRESS(Bus, Device, Function, PCI_BASE_ADDRESSREG_OFFSET + 4), 0xFFFFFFFF);
|
||||
Size = PciRead32 (PCI_LIB_ADDRESS(Bus, Device, Function, PCI_BASE_ADDRESSREG_OFFSET + 4));
|
||||
//
|
||||
// Fix the length to support some spefic 64 bit BAR
|
||||
//
|
||||
Size |= ((UINT32)(-1) << HighBitSet32 (Size));
|
||||
//
|
||||
// Calculate the size of 64bit bar
|
||||
//
|
||||
MmioSize |= LShiftU64 ((UINT64) Size, 32);
|
||||
MmioSize = (~(MmioSize)) + 1;
|
||||
//
|
||||
// Clean the high 32bits of this 64bit BAR to 0 as we only allow a 32bit BAR.
|
||||
//
|
||||
PciWrite32 (PCI_LIB_ADDRESS (Bus, Device, Function, PCI_BASE_ADDRESSREG_OFFSET + 4 * Slot + 4), 0);
|
||||
break;
|
||||
default:
|
||||
//
|
||||
// Unknown BAR type
|
||||
//
|
||||
ASSERT (FALSE);
|
||||
continue;
|
||||
};
|
||||
//
|
||||
// Assign resource to the SdMmc Pci host controller's MMIO BAR.
|
||||
// Enable the SdMmc Pci host controller by setting BME and MSE bits of PCI_CMD register.
|
||||
//
|
||||
PciWrite32 (PCI_LIB_ADDRESS (Bus, Device, Function, PCI_BASE_ADDRESSREG_OFFSET + 4 * Slot), BarAddr);
|
||||
PciOr16 (PCI_LIB_ADDRESS (Bus, Device, Function, PCI_COMMAND_OFFSET), (EFI_PCI_COMMAND_BUS_MASTER | EFI_PCI_COMMAND_MEMORY_SPACE));
|
||||
//
|
||||
// Record the allocated Mmio base address.
|
||||
//
|
||||
Private->MmioBar[Private->TotalSdMmcHcs].SlotNum++;
|
||||
Private->MmioBar[Private->TotalSdMmcHcs].MmioBarAddr[Index] = BarAddr;
|
||||
BarAddr += (UINT32)MmioSize;
|
||||
}
|
||||
Private->TotalSdMmcHcs++;
|
||||
ASSERT (Private->TotalSdMmcHcs < MAX_SD_MMC_HCS);
|
||||
}
|
||||
}
|
||||
}
|
||||
}
|
||||
|
||||
///
|
||||
/// Install SdMmc Host Controller PPI
|
||||
///
|
||||
Status = PeiServicesInstallPpi (&Private->PpiList);
|
||||
|
||||
ASSERT_EFI_ERROR (Status);
|
||||
return Status;
|
||||
}
|
Reference in New Issue
Block a user