mirror of https://github.com/acidanthera/audk.git
858 lines
29 KiB
C
858 lines
29 KiB
C
/** @file
|
|
|
|
Copyright (c) 2015 - 2017, Intel Corporation. All rights reserved.<BR>
|
|
SPDX-License-Identifier: BSD-2-Clause-Patent
|
|
|
|
**/
|
|
|
|
#include "EmmcBlockIoPei.h"
|
|
|
|
//
|
|
// Template for EMMC HC Slot Data.
|
|
//
|
|
EMMC_PEIM_HC_SLOT gEmmcHcSlotTemplate = {
|
|
EMMC_PEIM_SLOT_SIG, // Signature
|
|
{ // Media
|
|
{
|
|
MSG_EMMC_DP,
|
|
FALSE,
|
|
TRUE,
|
|
FALSE,
|
|
0x200,
|
|
0
|
|
},
|
|
{
|
|
MSG_EMMC_DP,
|
|
FALSE,
|
|
TRUE,
|
|
FALSE,
|
|
0x200,
|
|
0
|
|
},
|
|
{
|
|
MSG_EMMC_DP,
|
|
FALSE,
|
|
TRUE,
|
|
FALSE,
|
|
0x200,
|
|
0
|
|
},
|
|
{
|
|
MSG_EMMC_DP,
|
|
FALSE,
|
|
TRUE,
|
|
FALSE,
|
|
0x200,
|
|
0
|
|
},
|
|
{
|
|
MSG_EMMC_DP,
|
|
FALSE,
|
|
TRUE,
|
|
FALSE,
|
|
0x200,
|
|
0
|
|
},
|
|
{
|
|
MSG_EMMC_DP,
|
|
FALSE,
|
|
TRUE,
|
|
FALSE,
|
|
0x200,
|
|
0
|
|
},
|
|
{
|
|
MSG_EMMC_DP,
|
|
FALSE,
|
|
TRUE,
|
|
FALSE,
|
|
0x200,
|
|
0
|
|
},
|
|
{
|
|
MSG_EMMC_DP,
|
|
FALSE,
|
|
TRUE,
|
|
FALSE,
|
|
0x200,
|
|
0
|
|
}
|
|
},
|
|
0, // MediaNum
|
|
{ // PartitionType
|
|
EmmcPartitionUnknown,
|
|
EmmcPartitionUnknown,
|
|
EmmcPartitionUnknown,
|
|
EmmcPartitionUnknown,
|
|
EmmcPartitionUnknown,
|
|
EmmcPartitionUnknown,
|
|
EmmcPartitionUnknown,
|
|
EmmcPartitionUnknown
|
|
},
|
|
0, // EmmcHcBase
|
|
{ // Capability
|
|
0,
|
|
},
|
|
{ // Csd
|
|
0,
|
|
},
|
|
{ // ExtCsd
|
|
{ 0 },
|
|
},
|
|
TRUE, // SectorAddressing
|
|
NULL // Private
|
|
};
|
|
|
|
//
|
|
// Template for EMMC HC Private Data.
|
|
//
|
|
EMMC_PEIM_HC_PRIVATE_DATA gEmmcHcPrivateTemplate = {
|
|
EMMC_PEIM_SIG, // Signature
|
|
NULL, // Pool
|
|
{ // BlkIoPpi
|
|
EmmcBlockIoPeimGetDeviceNo,
|
|
EmmcBlockIoPeimGetMediaInfo,
|
|
EmmcBlockIoPeimReadBlocks
|
|
},
|
|
{ // BlkIo2Ppi
|
|
EFI_PEI_RECOVERY_BLOCK_IO2_PPI_REVISION,
|
|
EmmcBlockIoPeimGetDeviceNo2,
|
|
EmmcBlockIoPeimGetMediaInfo2,
|
|
EmmcBlockIoPeimReadBlocks2
|
|
},
|
|
{ // BlkIoPpiList
|
|
EFI_PEI_PPI_DESCRIPTOR_PPI,
|
|
&gEfiPeiVirtualBlockIoPpiGuid,
|
|
NULL
|
|
},
|
|
{ // BlkIo2PpiList
|
|
EFI_PEI_PPI_DESCRIPTOR_PPI | EFI_PEI_PPI_DESCRIPTOR_TERMINATE_LIST,
|
|
&gEfiPeiVirtualBlockIo2PpiGuid,
|
|
NULL
|
|
},
|
|
{ // EndOfPeiNotifyList
|
|
(EFI_PEI_PPI_DESCRIPTOR_NOTIFY_CALLBACK | EFI_PEI_PPI_DESCRIPTOR_TERMINATE_LIST),
|
|
&gEfiEndOfPeiSignalPpiGuid,
|
|
EmmcBlockIoPeimEndOfPei
|
|
},
|
|
{ // Slot
|
|
{
|
|
0,
|
|
},
|
|
{
|
|
0,
|
|
},
|
|
{
|
|
0,
|
|
},
|
|
{
|
|
0,
|
|
},
|
|
{
|
|
0,
|
|
},
|
|
{
|
|
0,
|
|
}
|
|
},
|
|
0, // SlotNum
|
|
0 // TotalBlkIoDevices
|
|
};
|
|
|
|
/**
|
|
Gets the count of block I/O devices that one specific block driver detects.
|
|
|
|
This function is used for getting the count of block I/O devices that one
|
|
specific block driver detects. To the PEI ATAPI driver, it returns the number
|
|
of all the detected ATAPI devices it detects during the enumeration process.
|
|
To the PEI legacy floppy driver, it returns the number of all the legacy
|
|
devices it finds during its enumeration process. If no device is detected,
|
|
then the function will return zero.
|
|
|
|
@param[in] PeiServices General-purpose services that are available
|
|
to every PEIM.
|
|
@param[in] This Indicates the EFI_PEI_RECOVERY_BLOCK_IO_PPI
|
|
instance.
|
|
@param[out] NumberBlockDevices The number of block I/O devices discovered.
|
|
|
|
@retval EFI_SUCCESS The operation performed successfully.
|
|
|
|
**/
|
|
EFI_STATUS
|
|
EFIAPI
|
|
EmmcBlockIoPeimGetDeviceNo (
|
|
IN EFI_PEI_SERVICES **PeiServices,
|
|
IN EFI_PEI_RECOVERY_BLOCK_IO_PPI *This,
|
|
OUT UINTN *NumberBlockDevices
|
|
)
|
|
{
|
|
EMMC_PEIM_HC_PRIVATE_DATA *Private;
|
|
|
|
Private = GET_EMMC_PEIM_HC_PRIVATE_DATA_FROM_THIS (This);
|
|
*NumberBlockDevices = Private->TotalBlkIoDevices;
|
|
return EFI_SUCCESS;
|
|
}
|
|
|
|
/**
|
|
Gets a block device's media information.
|
|
|
|
This function will provide the caller with the specified block device's media
|
|
information. If the media changes, calling this function will update the media
|
|
information accordingly.
|
|
|
|
@param[in] PeiServices General-purpose services that are available to every
|
|
PEIM
|
|
@param[in] This Indicates the EFI_PEI_RECOVERY_BLOCK_IO_PPI instance.
|
|
@param[in] DeviceIndex Specifies the block device to which the function wants
|
|
to talk. Because the driver that implements Block I/O
|
|
PPIs will manage multiple block devices, the PPIs that
|
|
want to talk to a single device must specify the
|
|
device index that was assigned during the enumeration
|
|
process. This index is a number from one to
|
|
NumberBlockDevices.
|
|
@param[out] MediaInfo The media information of the specified block media.
|
|
The caller is responsible for the ownership of this
|
|
data structure.
|
|
|
|
@par Note:
|
|
The MediaInfo structure describes an enumeration of possible block device
|
|
types. This enumeration exists because no device paths are actually passed
|
|
across interfaces that describe the type or class of hardware that is publishing
|
|
the block I/O interface. This enumeration will allow for policy decisions
|
|
in the Recovery PEIM, such as "Try to recover from legacy floppy first,
|
|
LS-120 second, CD-ROM third." If there are multiple partitions abstracted
|
|
by a given device type, they should be reported in ascending order; this
|
|
order also applies to nested partitions, such as legacy MBR, where the
|
|
outermost partitions would have precedence in the reporting order. The
|
|
same logic applies to systems such as IDE that have precedence relationships
|
|
like "Master/Slave" or "Primary/Secondary". The master device should be
|
|
reported first, the slave second.
|
|
|
|
@retval EFI_SUCCESS Media information about the specified block device
|
|
was obtained successfully.
|
|
@retval EFI_DEVICE_ERROR Cannot get the media information due to a hardware
|
|
error.
|
|
|
|
**/
|
|
EFI_STATUS
|
|
EFIAPI
|
|
EmmcBlockIoPeimGetMediaInfo (
|
|
IN EFI_PEI_SERVICES **PeiServices,
|
|
IN EFI_PEI_RECOVERY_BLOCK_IO_PPI *This,
|
|
IN UINTN DeviceIndex,
|
|
OUT EFI_PEI_BLOCK_IO_MEDIA *MediaInfo
|
|
)
|
|
{
|
|
EMMC_PEIM_HC_PRIVATE_DATA *Private;
|
|
UINT8 SlotNum;
|
|
UINT8 MediaNum;
|
|
UINT8 Location;
|
|
BOOLEAN Found;
|
|
|
|
Found = FALSE;
|
|
Private = GET_EMMC_PEIM_HC_PRIVATE_DATA_FROM_THIS (This);
|
|
|
|
if ((DeviceIndex == 0) || (DeviceIndex > Private->TotalBlkIoDevices)) {
|
|
return EFI_INVALID_PARAMETER;
|
|
}
|
|
|
|
Location = 0;
|
|
MediaNum = 0;
|
|
for (SlotNum = 0; SlotNum < Private->SlotNum; SlotNum++) {
|
|
for (MediaNum = 0; MediaNum < Private->Slot[SlotNum].MediaNum; MediaNum++) {
|
|
Location++;
|
|
if (Location == DeviceIndex) {
|
|
Found = TRUE;
|
|
break;
|
|
}
|
|
}
|
|
|
|
if (Found) {
|
|
break;
|
|
}
|
|
}
|
|
|
|
MediaInfo->DeviceType = EMMC;
|
|
MediaInfo->MediaPresent = TRUE;
|
|
MediaInfo->LastBlock = (UINTN)Private->Slot[SlotNum].Media[MediaNum].LastBlock;
|
|
MediaInfo->BlockSize = Private->Slot[SlotNum].Media[MediaNum].BlockSize;
|
|
|
|
return EFI_SUCCESS;
|
|
}
|
|
|
|
/**
|
|
Reads the requested number of blocks from the specified block device.
|
|
|
|
The function reads the requested number of blocks from the device. All the
|
|
blocks are read, or an error is returned. If there is no media in the device,
|
|
the function returns EFI_NO_MEDIA.
|
|
|
|
@param[in] PeiServices General-purpose services that are available to
|
|
every PEIM.
|
|
@param[in] This Indicates the EFI_PEI_RECOVERY_BLOCK_IO_PPI instance.
|
|
@param[in] DeviceIndex Specifies the block device to which the function wants
|
|
to talk. Because the driver that implements Block I/O
|
|
PPIs will manage multiple block devices, PPIs that
|
|
want to talk to a single device must specify the device
|
|
index that was assigned during the enumeration process.
|
|
This index is a number from one to NumberBlockDevices.
|
|
@param[in] StartLBA The starting logical block address (LBA) to read from
|
|
on the device
|
|
@param[in] BufferSize The size of the Buffer in bytes. This number must be
|
|
a multiple of the intrinsic block size of the device.
|
|
@param[out] Buffer A pointer to the destination buffer for the data.
|
|
The caller is responsible for the ownership of the
|
|
buffer.
|
|
|
|
@retval EFI_SUCCESS The data was read correctly from the device.
|
|
@retval EFI_DEVICE_ERROR The device reported an error while attempting
|
|
to perform the read operation.
|
|
@retval EFI_INVALID_PARAMETER The read request contains LBAs that are not
|
|
valid, or the buffer is not properly aligned.
|
|
@retval EFI_NO_MEDIA There is no media in the device.
|
|
@retval EFI_BAD_BUFFER_SIZE The BufferSize parameter is not a multiple of
|
|
the intrinsic block size of the device.
|
|
|
|
**/
|
|
EFI_STATUS
|
|
EFIAPI
|
|
EmmcBlockIoPeimReadBlocks (
|
|
IN EFI_PEI_SERVICES **PeiServices,
|
|
IN EFI_PEI_RECOVERY_BLOCK_IO_PPI *This,
|
|
IN UINTN DeviceIndex,
|
|
IN EFI_PEI_LBA StartLBA,
|
|
IN UINTN BufferSize,
|
|
OUT VOID *Buffer
|
|
)
|
|
{
|
|
EFI_STATUS Status;
|
|
UINT32 BlockSize;
|
|
UINTN NumberOfBlocks;
|
|
EMMC_PEIM_HC_PRIVATE_DATA *Private;
|
|
UINT8 SlotNum;
|
|
UINT8 MediaNum;
|
|
UINT8 Location;
|
|
UINT8 PartitionConfig;
|
|
UINTN Remaining;
|
|
UINT32 MaxBlock;
|
|
BOOLEAN Found;
|
|
|
|
Status = EFI_SUCCESS;
|
|
Found = FALSE;
|
|
Private = GET_EMMC_PEIM_HC_PRIVATE_DATA_FROM_THIS (This);
|
|
|
|
//
|
|
// Check parameters
|
|
//
|
|
if (Buffer == NULL) {
|
|
return EFI_INVALID_PARAMETER;
|
|
}
|
|
|
|
if (BufferSize == 0) {
|
|
return EFI_SUCCESS;
|
|
}
|
|
|
|
if ((DeviceIndex == 0) || (DeviceIndex > Private->TotalBlkIoDevices)) {
|
|
return EFI_INVALID_PARAMETER;
|
|
}
|
|
|
|
Location = 0;
|
|
MediaNum = 0;
|
|
for (SlotNum = 0; SlotNum < Private->SlotNum; SlotNum++) {
|
|
for (MediaNum = 0; MediaNum < Private->Slot[SlotNum].MediaNum; MediaNum++) {
|
|
Location++;
|
|
if (Location == DeviceIndex) {
|
|
Found = TRUE;
|
|
break;
|
|
}
|
|
}
|
|
|
|
if (Found) {
|
|
break;
|
|
}
|
|
}
|
|
|
|
BlockSize = Private->Slot[SlotNum].Media[MediaNum].BlockSize;
|
|
if (BufferSize % BlockSize != 0) {
|
|
return EFI_BAD_BUFFER_SIZE;
|
|
}
|
|
|
|
if (StartLBA > Private->Slot[SlotNum].Media[MediaNum].LastBlock) {
|
|
return EFI_INVALID_PARAMETER;
|
|
}
|
|
|
|
NumberOfBlocks = BufferSize / BlockSize;
|
|
|
|
//
|
|
// Check if needs to switch partition access.
|
|
//
|
|
PartitionConfig = Private->Slot[SlotNum].ExtCsd.PartitionConfig;
|
|
if ((PartitionConfig & 0x7) != Private->Slot[SlotNum].PartitionType[MediaNum]) {
|
|
PartitionConfig &= (UINT8) ~0x7;
|
|
PartitionConfig |= Private->Slot[SlotNum].PartitionType[MediaNum];
|
|
Status = EmmcPeimSwitch (
|
|
&Private->Slot[SlotNum],
|
|
0x3,
|
|
OFFSET_OF (EMMC_EXT_CSD, PartitionConfig),
|
|
PartitionConfig,
|
|
0x0
|
|
);
|
|
if (EFI_ERROR (Status)) {
|
|
return Status;
|
|
}
|
|
|
|
Private->Slot[SlotNum].ExtCsd.PartitionConfig = PartitionConfig;
|
|
}
|
|
|
|
//
|
|
// Start to execute data transfer. The max block number in single cmd is 65535 blocks.
|
|
//
|
|
Remaining = NumberOfBlocks;
|
|
MaxBlock = 0xFFFF;
|
|
|
|
while (Remaining > 0) {
|
|
if (Remaining <= MaxBlock) {
|
|
NumberOfBlocks = Remaining;
|
|
} else {
|
|
NumberOfBlocks = MaxBlock;
|
|
}
|
|
|
|
Status = EmmcPeimSetBlkCount (&Private->Slot[SlotNum], (UINT16)NumberOfBlocks);
|
|
if (EFI_ERROR (Status)) {
|
|
return Status;
|
|
}
|
|
|
|
BufferSize = NumberOfBlocks * BlockSize;
|
|
Status = EmmcPeimRwMultiBlocks (&Private->Slot[SlotNum], StartLBA, BlockSize, Buffer, BufferSize, TRUE);
|
|
if (EFI_ERROR (Status)) {
|
|
return Status;
|
|
}
|
|
|
|
StartLBA += NumberOfBlocks;
|
|
Buffer = (UINT8 *)Buffer + BufferSize;
|
|
Remaining -= NumberOfBlocks;
|
|
}
|
|
|
|
return Status;
|
|
}
|
|
|
|
/**
|
|
Gets the count of block I/O devices that one specific block driver detects.
|
|
|
|
This function is used for getting the count of block I/O devices that one
|
|
specific block driver detects. To the PEI ATAPI driver, it returns the number
|
|
of all the detected ATAPI devices it detects during the enumeration process.
|
|
To the PEI legacy floppy driver, it returns the number of all the legacy
|
|
devices it finds during its enumeration process. If no device is detected,
|
|
then the function will return zero.
|
|
|
|
@param[in] PeiServices General-purpose services that are available
|
|
to every PEIM.
|
|
@param[in] This Indicates the EFI_PEI_RECOVERY_BLOCK_IO2_PPI
|
|
instance.
|
|
@param[out] NumberBlockDevices The number of block I/O devices discovered.
|
|
|
|
@retval EFI_SUCCESS The operation performed successfully.
|
|
|
|
**/
|
|
EFI_STATUS
|
|
EFIAPI
|
|
EmmcBlockIoPeimGetDeviceNo2 (
|
|
IN EFI_PEI_SERVICES **PeiServices,
|
|
IN EFI_PEI_RECOVERY_BLOCK_IO2_PPI *This,
|
|
OUT UINTN *NumberBlockDevices
|
|
)
|
|
{
|
|
EMMC_PEIM_HC_PRIVATE_DATA *Private;
|
|
|
|
Private = GET_EMMC_PEIM_HC_PRIVATE_DATA_FROM_THIS2 (This);
|
|
*NumberBlockDevices = Private->TotalBlkIoDevices;
|
|
|
|
return EFI_SUCCESS;
|
|
}
|
|
|
|
/**
|
|
Gets a block device's media information.
|
|
|
|
This function will provide the caller with the specified block device's media
|
|
information. If the media changes, calling this function will update the media
|
|
information accordingly.
|
|
|
|
@param[in] PeiServices General-purpose services that are available to every
|
|
PEIM
|
|
@param[in] This Indicates the EFI_PEI_RECOVERY_BLOCK_IO2_PPI instance.
|
|
@param[in] DeviceIndex Specifies the block device to which the function wants
|
|
to talk. Because the driver that implements Block I/O
|
|
PPIs will manage multiple block devices, the PPIs that
|
|
want to talk to a single device must specify the
|
|
device index that was assigned during the enumeration
|
|
process. This index is a number from one to
|
|
NumberBlockDevices.
|
|
@param[out] MediaInfo The media information of the specified block media.
|
|
The caller is responsible for the ownership of this
|
|
data structure.
|
|
|
|
@par Note:
|
|
The MediaInfo structure describes an enumeration of possible block device
|
|
types. This enumeration exists because no device paths are actually passed
|
|
across interfaces that describe the type or class of hardware that is publishing
|
|
the block I/O interface. This enumeration will allow for policy decisions
|
|
in the Recovery PEIM, such as "Try to recover from legacy floppy first,
|
|
LS-120 second, CD-ROM third." If there are multiple partitions abstracted
|
|
by a given device type, they should be reported in ascending order; this
|
|
order also applies to nested partitions, such as legacy MBR, where the
|
|
outermost partitions would have precedence in the reporting order. The
|
|
same logic applies to systems such as IDE that have precedence relationships
|
|
like "Master/Slave" or "Primary/Secondary". The master device should be
|
|
reported first, the slave second.
|
|
|
|
@retval EFI_SUCCESS Media information about the specified block device
|
|
was obtained successfully.
|
|
@retval EFI_DEVICE_ERROR Cannot get the media information due to a hardware
|
|
error.
|
|
|
|
**/
|
|
EFI_STATUS
|
|
EFIAPI
|
|
EmmcBlockIoPeimGetMediaInfo2 (
|
|
IN EFI_PEI_SERVICES **PeiServices,
|
|
IN EFI_PEI_RECOVERY_BLOCK_IO2_PPI *This,
|
|
IN UINTN DeviceIndex,
|
|
OUT EFI_PEI_BLOCK_IO2_MEDIA *MediaInfo
|
|
)
|
|
{
|
|
EFI_STATUS Status;
|
|
EMMC_PEIM_HC_PRIVATE_DATA *Private;
|
|
EFI_PEI_BLOCK_IO_MEDIA Media;
|
|
UINT8 SlotNum;
|
|
UINT8 MediaNum;
|
|
UINT8 Location;
|
|
BOOLEAN Found;
|
|
|
|
Found = FALSE;
|
|
Private = GET_EMMC_PEIM_HC_PRIVATE_DATA_FROM_THIS2 (This);
|
|
|
|
Status = EmmcBlockIoPeimGetMediaInfo (
|
|
PeiServices,
|
|
&Private->BlkIoPpi,
|
|
DeviceIndex,
|
|
&Media
|
|
);
|
|
if (EFI_ERROR (Status)) {
|
|
return Status;
|
|
}
|
|
|
|
Location = 0;
|
|
MediaNum = 0;
|
|
for (SlotNum = 0; SlotNum < Private->SlotNum; SlotNum++) {
|
|
for (MediaNum = 0; MediaNum < Private->Slot[SlotNum].MediaNum; MediaNum++) {
|
|
Location++;
|
|
if (Location == DeviceIndex) {
|
|
Found = TRUE;
|
|
break;
|
|
}
|
|
}
|
|
|
|
if (Found) {
|
|
break;
|
|
}
|
|
}
|
|
|
|
CopyMem (MediaInfo, &(Private->Slot[SlotNum].Media[MediaNum]), sizeof (EFI_PEI_BLOCK_IO2_MEDIA));
|
|
return EFI_SUCCESS;
|
|
}
|
|
|
|
/**
|
|
Reads the requested number of blocks from the specified block device.
|
|
|
|
The function reads the requested number of blocks from the device. All the
|
|
blocks are read, or an error is returned. If there is no media in the device,
|
|
the function returns EFI_NO_MEDIA.
|
|
|
|
@param[in] PeiServices General-purpose services that are available to
|
|
every PEIM.
|
|
@param[in] This Indicates the EFI_PEI_RECOVERY_BLOCK_IO2_PPI instance.
|
|
@param[in] DeviceIndex Specifies the block device to which the function wants
|
|
to talk. Because the driver that implements Block I/O
|
|
PPIs will manage multiple block devices, PPIs that
|
|
want to talk to a single device must specify the device
|
|
index that was assigned during the enumeration process.
|
|
This index is a number from one to NumberBlockDevices.
|
|
@param[in] StartLBA The starting logical block address (LBA) to read from
|
|
on the device
|
|
@param[in] BufferSize The size of the Buffer in bytes. This number must be
|
|
a multiple of the intrinsic block size of the device.
|
|
@param[out] Buffer A pointer to the destination buffer for the data.
|
|
The caller is responsible for the ownership of the
|
|
buffer.
|
|
|
|
@retval EFI_SUCCESS The data was read correctly from the device.
|
|
@retval EFI_DEVICE_ERROR The device reported an error while attempting
|
|
to perform the read operation.
|
|
@retval EFI_INVALID_PARAMETER The read request contains LBAs that are not
|
|
valid, or the buffer is not properly aligned.
|
|
@retval EFI_NO_MEDIA There is no media in the device.
|
|
@retval EFI_BAD_BUFFER_SIZE The BufferSize parameter is not a multiple of
|
|
the intrinsic block size of the device.
|
|
|
|
**/
|
|
EFI_STATUS
|
|
EFIAPI
|
|
EmmcBlockIoPeimReadBlocks2 (
|
|
IN EFI_PEI_SERVICES **PeiServices,
|
|
IN EFI_PEI_RECOVERY_BLOCK_IO2_PPI *This,
|
|
IN UINTN DeviceIndex,
|
|
IN EFI_PEI_LBA StartLBA,
|
|
IN UINTN BufferSize,
|
|
OUT VOID *Buffer
|
|
)
|
|
{
|
|
EFI_STATUS Status;
|
|
EMMC_PEIM_HC_PRIVATE_DATA *Private;
|
|
|
|
Status = EFI_SUCCESS;
|
|
Private = GET_EMMC_PEIM_HC_PRIVATE_DATA_FROM_THIS2 (This);
|
|
|
|
Status = EmmcBlockIoPeimReadBlocks (
|
|
PeiServices,
|
|
&Private->BlkIoPpi,
|
|
DeviceIndex,
|
|
StartLBA,
|
|
BufferSize,
|
|
Buffer
|
|
);
|
|
return Status;
|
|
}
|
|
|
|
/**
|
|
One notified function to cleanup the allocated DMA buffers at the end of PEI.
|
|
|
|
@param[in] PeiServices Pointer to PEI Services Table.
|
|
@param[in] NotifyDescriptor Pointer to the descriptor for the Notification
|
|
event that caused this function to execute.
|
|
@param[in] Ppi Pointer to the PPI data associated with this function.
|
|
|
|
@retval EFI_SUCCESS The function completes successfully
|
|
|
|
**/
|
|
EFI_STATUS
|
|
EFIAPI
|
|
EmmcBlockIoPeimEndOfPei (
|
|
IN EFI_PEI_SERVICES **PeiServices,
|
|
IN EFI_PEI_NOTIFY_DESCRIPTOR *NotifyDescriptor,
|
|
IN VOID *Ppi
|
|
)
|
|
{
|
|
EMMC_PEIM_HC_PRIVATE_DATA *Private;
|
|
|
|
Private = GET_EMMC_PEIM_HC_PRIVATE_DATA_FROM_THIS_NOTIFY (NotifyDescriptor);
|
|
|
|
if ((Private->Pool != NULL) && (Private->Pool->Head != NULL)) {
|
|
EmmcPeimFreeMemPool (Private->Pool);
|
|
}
|
|
|
|
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
|
|
InitializeEmmcBlockIoPeim (
|
|
IN EFI_PEI_FILE_HANDLE FileHandle,
|
|
IN CONST EFI_PEI_SERVICES **PeiServices
|
|
)
|
|
{
|
|
EFI_STATUS Status;
|
|
EMMC_PEIM_HC_PRIVATE_DATA *Private;
|
|
EDKII_SD_MMC_HOST_CONTROLLER_PPI *SdMmcHcPpi;
|
|
UINT32 Index;
|
|
UINT32 PartitionIndex;
|
|
UINTN *MmioBase;
|
|
UINT8 BarNum;
|
|
UINT8 SlotNum;
|
|
UINT8 MediaNum;
|
|
UINT8 Controller;
|
|
UINT64 Capacity;
|
|
EMMC_EXT_CSD *ExtCsd;
|
|
EMMC_HC_SLOT_CAP Capability;
|
|
EMMC_PEIM_HC_SLOT *Slot;
|
|
UINT32 SecCount;
|
|
UINT32 GpSizeMult;
|
|
|
|
//
|
|
// Shadow this PEIM to run from memory
|
|
//
|
|
if (!EFI_ERROR (PeiServicesRegisterForShadow (FileHandle))) {
|
|
return EFI_SUCCESS;
|
|
}
|
|
|
|
//
|
|
// locate Emmc host controller PPI
|
|
//
|
|
Status = PeiServicesLocatePpi (
|
|
&gEdkiiPeiSdMmcHostControllerPpiGuid,
|
|
0,
|
|
NULL,
|
|
(VOID **)&SdMmcHcPpi
|
|
);
|
|
if (EFI_ERROR (Status)) {
|
|
return EFI_DEVICE_ERROR;
|
|
}
|
|
|
|
IoMmuInit ();
|
|
|
|
Controller = 0;
|
|
MmioBase = NULL;
|
|
while (TRUE) {
|
|
Status = SdMmcHcPpi->GetSdMmcHcMmioBar (SdMmcHcPpi, Controller, &MmioBase, &BarNum);
|
|
//
|
|
// When status is error, meant no controller is found
|
|
//
|
|
if (EFI_ERROR (Status)) {
|
|
break;
|
|
}
|
|
|
|
if (BarNum == 0) {
|
|
Controller++;
|
|
continue;
|
|
}
|
|
|
|
Private = AllocateCopyPool (sizeof (EMMC_PEIM_HC_PRIVATE_DATA), &gEmmcHcPrivateTemplate);
|
|
if (Private == NULL) {
|
|
Status = EFI_OUT_OF_RESOURCES;
|
|
break;
|
|
}
|
|
|
|
Private->BlkIoPpiList.Ppi = (VOID *)&Private->BlkIoPpi;
|
|
Private->BlkIo2PpiList.Ppi = (VOID *)&Private->BlkIo2Ppi;
|
|
//
|
|
// Initialize the memory pool which will be used in all transactions.
|
|
//
|
|
Status = EmmcPeimInitMemPool (Private);
|
|
if (EFI_ERROR (Status)) {
|
|
Status = EFI_OUT_OF_RESOURCES;
|
|
break;
|
|
}
|
|
|
|
for (Index = 0; Index < BarNum; Index++) {
|
|
Status = EmmcPeimHcGetCapability (MmioBase[Index], &Capability);
|
|
if (EFI_ERROR (Status)) {
|
|
continue;
|
|
}
|
|
|
|
if (Capability.SlotType != 0x1) {
|
|
DEBUG ((DEBUG_INFO, "The slot at 0x%x is not embedded slot type\n", MmioBase[Index]));
|
|
Status = EFI_UNSUPPORTED;
|
|
continue;
|
|
}
|
|
|
|
Status = EmmcPeimHcReset (MmioBase[Index]);
|
|
if (EFI_ERROR (Status)) {
|
|
continue;
|
|
}
|
|
|
|
Status = EmmcPeimHcCardDetect (MmioBase[Index]);
|
|
if (EFI_ERROR (Status)) {
|
|
continue;
|
|
}
|
|
|
|
Status = EmmcPeimHcInitHost (MmioBase[Index]);
|
|
if (EFI_ERROR (Status)) {
|
|
continue;
|
|
}
|
|
|
|
SlotNum = Private->SlotNum;
|
|
Slot = &Private->Slot[SlotNum];
|
|
CopyMem (Slot, &gEmmcHcSlotTemplate, sizeof (EMMC_PEIM_HC_SLOT));
|
|
Slot->Private = Private;
|
|
Slot->EmmcHcBase = MmioBase[Index];
|
|
CopyMem (&Slot->Capability, &Capability, sizeof (Capability));
|
|
|
|
Status = EmmcPeimIdentification (Slot);
|
|
if (EFI_ERROR (Status)) {
|
|
continue;
|
|
}
|
|
|
|
ExtCsd = &Slot->ExtCsd;
|
|
if (ExtCsd->ExtCsdRev < 5) {
|
|
DEBUG ((DEBUG_ERROR, "The EMMC device version is too low, we don't support!!!\n"));
|
|
Status = EFI_UNSUPPORTED;
|
|
continue;
|
|
}
|
|
|
|
if ((ExtCsd->PartitioningSupport & BIT0) != BIT0) {
|
|
DEBUG ((DEBUG_ERROR, "The EMMC device doesn't support Partition Feature!!!\n"));
|
|
Status = EFI_UNSUPPORTED;
|
|
continue;
|
|
}
|
|
|
|
for (PartitionIndex = 0; PartitionIndex < EMMC_PEIM_MAX_PARTITIONS; PartitionIndex++) {
|
|
switch (PartitionIndex) {
|
|
case EmmcPartitionUserData:
|
|
SecCount = *(UINT32 *)&ExtCsd->SecCount;
|
|
Capacity = MultU64x32 ((UINT64)SecCount, 0x200);
|
|
break;
|
|
case EmmcPartitionBoot1:
|
|
case EmmcPartitionBoot2:
|
|
Capacity = ExtCsd->BootSizeMult * SIZE_128KB;
|
|
break;
|
|
case EmmcPartitionRPMB:
|
|
Capacity = ExtCsd->RpmbSizeMult * SIZE_128KB;
|
|
break;
|
|
case EmmcPartitionGP1:
|
|
GpSizeMult = (ExtCsd->GpSizeMult[0] | (ExtCsd->GpSizeMult[1] << 8) | (ExtCsd->GpSizeMult[2] << 16));
|
|
Capacity = MultU64x32 (MultU64x32 (MultU64x32 ((UINT64)GpSizeMult, ExtCsd->HcWpGrpSize), ExtCsd->HcEraseGrpSize), SIZE_512KB);
|
|
break;
|
|
case EmmcPartitionGP2:
|
|
GpSizeMult = (ExtCsd->GpSizeMult[3] | (ExtCsd->GpSizeMult[4] << 8) | (ExtCsd->GpSizeMult[5] << 16));
|
|
Capacity = MultU64x32 (MultU64x32 (MultU64x32 ((UINT64)GpSizeMult, ExtCsd->HcWpGrpSize), ExtCsd->HcEraseGrpSize), SIZE_512KB);
|
|
break;
|
|
case EmmcPartitionGP3:
|
|
GpSizeMult = (ExtCsd->GpSizeMult[6] | (ExtCsd->GpSizeMult[7] << 8) | (ExtCsd->GpSizeMult[8] << 16));
|
|
Capacity = MultU64x32 (MultU64x32 (MultU64x32 ((UINT64)GpSizeMult, ExtCsd->HcWpGrpSize), ExtCsd->HcEraseGrpSize), SIZE_512KB);
|
|
break;
|
|
case EmmcPartitionGP4:
|
|
GpSizeMult = (ExtCsd->GpSizeMult[9] | (ExtCsd->GpSizeMult[10] << 8) | (ExtCsd->GpSizeMult[11] << 16));
|
|
Capacity = MultU64x32 (MultU64x32 (MultU64x32 ((UINT64)GpSizeMult, ExtCsd->HcWpGrpSize), ExtCsd->HcEraseGrpSize), SIZE_512KB);
|
|
break;
|
|
default:
|
|
ASSERT (FALSE);
|
|
continue;
|
|
}
|
|
|
|
MediaNum = Slot->MediaNum;
|
|
if (Capacity != 0) {
|
|
Slot->Media[MediaNum].LastBlock = DivU64x32 (Capacity, Slot->Media[MediaNum].BlockSize) - 1;
|
|
Slot->PartitionType[MediaNum] = PartitionIndex;
|
|
Private->TotalBlkIoDevices++;
|
|
Slot->MediaNum++;
|
|
}
|
|
}
|
|
|
|
Private->SlotNum++;
|
|
}
|
|
|
|
Controller++;
|
|
|
|
if (!EFI_ERROR (Status)) {
|
|
PeiServicesInstallPpi (&Private->BlkIoPpiList);
|
|
PeiServicesNotifyPpi (&Private->EndOfPeiNotifyList);
|
|
} else {
|
|
if (Private->Pool->Head != NULL) {
|
|
EmmcPeimFreeMemPool (Private->Pool);
|
|
}
|
|
}
|
|
}
|
|
|
|
return EFI_SUCCESS;
|
|
}
|