mirror of
https://github.com/acidanthera/audk.git
synced 2025-07-28 08:04:07 +02:00
Update CpuIo2Dxe to also support IPF
Clean up CpuIo2Dxe to follow the same design as the IntelFrameworkModulePlg module CpuIoDxe and the UefiCpuPkg module CpuIo2Smm git-svn-id: https://edk2.svn.sourceforge.net/svnroot/edk2/trunk/edk2@9761 6f19259b-4bc3-4df7-8a09-765794883524
This commit is contained in:
parent
7a7f916a70
commit
3ea1d3e611
@ -1,21 +1,80 @@
|
|||||||
/** @file
|
/** @file
|
||||||
Produces the CPU I/O 2 Protocol.
|
Produces the CPU I/O 2 Protocol.
|
||||||
|
|
||||||
Copyright (c) 2009, Intel Corporation
|
Copyright (c) 2009 - 2010, Intel Corporation
|
||||||
All rights reserved. This program and the accompanying materials
|
All rights reserved. This program and the accompanying materials
|
||||||
are licensed and made available under the terms and conditions of the BSD License
|
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
|
which accompanies this distribution. The full text of the license may be found at
|
||||||
http://opensource.org/licenses/bsd-license.php
|
http://opensource.org/licenses/bsd-license.php
|
||||||
|
|
||||||
THE PROGRAM IS DISTRIBUTED UNDER THE BSD LICENSE ON AN "AS IS" BASIS,
|
THE PROGRAM IS DISTRIBUTED UNDER THE BSD LICENSE ON AN "AS IS" BASIS,
|
||||||
WITHOUT WARRANTIES OR REPRESENTATIONS OF ANY KIND, EITHER EXPRESS OR IMPLIED.
|
WITHOUT WARRANTIES OR REPRESENTATIONS OF ANY KIND, EITHER EXPRESS OR IMPLIED.
|
||||||
|
|
||||||
**/
|
**/
|
||||||
|
|
||||||
#include "CpuIo2Dxe.h"
|
#include <PiDxe.h>
|
||||||
|
|
||||||
EFI_HANDLE mHandle = NULL;
|
#include <Protocol/CpuIo2.h>
|
||||||
EFI_CPU_IO2_PROTOCOL mCpuIo = {
|
|
||||||
|
#include <Library/BaseLib.h>
|
||||||
|
#include <Library/DebugLib.h>
|
||||||
|
#include <Library/IoLib.h>
|
||||||
|
#include <Library/UefiBootServicesTableLib.h>
|
||||||
|
|
||||||
|
#define MAX_IO_PORT_ADDRESS 0xFFFF
|
||||||
|
|
||||||
|
//
|
||||||
|
// Function Prototypes
|
||||||
|
//
|
||||||
|
EFI_STATUS
|
||||||
|
EFIAPI
|
||||||
|
CpuMemoryServiceRead (
|
||||||
|
IN EFI_CPU_IO2_PROTOCOL *This,
|
||||||
|
IN EFI_CPU_IO_PROTOCOL_WIDTH Width,
|
||||||
|
IN UINT64 Address,
|
||||||
|
IN UINTN Count,
|
||||||
|
OUT VOID *Buffer
|
||||||
|
);
|
||||||
|
|
||||||
|
EFI_STATUS
|
||||||
|
EFIAPI
|
||||||
|
CpuMemoryServiceWrite (
|
||||||
|
IN EFI_CPU_IO2_PROTOCOL *This,
|
||||||
|
IN EFI_CPU_IO_PROTOCOL_WIDTH Width,
|
||||||
|
IN UINT64 Address,
|
||||||
|
IN UINTN Count,
|
||||||
|
IN VOID *Buffer
|
||||||
|
);
|
||||||
|
|
||||||
|
EFI_STATUS
|
||||||
|
EFIAPI
|
||||||
|
CpuIoServiceRead (
|
||||||
|
IN EFI_CPU_IO2_PROTOCOL *This,
|
||||||
|
IN EFI_CPU_IO_PROTOCOL_WIDTH Width,
|
||||||
|
IN UINT64 Address,
|
||||||
|
IN UINTN Count,
|
||||||
|
OUT VOID *Buffer
|
||||||
|
);
|
||||||
|
|
||||||
|
EFI_STATUS
|
||||||
|
EFIAPI
|
||||||
|
CpuIoServiceWrite (
|
||||||
|
IN EFI_CPU_IO2_PROTOCOL *This,
|
||||||
|
IN EFI_CPU_IO_PROTOCOL_WIDTH Width,
|
||||||
|
IN UINT64 Address,
|
||||||
|
IN UINTN Count,
|
||||||
|
IN VOID *Buffer
|
||||||
|
);
|
||||||
|
|
||||||
|
//
|
||||||
|
// Handle for the CPU I/O 2 Protocol
|
||||||
|
//
|
||||||
|
EFI_HANDLE mHandle = NULL;
|
||||||
|
|
||||||
|
//
|
||||||
|
// CPU I/O 2 Protocol instance
|
||||||
|
//
|
||||||
|
EFI_CPU_IO2_PROTOCOL mCpuIo2 = {
|
||||||
{
|
{
|
||||||
CpuMemoryServiceRead,
|
CpuMemoryServiceRead,
|
||||||
CpuMemoryServiceWrite
|
CpuMemoryServiceWrite
|
||||||
@ -26,519 +85,485 @@ EFI_CPU_IO2_PROTOCOL mCpuIo = {
|
|||||||
}
|
}
|
||||||
};
|
};
|
||||||
|
|
||||||
|
//
|
||||||
|
// Lookup table for increment values based on transfer widths
|
||||||
|
//
|
||||||
|
UINT8 mInStride[] = {
|
||||||
|
1, // EfiCpuIoWidthUint8
|
||||||
|
2, // EfiCpuIoWidthUint16
|
||||||
|
4, // EfiCpuIoWidthUint32
|
||||||
|
8, // EfiCpuIoWidthUint64
|
||||||
|
0, // EfiCpuIoWidthFifoUint8
|
||||||
|
0, // EfiCpuIoWidthFifoUint16
|
||||||
|
0, // EfiCpuIoWidthFifoUint32
|
||||||
|
0, // EfiCpuIoWidthFifoUint64
|
||||||
|
1, // EfiCpuIoWidthFillUint8
|
||||||
|
2, // EfiCpuIoWidthFillUint16
|
||||||
|
4, // EfiCpuIoWidthFillUint32
|
||||||
|
8 // EfiCpuIoWidthFillUint64
|
||||||
|
};
|
||||||
|
|
||||||
|
//
|
||||||
|
// Lookup table for increment values based on transfer widths
|
||||||
|
//
|
||||||
|
UINT8 mOutStride[] = {
|
||||||
|
1, // EfiCpuIoWidthUint8
|
||||||
|
2, // EfiCpuIoWidthUint16
|
||||||
|
4, // EfiCpuIoWidthUint32
|
||||||
|
8, // EfiCpuIoWidthUint64
|
||||||
|
1, // EfiCpuIoWidthFifoUint8
|
||||||
|
2, // EfiCpuIoWidthFifoUint16
|
||||||
|
4, // EfiCpuIoWidthFifoUint32
|
||||||
|
8, // EfiCpuIoWidthFifoUint64
|
||||||
|
0, // EfiCpuIoWidthFillUint8
|
||||||
|
0, // EfiCpuIoWidthFillUint16
|
||||||
|
0, // EfiCpuIoWidthFillUint32
|
||||||
|
0 // EfiCpuIoWidthFillUint64
|
||||||
|
};
|
||||||
|
|
||||||
/**
|
/**
|
||||||
Worker function to check the validation of parameters for CPU I/O interface functions.
|
Check parameters to a CPU I/O 2 Protocol service request.
|
||||||
|
|
||||||
This function check the validation of parameters for CPU I/O interface functions.
|
The I/O operations are carried out exactly as requested. The caller is responsible
|
||||||
|
for satisfying any alignment and I/O width restrictions that a PI System on a
|
||||||
|
platform might require. For example on some platforms, width requests of
|
||||||
|
EfiCpuIoWidthUint64 do not work. Misaligned buffers, on the other hand, will
|
||||||
|
be handled by the driver.
|
||||||
|
|
||||||
|
@param[in] MmioOperation TRUE for an MMIO operation, FALSE for I/O Port operation.
|
||||||
|
@param[in] Width Signifies the width of the I/O or Memory operation.
|
||||||
|
@param[in] Address The base address of the I/O operation.
|
||||||
|
@param[in] Count The number of I/O operations to perform. The number of
|
||||||
|
bytes moved is Width size * Count, starting at Address.
|
||||||
|
@param[in] Buffer For read operations, the destination buffer to store the results.
|
||||||
|
For write operations, the source buffer from which to write data.
|
||||||
|
|
||||||
@param Width Width of the Mmio/Io operation
|
@retval EFI_SUCCESS The parameters for this request pass the checks.
|
||||||
@param Address Base address of the Mmio/Io operation
|
@retval EFI_INVALID_PARAMETER Width is invalid for this PI system.
|
||||||
@param Count Count of the number of accesses to perform
|
@retval EFI_INVALID_PARAMETER Buffer is NULL.
|
||||||
@param Buffer Pointer to the buffer to read from memory
|
@retval EFI_UNSUPPORTED The Buffer is not aligned for the given Width.
|
||||||
@param Limit Maximum address supported
|
@retval EFI_UNSUPPORTED The address range specified by Address, Width,
|
||||||
|
and Count is not valid for this PI system.
|
||||||
@retval EFI_INVALID_PARAMETER Buffer is NULL
|
|
||||||
@retval EFI_UNSUPPORTED The address range specified by Width, Address and Count is invalid
|
|
||||||
@retval EFI_UNSUPPORTED The memory buffer is not aligned
|
|
||||||
@retval EFI_SUCCESS Parameters are valid
|
|
||||||
|
|
||||||
**/
|
**/
|
||||||
EFI_STATUS
|
EFI_STATUS
|
||||||
CpuIoCheckParameter (
|
CpuIoCheckParameter (
|
||||||
|
IN BOOLEAN MmioOperation,
|
||||||
IN EFI_CPU_IO_PROTOCOL_WIDTH Width,
|
IN EFI_CPU_IO_PROTOCOL_WIDTH Width,
|
||||||
IN UINT64 Address,
|
IN UINT64 Address,
|
||||||
IN UINTN Count,
|
IN UINTN Count,
|
||||||
IN VOID *Buffer,
|
IN VOID *Buffer
|
||||||
IN UINT64 Limit
|
|
||||||
)
|
)
|
||||||
{
|
{
|
||||||
UINTN AlignMask;
|
UINT64 MaxCount;
|
||||||
|
UINT64 Limit;
|
||||||
|
|
||||||
|
//
|
||||||
|
// Check to see if Buffer is NULL
|
||||||
|
//
|
||||||
if (Buffer == NULL) {
|
if (Buffer == NULL) {
|
||||||
return EFI_INVALID_PARAMETER;
|
return EFI_INVALID_PARAMETER;
|
||||||
}
|
}
|
||||||
|
|
||||||
if (Address > Limit) {
|
//
|
||||||
return EFI_UNSUPPORTED;
|
// Check to see if Width is in the valid range
|
||||||
|
//
|
||||||
|
if (Width < 0 || Width >= EfiCpuIoWidthMaximum) {
|
||||||
|
return EFI_INVALID_PARAMETER;
|
||||||
}
|
}
|
||||||
|
|
||||||
//
|
//
|
||||||
// For FiFo type, the target address won't increase during the access,
|
// For FIFO type, the target address won't increase during the access,
|
||||||
// so treat count as 1
|
// so treat Count as 1
|
||||||
//
|
//
|
||||||
if (Width >= EfiCpuIoWidthFifoUint8 && Width <= EfiCpuIoWidthFifoUint64) {
|
if (Width >= EfiCpuIoWidthFifoUint8 && Width <= EfiCpuIoWidthFifoUint64) {
|
||||||
Count = 1;
|
Count = 1;
|
||||||
}
|
}
|
||||||
|
|
||||||
Width = (EFI_CPU_IO_PROTOCOL_WIDTH) (Width & 0x03);
|
|
||||||
if (Address - 1 + (UINT32)(1 << Width) * Count > Limit) {
|
|
||||||
return EFI_UNSUPPORTED;
|
|
||||||
}
|
|
||||||
|
|
||||||
AlignMask = (1 << Width) - 1;
|
|
||||||
if ((UINTN) Buffer & AlignMask) {
|
|
||||||
return EFI_UNSUPPORTED;
|
|
||||||
}
|
|
||||||
|
|
||||||
return EFI_SUCCESS;
|
|
||||||
}
|
|
||||||
|
|
||||||
/**
|
|
||||||
Worker function to update access width and count for access to the unaligned address.
|
|
||||||
Unaligned Io/MmIo address access, break up the request into word by word or byte by byte.
|
|
||||||
|
|
||||||
@param Address Base address of the Mmio/Io operation
|
|
||||||
@param PtrWidth Pointer to width of the Mmio/Io operation
|
|
||||||
Out, this value will be updated for access to the unaligned address.
|
|
||||||
@param PtrCount Pointer to count of the number of accesses to perform
|
|
||||||
Out, this value will be updated for access to the unaligned address.
|
|
||||||
**/
|
|
||||||
VOID
|
|
||||||
CpuIoUpdateWidthCount (
|
|
||||||
IN UINT64 Address,
|
|
||||||
IN OUT EFI_CPU_IO_PROTOCOL_WIDTH *PtrWidth,
|
|
||||||
IN OUT UINTN *PtrCount
|
|
||||||
)
|
|
||||||
{
|
|
||||||
EFI_CPU_IO_PROTOCOL_WIDTH BufferWidth;
|
|
||||||
UINTN BufferCount;
|
|
||||||
|
|
||||||
BufferWidth = *PtrWidth;
|
|
||||||
BufferCount = *PtrCount;
|
|
||||||
|
|
||||||
switch (BufferWidth) {
|
|
||||||
case EfiCpuIoWidthUint8:
|
|
||||||
break;
|
|
||||||
|
|
||||||
case EfiCpuIoWidthUint16:
|
|
||||||
if ((Address & 0x01) == 0) {
|
|
||||||
break;
|
|
||||||
} else {
|
|
||||||
BufferCount = BufferCount * 2;
|
|
||||||
BufferWidth = EfiCpuIoWidthUint8;
|
|
||||||
}
|
|
||||||
break;
|
|
||||||
|
|
||||||
case EfiCpuIoWidthUint32:
|
|
||||||
if ((Address & 0x03) == 0) {
|
|
||||||
break;
|
|
||||||
} else if ((Address & 0x01) == 0) {
|
|
||||||
BufferCount = BufferCount * 2;
|
|
||||||
BufferWidth = EfiCpuIoWidthUint16;
|
|
||||||
} else {
|
|
||||||
BufferCount = BufferCount * 4;
|
|
||||||
BufferWidth = EfiCpuIoWidthUint8;
|
|
||||||
}
|
|
||||||
break;
|
|
||||||
|
|
||||||
case EfiCpuIoWidthUint64:
|
|
||||||
if ((Address & 0x07) == 0) {
|
|
||||||
break;
|
|
||||||
} else if ((Address & 0x03) == 0) {
|
|
||||||
BufferCount = BufferCount * 2;
|
|
||||||
BufferWidth = EfiCpuIoWidthUint32;
|
|
||||||
} else if ((Address & 0x01) == 0) {
|
|
||||||
BufferCount = BufferCount * 4;
|
|
||||||
BufferWidth = EfiCpuIoWidthUint16;
|
|
||||||
} else {
|
|
||||||
BufferCount = BufferCount * 8;
|
|
||||||
BufferWidth = EfiCpuIoWidthUint8;
|
|
||||||
}
|
|
||||||
break;
|
|
||||||
|
|
||||||
default:
|
|
||||||
return;
|
|
||||||
}
|
|
||||||
|
|
||||||
*PtrWidth = BufferWidth;
|
|
||||||
*PtrCount = BufferCount;
|
|
||||||
|
|
||||||
return;
|
|
||||||
}
|
|
||||||
|
|
||||||
/**
|
|
||||||
Worker function to perform memory mapped I/O read/write
|
|
||||||
|
|
||||||
This function provides private services to perform memory mapped I/O read/write.
|
|
||||||
|
|
||||||
@param Width Width of the memory mapped I/O operation
|
|
||||||
@param Count Count of the number of accesses to perform
|
|
||||||
@param DestinationStrideFlag Boolean flag indicates if the destination is to be incremented
|
|
||||||
@param Destination Destination of the memory mapped I/O operation
|
|
||||||
@param SourceStrideFlag Boolean flag indicates if the source is to be incremented
|
|
||||||
@param Source Source of the memory mapped I/O operation
|
|
||||||
|
|
||||||
@retval EFI_SUCCESS Successful operation
|
|
||||||
@retval EFI_INVALID_PARAMETER Width is invalid
|
|
||||||
|
|
||||||
**/
|
|
||||||
EFI_STATUS
|
|
||||||
CpuIoMemRW (
|
|
||||||
IN EFI_CPU_IO_PROTOCOL_WIDTH Width,
|
|
||||||
IN UINTN Count,
|
|
||||||
IN BOOLEAN DestinationStrideFlag,
|
|
||||||
OUT PTR Destination,
|
|
||||||
IN BOOLEAN SourceStrideFlag,
|
|
||||||
IN PTR Source
|
|
||||||
)
|
|
||||||
{
|
|
||||||
UINTN Stride;
|
|
||||||
UINTN DestinationStride;
|
|
||||||
UINTN SourceStride;
|
|
||||||
|
|
||||||
Width = (EFI_CPU_IO_PROTOCOL_WIDTH) (Width & 0x03);
|
|
||||||
Stride = (UINT32)(1 << Width);
|
|
||||||
DestinationStride = DestinationStrideFlag ? Stride : 0;
|
|
||||||
SourceStride = SourceStrideFlag ? Stride : 0;
|
|
||||||
|
|
||||||
//
|
//
|
||||||
// Loop for each iteration and move the data
|
// Check to see if Width is in the valid range for I/O Port operations
|
||||||
//
|
//
|
||||||
switch (Width) {
|
Width = Width & 0x03;
|
||||||
case EfiCpuIoWidthUint8:
|
if (!MmioOperation && (Width == EfiCpuIoWidthUint64)) {
|
||||||
for (; Count > 0; Count--, Destination.Buf += DestinationStride, Source.Buf += SourceStride) {
|
|
||||||
MmioWrite8((UINTN)Destination.Ui8 , MmioRead8((UINTN)Source.Ui8));
|
|
||||||
}
|
|
||||||
break;
|
|
||||||
|
|
||||||
case EfiCpuIoWidthUint16:
|
|
||||||
for (; Count > 0; Count--, Destination.Buf += DestinationStride, Source.Buf += SourceStride) {
|
|
||||||
MmioWrite16((UINTN)Destination.Ui16 , MmioRead16((UINTN)Source.Ui16));
|
|
||||||
}
|
|
||||||
break;
|
|
||||||
|
|
||||||
case EfiCpuIoWidthUint32:
|
|
||||||
for (; Count > 0; Count--, Destination.Buf += DestinationStride, Source.Buf += SourceStride) {
|
|
||||||
MmioWrite32((UINTN)Destination.Ui32 , MmioRead32((UINTN)Source.Ui32));
|
|
||||||
}
|
|
||||||
break;
|
|
||||||
|
|
||||||
case EfiCpuIoWidthUint64:
|
|
||||||
for (; Count > 0; Count--, Destination.Buf += DestinationStride, Source.Buf += SourceStride) {
|
|
||||||
MmioWrite64((UINTN)Destination.Ui64 , MmioRead64((UINTN)Source.Ui64));
|
|
||||||
}
|
|
||||||
break;
|
|
||||||
|
|
||||||
default:
|
|
||||||
return EFI_INVALID_PARAMETER;
|
return EFI_INVALID_PARAMETER;
|
||||||
}
|
}
|
||||||
|
|
||||||
|
//
|
||||||
|
// Check to see if Address is alligned
|
||||||
|
//
|
||||||
|
if ((Address & (UINT64)(mInStride[Width] - 1)) != 0) {
|
||||||
|
return EFI_UNSUPPORTED;
|
||||||
|
}
|
||||||
|
|
||||||
|
//
|
||||||
|
// Check to see if any address associated with this transfer exceeds the maximum
|
||||||
|
// allowed address. The maximum address implied by the parameters passed in is
|
||||||
|
// Address + Size * Count. If the following condition is met, then the transfer
|
||||||
|
// is not supported.
|
||||||
|
//
|
||||||
|
// Address + Size * Count > (MmioOperation ? MAX_ADDRESS : MAX_IO_PORT_ADDRESS) + 1
|
||||||
|
//
|
||||||
|
// Since MAX_ADDRESS can be the maximum integer value supported by the CPU and Count
|
||||||
|
// can also be the maximum integer value supported by the CPU, this range
|
||||||
|
// check must be adjusted to avoid all oveflow conditions.
|
||||||
|
//
|
||||||
|
// The follwing form of the range check is equivalent but assumes that
|
||||||
|
// MAX_ADDRESS and MAX_IO_PORT_ADDRESS are of the form (2^n - 1).
|
||||||
|
//
|
||||||
|
Limit = (MmioOperation ? MAX_ADDRESS : MAX_IO_PORT_ADDRESS);
|
||||||
|
if (Count == 0) {
|
||||||
|
if (Address > Limit) {
|
||||||
|
return EFI_UNSUPPORTED;
|
||||||
|
}
|
||||||
|
} else {
|
||||||
|
MaxCount = RShiftU64 (Limit, Width);
|
||||||
|
if (MaxCount < (Count - 1)) {
|
||||||
|
return EFI_UNSUPPORTED;
|
||||||
|
}
|
||||||
|
if (Address > LShiftU64 (MaxCount - Count + 1, Width)) {
|
||||||
|
return EFI_UNSUPPORTED;
|
||||||
|
}
|
||||||
|
}
|
||||||
|
|
||||||
|
//
|
||||||
|
// Check to see if Buffer is alligned
|
||||||
|
//
|
||||||
|
if (((UINTN)Buffer & (mInStride[Width] - 1)) != 0) {
|
||||||
|
return EFI_UNSUPPORTED;
|
||||||
|
}
|
||||||
|
|
||||||
return EFI_SUCCESS;
|
return EFI_SUCCESS;
|
||||||
}
|
}
|
||||||
|
|
||||||
/**
|
/**
|
||||||
Enables a driver to read memory-mapped registers in the PI System memory space.
|
Reads memory-mapped registers.
|
||||||
|
|
||||||
@param[in] This A pointer to the EFI_CPU_IO2_PROTOCOL instance.
|
The I/O operations are carried out exactly as requested. The caller is responsible
|
||||||
@param[in] Width Signifies the width of the memory operation.
|
for satisfying any alignment and I/O width restrictions that a PI System on a
|
||||||
@param[in] Address The base address of the memory operation.
|
platform might require. For example on some platforms, width requests of
|
||||||
@param[in] Count The number of memory operations to perform. The number of bytes moved
|
EfiCpuIoWidthUint64 do not work. Misaligned buffers, on the other hand, will
|
||||||
is Width size * Count, starting at Address.
|
be handled by the driver.
|
||||||
@param[out] Buffer The destination buffer to store the results.
|
|
||||||
|
If Width is EfiCpuIoWidthUint8, EfiCpuIoWidthUint16, EfiCpuIoWidthUint32,
|
||||||
|
or EfiCpuIoWidthUint64, then both Address and Buffer are incremented for
|
||||||
|
each of the Count operations that is performed.
|
||||||
|
|
||||||
|
If Width is EfiCpuIoWidthFifoUint8, EfiCpuIoWidthFifoUint16,
|
||||||
|
EfiCpuIoWidthFifoUint32, or EfiCpuIoWidthFifoUint64, then only Buffer is
|
||||||
|
incremented for each of the Count operations that is performed. The read or
|
||||||
|
write operation is performed Count times on the same Address.
|
||||||
|
|
||||||
|
If Width is EfiCpuIoWidthFillUint8, EfiCpuIoWidthFillUint16,
|
||||||
|
EfiCpuIoWidthFillUint32, or EfiCpuIoWidthFillUint64, then only Address is
|
||||||
|
incremented for each of the Count operations that is performed. The read or
|
||||||
|
write operation is performed Count times from the first element of Buffer.
|
||||||
|
|
||||||
|
@param[in] This A pointer to the EFI_CPU_IO2_PROTOCOL instance.
|
||||||
|
@param[in] Width Signifies the width of the I/O or Memory operation.
|
||||||
|
@param[in] Address The base address of the I/O operation.
|
||||||
|
@param[in] Count The number of I/O operations to perform. The number of
|
||||||
|
bytes moved is Width size * Count, starting at Address.
|
||||||
|
@param[out] Buffer For read operations, the destination buffer to store the results.
|
||||||
|
For write operations, the source buffer from which to write data.
|
||||||
|
|
||||||
@retval EFI_SUCCESS The data was read from or written to the EFI system.
|
@retval EFI_SUCCESS The data was read from or written to the PI system.
|
||||||
@retval EFI_INVALID_PARAMETER Width is invalid for this EFI system. Or Buffer is NULL.
|
@retval EFI_INVALID_PARAMETER Width is invalid for this PI system.
|
||||||
@retval EFI_UNSUPPORTED The Buffer is not aligned for the given Width.
|
@retval EFI_INVALID_PARAMETER Buffer is NULL.
|
||||||
Or,The address range specified by Address, Width, and Count is not valid for this EFI system.
|
@retval EFI_UNSUPPORTED The Buffer is not aligned for the given Width.
|
||||||
|
@retval EFI_UNSUPPORTED The address range specified by Address, Width,
|
||||||
|
and Count is not valid for this PI system.
|
||||||
|
|
||||||
**/
|
**/
|
||||||
EFI_STATUS
|
EFI_STATUS
|
||||||
EFIAPI
|
EFIAPI
|
||||||
CpuMemoryServiceRead (
|
CpuMemoryServiceRead (
|
||||||
IN EFI_CPU_IO2_PROTOCOL *This,
|
IN EFI_CPU_IO2_PROTOCOL *This,
|
||||||
IN EFI_CPU_IO_PROTOCOL_WIDTH Width,
|
IN EFI_CPU_IO_PROTOCOL_WIDTH Width,
|
||||||
IN UINT64 Address,
|
IN UINT64 Address,
|
||||||
IN UINTN Count,
|
IN UINTN Count,
|
||||||
OUT VOID *Buffer
|
OUT VOID *Buffer
|
||||||
)
|
)
|
||||||
{
|
{
|
||||||
PTR Source;
|
EFI_STATUS Status;
|
||||||
PTR Destination;
|
UINT8 InStride;
|
||||||
EFI_STATUS Status;
|
UINT8 OutStride;
|
||||||
EFI_CPU_IO_PROTOCOL_WIDTH BufferWidth;
|
EFI_CPU_IO_PROTOCOL_WIDTH OperationWidth;
|
||||||
|
UINT8 *Uint8Buffer;
|
||||||
|
|
||||||
Status = CpuIoCheckParameter (Width, Address, Count, Buffer, MAX_ADDRESS);
|
Status = CpuIoCheckParameter (TRUE, Width, Address, Count, Buffer);
|
||||||
if (EFI_ERROR (Status)) {
|
if (EFI_ERROR (Status)) {
|
||||||
return Status;
|
return Status;
|
||||||
}
|
}
|
||||||
|
|
||||||
Destination.Buf = Buffer;
|
|
||||||
Source.Buf = (VOID *) (UINTN) Address;
|
|
||||||
|
|
||||||
//
|
//
|
||||||
// Support access to unaligned mmio address.
|
// Select loop based on the width of the transfer
|
||||||
// Break up the request into byte by byte
|
|
||||||
//
|
//
|
||||||
BufferWidth = (EFI_CPU_IO_PROTOCOL_WIDTH) (Width & 0x03);
|
InStride = mInStride[Width];
|
||||||
CpuIoUpdateWidthCount (Address, &BufferWidth, &Count);
|
OutStride = mOutStride[Width];
|
||||||
|
OperationWidth = Width & 0x03;
|
||||||
if (Width >= EfiCpuIoWidthUint8 && Width <= EfiCpuIoWidthUint64) {
|
for (Uint8Buffer = Buffer; Count > 0; Address += InStride, Uint8Buffer += OutStride, Count--) {
|
||||||
return CpuIoMemRW (BufferWidth, Count, TRUE, Destination, TRUE, Source);
|
if (OperationWidth == EfiCpuIoWidthUint8) {
|
||||||
|
*Uint8Buffer = MmioRead8 ((UINTN)Address);
|
||||||
|
} else if (OperationWidth == EfiCpuIoWidthUint16) {
|
||||||
|
*((UINT16 *)Uint8Buffer) = MmioRead16 ((UINTN)Address);
|
||||||
|
} else if (OperationWidth == EfiCpuIoWidthUint32) {
|
||||||
|
*((UINT32 *)Uint8Buffer) = MmioRead32 ((UINTN)Address);
|
||||||
|
} else if (OperationWidth == EfiCpuIoWidthUint64) {
|
||||||
|
*((UINT64 *)Uint8Buffer) = MmioRead64 ((UINTN)Address);
|
||||||
|
}
|
||||||
}
|
}
|
||||||
|
return EFI_SUCCESS;
|
||||||
if (Width >= EfiCpuIoWidthFifoUint8 && Width <= EfiCpuIoWidthFifoUint64) {
|
|
||||||
return CpuIoMemRW (BufferWidth, Count, TRUE, Destination, FALSE, Source);
|
|
||||||
}
|
|
||||||
|
|
||||||
if (Width >= EfiCpuIoWidthFillUint8 && Width <= EfiCpuIoWidthFillUint64) {
|
|
||||||
return CpuIoMemRW (BufferWidth, Count, FALSE, Destination, TRUE, Source);
|
|
||||||
}
|
|
||||||
|
|
||||||
return EFI_INVALID_PARAMETER;
|
|
||||||
}
|
}
|
||||||
|
|
||||||
/**
|
/**
|
||||||
Enables a driver to write memory-mapped registers in the PI System memory space.
|
Writes memory-mapped registers.
|
||||||
|
|
||||||
@param[in] This A pointer to the EFI_CPU_IO2_PROTOCOL instance.
|
The I/O operations are carried out exactly as requested. The caller is responsible
|
||||||
@param[in] Width Signifies the width of the memory operation.
|
for satisfying any alignment and I/O width restrictions that a PI System on a
|
||||||
@param[in] Address The base address of the memory operation.
|
platform might require. For example on some platforms, width requests of
|
||||||
@param[in] Count The number of memory operations to perform. The number of bytes moved
|
EfiCpuIoWidthUint64 do not work. Misaligned buffers, on the other hand, will
|
||||||
is Width size * Count, starting at Address.
|
be handled by the driver.
|
||||||
@param[in] Buffer The source buffer from which to write data.
|
|
||||||
|
If Width is EfiCpuIoWidthUint8, EfiCpuIoWidthUint16, EfiCpuIoWidthUint32,
|
||||||
|
or EfiCpuIoWidthUint64, then both Address and Buffer are incremented for
|
||||||
|
each of the Count operations that is performed.
|
||||||
|
|
||||||
|
If Width is EfiCpuIoWidthFifoUint8, EfiCpuIoWidthFifoUint16,
|
||||||
|
EfiCpuIoWidthFifoUint32, or EfiCpuIoWidthFifoUint64, then only Buffer is
|
||||||
|
incremented for each of the Count operations that is performed. The read or
|
||||||
|
write operation is performed Count times on the same Address.
|
||||||
|
|
||||||
|
If Width is EfiCpuIoWidthFillUint8, EfiCpuIoWidthFillUint16,
|
||||||
|
EfiCpuIoWidthFillUint32, or EfiCpuIoWidthFillUint64, then only Address is
|
||||||
|
incremented for each of the Count operations that is performed. The read or
|
||||||
|
write operation is performed Count times from the first element of Buffer.
|
||||||
|
|
||||||
|
@param[in] This A pointer to the EFI_CPU_IO2_PROTOCOL instance.
|
||||||
|
@param[in] Width Signifies the width of the I/O or Memory operation.
|
||||||
|
@param[in] Address The base address of the I/O operation.
|
||||||
|
@param[in] Count The number of I/O operations to perform. The number of
|
||||||
|
bytes moved is Width size * Count, starting at Address.
|
||||||
|
@param[in] Buffer For read operations, the destination buffer to store the results.
|
||||||
|
For write operations, the source buffer from which to write data.
|
||||||
|
|
||||||
@retval EFI_SUCCESS The data was read from or written to the EFI system.
|
@retval EFI_SUCCESS The data was read from or written to the PI system.
|
||||||
@retval EFI_INVALID_PARAMETER Width is invalid for this EFI system. Or Buffer is NULL.
|
@retval EFI_INVALID_PARAMETER Width is invalid for this PI system.
|
||||||
@retval EFI_UNSUPPORTED The Buffer is not aligned for the given Width.
|
@retval EFI_INVALID_PARAMETER Buffer is NULL.
|
||||||
Or,The address range specified by Address, Width, and Count is not valid for this EFI system.
|
@retval EFI_UNSUPPORTED The Buffer is not aligned for the given Width.
|
||||||
|
@retval EFI_UNSUPPORTED The address range specified by Address, Width,
|
||||||
|
and Count is not valid for this PI system.
|
||||||
|
|
||||||
**/
|
**/
|
||||||
EFI_STATUS
|
EFI_STATUS
|
||||||
EFIAPI
|
EFIAPI
|
||||||
CpuMemoryServiceWrite (
|
CpuMemoryServiceWrite (
|
||||||
IN EFI_CPU_IO2_PROTOCOL *This,
|
IN EFI_CPU_IO2_PROTOCOL *This,
|
||||||
IN EFI_CPU_IO_PROTOCOL_WIDTH Width,
|
IN EFI_CPU_IO_PROTOCOL_WIDTH Width,
|
||||||
IN UINT64 Address,
|
IN UINT64 Address,
|
||||||
IN UINTN Count,
|
IN UINTN Count,
|
||||||
IN VOID *Buffer
|
IN VOID *Buffer
|
||||||
)
|
)
|
||||||
{
|
{
|
||||||
PTR Source;
|
|
||||||
PTR Destination;
|
|
||||||
EFI_STATUS Status;
|
EFI_STATUS Status;
|
||||||
EFI_CPU_IO_PROTOCOL_WIDTH BufferWidth;
|
UINT8 InStride;
|
||||||
|
UINT8 OutStride;
|
||||||
|
EFI_CPU_IO_PROTOCOL_WIDTH OperationWidth;
|
||||||
|
UINT8 *Uint8Buffer;
|
||||||
|
|
||||||
Status = CpuIoCheckParameter (Width, Address, Count, Buffer, MAX_ADDRESS);
|
Status = CpuIoCheckParameter (TRUE, Width, Address, Count, Buffer);
|
||||||
if (EFI_ERROR (Status)) {
|
if (EFI_ERROR (Status)) {
|
||||||
return Status;
|
return Status;
|
||||||
}
|
}
|
||||||
|
|
||||||
Destination.Buf = (VOID *) (UINTN) Address;
|
|
||||||
Source.Buf = Buffer;
|
|
||||||
|
|
||||||
//
|
//
|
||||||
// Support access to unaligned mmio address.
|
// Select loop based on the width of the transfer
|
||||||
// Break up the request into byte by byte
|
|
||||||
//
|
//
|
||||||
BufferWidth = (EFI_CPU_IO_PROTOCOL_WIDTH) (Width & 0x03);
|
InStride = mInStride[Width];
|
||||||
CpuIoUpdateWidthCount (Address, &BufferWidth, &Count);
|
OutStride = mOutStride[Width];
|
||||||
|
OperationWidth = Width & 0x03;
|
||||||
if (Width >= EfiCpuIoWidthUint8 && Width <= EfiCpuIoWidthUint64) {
|
for (Uint8Buffer = Buffer; Count > 0; Address += InStride, Uint8Buffer += OutStride, Count--) {
|
||||||
return CpuIoMemRW (BufferWidth, Count, TRUE, Destination, TRUE, Source);
|
if (OperationWidth == EfiCpuIoWidthUint8) {
|
||||||
|
MmioWrite8 ((UINTN)Address, *Uint8Buffer);
|
||||||
|
} else if (OperationWidth == EfiCpuIoWidthUint16) {
|
||||||
|
MmioWrite16 ((UINTN)Address, *((UINT16 *)Uint8Buffer));
|
||||||
|
} else if (OperationWidth == EfiCpuIoWidthUint32) {
|
||||||
|
MmioWrite32 ((UINTN)Address, *((UINT32 *)Uint8Buffer));
|
||||||
|
} else if (OperationWidth == EfiCpuIoWidthUint64) {
|
||||||
|
MmioWrite64 ((UINTN)Address, *((UINT64 *)Uint8Buffer));
|
||||||
|
}
|
||||||
}
|
}
|
||||||
|
return EFI_SUCCESS;
|
||||||
if (Width >= EfiCpuIoWidthFifoUint8 && Width <= EfiCpuIoWidthFifoUint64) {
|
|
||||||
return CpuIoMemRW (BufferWidth, Count, FALSE, Destination, TRUE, Source);
|
|
||||||
}
|
|
||||||
|
|
||||||
if (Width >= EfiCpuIoWidthFillUint8 && Width <= EfiCpuIoWidthFillUint64) {
|
|
||||||
return CpuIoMemRW (BufferWidth, Count, TRUE, Destination, FALSE, Source);
|
|
||||||
}
|
|
||||||
|
|
||||||
return EFI_INVALID_PARAMETER;
|
|
||||||
}
|
}
|
||||||
|
|
||||||
/**
|
/**
|
||||||
Enables a driver to read registers in the PI CPU I/O space.
|
Reads I/O registers.
|
||||||
|
|
||||||
@param[in] This A pointer to the EFI_CPU_IO2_PROTOCOL instance.
|
The I/O operations are carried out exactly as requested. The caller is responsible
|
||||||
@param[in] Width Signifies the width of the I/O operation.
|
for satisfying any alignment and I/O width restrictions that a PI System on a
|
||||||
@param[in] UserAddress The base address of the I/O operation. The caller is responsible
|
platform might require. For example on some platforms, width requests of
|
||||||
for aligning the Address if required.
|
EfiCpuIoWidthUint64 do not work. Misaligned buffers, on the other hand, will
|
||||||
@param[in] Count The number of I/O operations to perform. The number of bytes moved
|
be handled by the driver.
|
||||||
is Width size * Count, starting at Address.
|
|
||||||
@param[out] UserBuffer The destination buffer to store the results.
|
If Width is EfiCpuIoWidthUint8, EfiCpuIoWidthUint16, EfiCpuIoWidthUint32,
|
||||||
|
or EfiCpuIoWidthUint64, then both Address and Buffer are incremented for
|
||||||
|
each of the Count operations that is performed.
|
||||||
|
|
||||||
|
If Width is EfiCpuIoWidthFifoUint8, EfiCpuIoWidthFifoUint16,
|
||||||
|
EfiCpuIoWidthFifoUint32, or EfiCpuIoWidthFifoUint64, then only Buffer is
|
||||||
|
incremented for each of the Count operations that is performed. The read or
|
||||||
|
write operation is performed Count times on the same Address.
|
||||||
|
|
||||||
|
If Width is EfiCpuIoWidthFillUint8, EfiCpuIoWidthFillUint16,
|
||||||
|
EfiCpuIoWidthFillUint32, or EfiCpuIoWidthFillUint64, then only Address is
|
||||||
|
incremented for each of the Count operations that is performed. The read or
|
||||||
|
write operation is performed Count times from the first element of Buffer.
|
||||||
|
|
||||||
|
@param[in] This A pointer to the EFI_CPU_IO2_PROTOCOL instance.
|
||||||
|
@param[in] Width Signifies the width of the I/O or Memory operation.
|
||||||
|
@param[in] Address The base address of the I/O operation.
|
||||||
|
@param[in] Count The number of I/O operations to perform. The number of
|
||||||
|
bytes moved is Width size * Count, starting at Address.
|
||||||
|
@param[out] Buffer For read operations, the destination buffer to store the results.
|
||||||
|
For write operations, the source buffer from which to write data.
|
||||||
|
|
||||||
@retval EFI_SUCCESS The data was read from or written to the EFI system.
|
@retval EFI_SUCCESS The data was read from or written to the PI system.
|
||||||
@retval EFI_INVALID_PARAMETER Width is invalid for this EFI system. Or Buffer is NULL.
|
@retval EFI_INVALID_PARAMETER Width is invalid for this PI system.
|
||||||
@retval EFI_UNSUPPORTED The Buffer is not aligned for the given Width.
|
@retval EFI_INVALID_PARAMETER Buffer is NULL.
|
||||||
Or,The address range specified by Address, Width, and Count is not valid for this EFI system.
|
@retval EFI_UNSUPPORTED The Buffer is not aligned for the given Width.
|
||||||
|
@retval EFI_UNSUPPORTED The address range specified by Address, Width,
|
||||||
|
and Count is not valid for this PI system.
|
||||||
|
|
||||||
**/
|
**/
|
||||||
EFI_STATUS
|
EFI_STATUS
|
||||||
EFIAPI
|
EFIAPI
|
||||||
CpuIoServiceRead (
|
CpuIoServiceRead (
|
||||||
IN EFI_CPU_IO2_PROTOCOL *This,
|
IN EFI_CPU_IO2_PROTOCOL *This,
|
||||||
IN EFI_CPU_IO_PROTOCOL_WIDTH Width,
|
IN EFI_CPU_IO_PROTOCOL_WIDTH Width,
|
||||||
IN UINT64 UserAddress,
|
IN UINT64 Address,
|
||||||
IN UINTN Count,
|
IN UINTN Count,
|
||||||
OUT VOID *UserBuffer
|
OUT VOID *Buffer
|
||||||
)
|
)
|
||||||
{
|
{
|
||||||
UINTN InStride;
|
EFI_STATUS Status;
|
||||||
UINTN OutStride;
|
UINT8 InStride;
|
||||||
UINTN Address;
|
UINT8 OutStride;
|
||||||
PTR Buffer;
|
EFI_CPU_IO_PROTOCOL_WIDTH OperationWidth;
|
||||||
EFI_STATUS Status;
|
UINT8 *Uint8Buffer;
|
||||||
EFI_CPU_IO_PROTOCOL_WIDTH BufferWidth;
|
|
||||||
|
|
||||||
Buffer.Buf = (UINT8 *) UserBuffer;
|
Status = CpuIoCheckParameter (FALSE, Width, Address, Count, Buffer);
|
||||||
|
|
||||||
if (Width >= EfiCpuIoWidthMaximum) {
|
|
||||||
return EFI_INVALID_PARAMETER;
|
|
||||||
}
|
|
||||||
|
|
||||||
Status = CpuIoCheckParameter (Width, UserAddress, Count, UserBuffer, IA32_MAX_IO_ADDRESS);
|
|
||||||
if (EFI_ERROR (Status)) {
|
if (EFI_ERROR (Status)) {
|
||||||
return Status;
|
return Status;
|
||||||
}
|
}
|
||||||
|
|
||||||
//
|
//
|
||||||
// Support access to unaligned IO address.
|
// Select loop based on the width of the transfer
|
||||||
// Break up the request into byte by byte
|
|
||||||
//
|
//
|
||||||
BufferWidth = (EFI_CPU_IO_PROTOCOL_WIDTH) (Width & 0x03);
|
InStride = mInStride[Width];
|
||||||
CpuIoUpdateWidthCount (UserAddress, &BufferWidth, &Count);
|
OutStride = mOutStride[Width];
|
||||||
|
OperationWidth = Width & 0x03;
|
||||||
Address = (UINTN) UserAddress;
|
for (Uint8Buffer = Buffer; Count > 0; Address += InStride, Uint8Buffer += OutStride, Count--) {
|
||||||
InStride = (UINT32)(1 << (BufferWidth & 0x03));
|
if (OperationWidth == EfiCpuIoWidthUint8) {
|
||||||
OutStride = InStride;
|
*Uint8Buffer = IoRead8 ((UINTN)Address);
|
||||||
if (Width >= EfiCpuIoWidthFifoUint8 && Width <= EfiCpuIoWidthFifoUint64) {
|
} else if (OperationWidth == EfiCpuIoWidthUint16) {
|
||||||
InStride = 0;
|
*((UINT16 *)Uint8Buffer) = IoRead16 ((UINTN)Address);
|
||||||
}
|
} else if (OperationWidth == EfiCpuIoWidthUint32) {
|
||||||
|
*((UINT32 *)Uint8Buffer) = IoRead32 ((UINTN)Address);
|
||||||
if (Width >= EfiCpuIoWidthFillUint8 && Width <= EfiCpuIoWidthFillUint64) {
|
|
||||||
OutStride = 0;
|
|
||||||
}
|
|
||||||
|
|
||||||
//
|
|
||||||
// Loop for each iteration and move the data
|
|
||||||
//
|
|
||||||
switch (BufferWidth) {
|
|
||||||
case EfiCpuIoWidthUint8:
|
|
||||||
for (; Count > 0; Count--, Buffer.Buf += OutStride, Address += InStride) {
|
|
||||||
*Buffer.Ui8 = IoRead8 (Address);
|
|
||||||
}
|
}
|
||||||
break;
|
|
||||||
|
|
||||||
case EfiCpuIoWidthUint16:
|
|
||||||
for (; Count > 0; Count--, Buffer.Buf += OutStride, Address += InStride) {
|
|
||||||
*Buffer.Ui16 = IoRead16 (Address);
|
|
||||||
}
|
|
||||||
break;
|
|
||||||
|
|
||||||
case EfiCpuIoWidthUint32:
|
|
||||||
for (; Count > 0; Count--, Buffer.Buf += OutStride, Address += InStride) {
|
|
||||||
*Buffer.Ui32 = IoRead32 (Address);
|
|
||||||
}
|
|
||||||
break;
|
|
||||||
|
|
||||||
default:
|
|
||||||
return EFI_INVALID_PARAMETER;
|
|
||||||
}
|
}
|
||||||
|
|
||||||
return EFI_SUCCESS;
|
return EFI_SUCCESS;
|
||||||
}
|
}
|
||||||
|
|
||||||
/**
|
/**
|
||||||
Enables a driver to write registers in the PI CPU I/O space.
|
Write I/O registers.
|
||||||
|
|
||||||
@param[in] This A pointer to the EFI_CPU_IO2_PROTOCOL instance.
|
The I/O operations are carried out exactly as requested. The caller is responsible
|
||||||
@param[in] Width Signifies the width of the I/O operation.
|
for satisfying any alignment and I/O width restrictions that a PI System on a
|
||||||
@param[in] UserAddress The base address of the I/O operation. The caller is responsible
|
platform might require. For example on some platforms, width requests of
|
||||||
for aligning the Address if required.
|
EfiCpuIoWidthUint64 do not work. Misaligned buffers, on the other hand, will
|
||||||
@param[in] Count The number of I/O operations to perform. The number of bytes moved
|
be handled by the driver.
|
||||||
is Width size * Count, starting at Address.
|
|
||||||
@param[in] UserBuffer The source buffer from which to write data.
|
If Width is EfiCpuIoWidthUint8, EfiCpuIoWidthUint16, EfiCpuIoWidthUint32,
|
||||||
|
or EfiCpuIoWidthUint64, then both Address and Buffer are incremented for
|
||||||
@retval EFI_SUCCESS The data was read from or written to the EFI system.
|
each of the Count operations that is performed.
|
||||||
@retval EFI_INVALID_PARAMETER Width is invalid for this EFI system. Or Buffer is NULL.
|
|
||||||
@retval EFI_UNSUPPORTED The Buffer is not aligned for the given Width.
|
If Width is EfiCpuIoWidthFifoUint8, EfiCpuIoWidthFifoUint16,
|
||||||
Or,The address range specified by Address, Width, and Count is not valid for this EFI system.
|
EfiCpuIoWidthFifoUint32, or EfiCpuIoWidthFifoUint64, then only Buffer is
|
||||||
|
incremented for each of the Count operations that is performed. The read or
|
||||||
|
write operation is performed Count times on the same Address.
|
||||||
|
|
||||||
|
If Width is EfiCpuIoWidthFillUint8, EfiCpuIoWidthFillUint16,
|
||||||
|
EfiCpuIoWidthFillUint32, or EfiCpuIoWidthFillUint64, then only Address is
|
||||||
|
incremented for each of the Count operations that is performed. The read or
|
||||||
|
write operation is performed Count times from the first element of Buffer.
|
||||||
|
|
||||||
|
@param[in] This A pointer to the EFI_CPU_IO2_PROTOCOL instance.
|
||||||
|
@param[in] Width Signifies the width of the I/O or Memory operation.
|
||||||
|
@param[in] Address The base address of the I/O operation.
|
||||||
|
@param[in] Count The number of I/O operations to perform. The number of
|
||||||
|
bytes moved is Width size * Count, starting at Address.
|
||||||
|
@param[in] Buffer For read operations, the destination buffer to store the results.
|
||||||
|
For write operations, the source buffer from which to write data.
|
||||||
|
|
||||||
|
@retval EFI_SUCCESS The data was read from or written to the PI system.
|
||||||
|
@retval EFI_INVALID_PARAMETER Width is invalid for this PI system.
|
||||||
|
@retval EFI_INVALID_PARAMETER Buffer is NULL.
|
||||||
|
@retval EFI_UNSUPPORTED The Buffer is not aligned for the given Width.
|
||||||
|
@retval EFI_UNSUPPORTED The address range specified by Address, Width,
|
||||||
|
and Count is not valid for this PI system.
|
||||||
|
|
||||||
**/
|
**/
|
||||||
EFI_STATUS
|
EFI_STATUS
|
||||||
EFIAPI
|
EFIAPI
|
||||||
CpuIoServiceWrite (
|
CpuIoServiceWrite (
|
||||||
IN EFI_CPU_IO2_PROTOCOL *This,
|
IN EFI_CPU_IO2_PROTOCOL *This,
|
||||||
IN EFI_CPU_IO_PROTOCOL_WIDTH Width,
|
IN EFI_CPU_IO_PROTOCOL_WIDTH Width,
|
||||||
IN UINT64 UserAddress,
|
IN UINT64 Address,
|
||||||
IN UINTN Count,
|
IN UINTN Count,
|
||||||
IN VOID *UserBuffer
|
IN VOID *Buffer
|
||||||
)
|
)
|
||||||
{
|
{
|
||||||
UINTN InStride;
|
EFI_STATUS Status;
|
||||||
UINTN OutStride;
|
UINT8 InStride;
|
||||||
UINTN Address;
|
UINT8 OutStride;
|
||||||
PTR Buffer;
|
EFI_CPU_IO_PROTOCOL_WIDTH OperationWidth;
|
||||||
EFI_STATUS Status;
|
UINT8 *Uint8Buffer;
|
||||||
EFI_CPU_IO_PROTOCOL_WIDTH BufferWidth;
|
|
||||||
|
|
||||||
Buffer.Buf = (UINT8 *) UserBuffer;
|
//
|
||||||
|
// Make sure the parameters are valid
|
||||||
if (Width >= EfiCpuIoWidthMaximum) {
|
//
|
||||||
return EFI_INVALID_PARAMETER;
|
Status = CpuIoCheckParameter (FALSE, Width, Address, Count, Buffer);
|
||||||
}
|
|
||||||
|
|
||||||
Status = CpuIoCheckParameter (Width, UserAddress, Count, UserBuffer, IA32_MAX_IO_ADDRESS);
|
|
||||||
if (EFI_ERROR (Status)) {
|
if (EFI_ERROR (Status)) {
|
||||||
return Status;
|
return Status;
|
||||||
}
|
}
|
||||||
|
|
||||||
//
|
//
|
||||||
// Support access to unaligned IO address.
|
// Select loop based on the width of the transfer
|
||||||
// Break up the request into byte by byte
|
|
||||||
//
|
//
|
||||||
BufferWidth = (EFI_CPU_IO_PROTOCOL_WIDTH) (Width & 0x03);
|
InStride = mInStride[Width];
|
||||||
CpuIoUpdateWidthCount (UserAddress, &BufferWidth, &Count);
|
OutStride = mOutStride[Width];
|
||||||
|
OperationWidth = Width & 0x03;
|
||||||
Address = (UINTN) UserAddress;
|
for (Uint8Buffer = (UINT8 *)Buffer; Count > 0; Address += InStride, Uint8Buffer += OutStride, Count--) {
|
||||||
InStride = (UINT32)(1 << (BufferWidth & 0x03));
|
if (OperationWidth == EfiCpuIoWidthUint8) {
|
||||||
OutStride = InStride;
|
IoWrite8 ((UINTN)Address, *Uint8Buffer);
|
||||||
if (Width >= EfiCpuIoWidthFifoUint8 && Width <= EfiCpuIoWidthFifoUint64) {
|
} else if (OperationWidth == EfiCpuIoWidthUint16) {
|
||||||
InStride = 0;
|
IoWrite16 ((UINTN)Address, *((UINT16 *)Uint8Buffer));
|
||||||
}
|
} else if (OperationWidth == EfiCpuIoWidthUint32) {
|
||||||
|
IoWrite32 ((UINTN)Address, *((UINT32 *)Uint8Buffer));
|
||||||
if (Width >= EfiCpuIoWidthFillUint8 && Width <= EfiCpuIoWidthFillUint64) {
|
|
||||||
OutStride = 0;
|
|
||||||
}
|
|
||||||
|
|
||||||
//
|
|
||||||
// Loop for each iteration and move the data
|
|
||||||
//
|
|
||||||
switch (BufferWidth) {
|
|
||||||
case EfiCpuIoWidthUint8:
|
|
||||||
for (; Count > 0; Count--, Buffer.Buf += OutStride, Address += InStride) {
|
|
||||||
IoWrite8 (Address, *Buffer.Ui8);
|
|
||||||
}
|
}
|
||||||
break;
|
|
||||||
|
|
||||||
case EfiCpuIoWidthUint16:
|
|
||||||
for (; Count > 0; Count--, Buffer.Buf += OutStride, Address += InStride) {
|
|
||||||
IoWrite16 (Address, *Buffer.Ui16);
|
|
||||||
}
|
|
||||||
break;
|
|
||||||
|
|
||||||
case EfiCpuIoWidthUint32:
|
|
||||||
for (; Count > 0; Count--, Buffer.Buf += OutStride, Address += InStride) {
|
|
||||||
IoWrite32 (Address, *Buffer.Ui32);
|
|
||||||
}
|
|
||||||
break;
|
|
||||||
|
|
||||||
default:
|
|
||||||
return EFI_INVALID_PARAMETER;
|
|
||||||
}
|
}
|
||||||
|
|
||||||
return EFI_SUCCESS;
|
return EFI_SUCCESS;
|
||||||
}
|
}
|
||||||
|
|
||||||
/**
|
/**
|
||||||
Entrypoint of CPU I/O 2 DXE module.
|
The user Entry Point for module CpuIo2Dxe. The user code starts with this function.
|
||||||
|
|
||||||
|
@param[in] ImageHandle The firmware allocated handle for the EFI image.
|
||||||
|
@param[in] SystemTable A pointer to the EFI System Table.
|
||||||
|
|
||||||
@param ImageHandle The firmware allocated handle for the EFI image.
|
@retval EFI_SUCCESS The entry point is executed successfully.
|
||||||
@param SystemTable A pointer to the EFI System Table.
|
@retval other Some error occurs when executing this entry point.
|
||||||
|
|
||||||
@retval EFI_SUCCESS The entry point is executed successfully.
|
|
||||||
|
|
||||||
**/
|
**/
|
||||||
EFI_STATUS
|
EFI_STATUS
|
||||||
@ -548,13 +573,13 @@ CpuIo2Initialize (
|
|||||||
IN EFI_SYSTEM_TABLE *SystemTable
|
IN EFI_SYSTEM_TABLE *SystemTable
|
||||||
)
|
)
|
||||||
{
|
{
|
||||||
EFI_STATUS Status;
|
EFI_STATUS Status;
|
||||||
|
|
||||||
Status = gBS->InstallProtocolInterface (
|
ASSERT_PROTOCOL_ALREADY_INSTALLED (NULL, &gEfiCpuIo2ProtocolGuid);
|
||||||
|
Status = gBS->InstallMultipleProtocolInterfaces (
|
||||||
&mHandle,
|
&mHandle,
|
||||||
&gEfiCpuIo2ProtocolGuid,
|
&gEfiCpuIo2ProtocolGuid, &mCpuIo2,
|
||||||
EFI_NATIVE_INTERFACE,
|
NULL
|
||||||
&mCpuIo
|
|
||||||
);
|
);
|
||||||
ASSERT_EFI_ERROR (Status);
|
ASSERT_EFI_ERROR (Status);
|
||||||
|
|
||||||
|
@ -1,142 +0,0 @@
|
|||||||
/** @file
|
|
||||||
Internal include file for the CPU I/O 2 Protocol implementation.
|
|
||||||
|
|
||||||
Copyright (c) 2009, Intel Corporation
|
|
||||||
All rights reserved. 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.
|
|
||||||
|
|
||||||
**/
|
|
||||||
|
|
||||||
#ifndef _CPU_IO2_H_
|
|
||||||
#define _CPU_IO2_H_
|
|
||||||
|
|
||||||
#include <Protocol/CpuIo2.h>
|
|
||||||
|
|
||||||
#include <Library/DebugLib.h>
|
|
||||||
#include <Library/IoLib.h>
|
|
||||||
#include <Library/UefiDriverEntryPoint.h>
|
|
||||||
#include <Library/UefiBootServicesTableLib.h>
|
|
||||||
|
|
||||||
#define IA32_MAX_IO_ADDRESS 0xFFFF
|
|
||||||
|
|
||||||
typedef union {
|
|
||||||
UINT8 volatile *Buf;
|
|
||||||
UINT8 volatile *Ui8;
|
|
||||||
UINT16 volatile *Ui16;
|
|
||||||
UINT32 volatile *Ui32;
|
|
||||||
UINT64 volatile *Ui64;
|
|
||||||
UINTN volatile Ui;
|
|
||||||
} PTR;
|
|
||||||
|
|
||||||
/**
|
|
||||||
Enables a driver to read memory-mapped registers in the PI System memory space.
|
|
||||||
|
|
||||||
@param[in] This A pointer to the EFI_CPU_IO2_PROTOCOL instance.
|
|
||||||
@param[in] Width Signifies the width of the memory operation.
|
|
||||||
@param[in] Address The base address of the memory operation.
|
|
||||||
@param[in] Count The number of memory operations to perform. The number of bytes moved
|
|
||||||
is Width size * Count, starting at Address.
|
|
||||||
@param[out] Buffer The destination buffer to store the results.
|
|
||||||
|
|
||||||
@retval EFI_SUCCESS The data was read from or written to the EFI system.
|
|
||||||
@retval EFI_INVALID_PARAMETER Width is invalid for this EFI system. Or Buffer is NULL.
|
|
||||||
@retval EFI_UNSUPPORTED The Buffer is not aligned for the given Width.
|
|
||||||
Or,The address range specified by Address, Width, and Count is not valid for this EFI system.
|
|
||||||
|
|
||||||
**/
|
|
||||||
EFI_STATUS
|
|
||||||
EFIAPI
|
|
||||||
CpuMemoryServiceRead (
|
|
||||||
IN EFI_CPU_IO2_PROTOCOL *This,
|
|
||||||
IN EFI_CPU_IO_PROTOCOL_WIDTH Width,
|
|
||||||
IN UINT64 Address,
|
|
||||||
IN UINTN Count,
|
|
||||||
OUT VOID *Buffer
|
|
||||||
);
|
|
||||||
|
|
||||||
/**
|
|
||||||
Enables a driver to write memory-mapped registers in the PI System memory space.
|
|
||||||
|
|
||||||
@param[in] This A pointer to the EFI_CPU_IO2_PROTOCOL instance.
|
|
||||||
@param[in] Width Signifies the width of the memory operation.
|
|
||||||
@param[in] Address The base address of the memory operation.
|
|
||||||
@param[in] Count The number of memory operations to perform. The number of bytes moved
|
|
||||||
is Width size * Count, starting at Address.
|
|
||||||
@param[in] Buffer The source buffer from which to write data.
|
|
||||||
|
|
||||||
@retval EFI_SUCCESS The data was read from or written to the EFI system.
|
|
||||||
@retval EFI_INVALID_PARAMETER Width is invalid for this EFI system. Or Buffer is NULL.
|
|
||||||
@retval EFI_UNSUPPORTED The Buffer is not aligned for the given Width.
|
|
||||||
Or,The address range specified by Address, Width, and Count is not valid for this EFI system.
|
|
||||||
|
|
||||||
**/
|
|
||||||
EFI_STATUS
|
|
||||||
EFIAPI
|
|
||||||
CpuMemoryServiceWrite (
|
|
||||||
IN EFI_CPU_IO2_PROTOCOL *This,
|
|
||||||
IN EFI_CPU_IO_PROTOCOL_WIDTH Width,
|
|
||||||
IN UINT64 Address,
|
|
||||||
IN UINTN Count,
|
|
||||||
IN VOID *Buffer
|
|
||||||
);
|
|
||||||
|
|
||||||
/**
|
|
||||||
Enables a driver to read registers in the PI CPU I/O space.
|
|
||||||
|
|
||||||
@param[in] This A pointer to the EFI_CPU_IO2_PROTOCOL instance.
|
|
||||||
@param[in] Width Signifies the width of the I/O operation.
|
|
||||||
@param[in] UserAddress The base address of the I/O operation. The caller is responsible
|
|
||||||
for aligning the Address if required.
|
|
||||||
@param[in] Count The number of I/O operations to perform. The number of bytes moved
|
|
||||||
is Width size * Count, starting at Address.
|
|
||||||
@param[out] UserBuffer The destination buffer to store the results.
|
|
||||||
|
|
||||||
@retval EFI_SUCCESS The data was read from or written to the EFI system.
|
|
||||||
@retval EFI_INVALID_PARAMETER Width is invalid for this EFI system. Or Buffer is NULL.
|
|
||||||
@retval EFI_UNSUPPORTED The Buffer is not aligned for the given Width.
|
|
||||||
Or,The address range specified by Address, Width, and Count is not valid for this EFI system.
|
|
||||||
|
|
||||||
**/
|
|
||||||
EFI_STATUS
|
|
||||||
EFIAPI
|
|
||||||
CpuIoServiceRead (
|
|
||||||
IN EFI_CPU_IO2_PROTOCOL *This,
|
|
||||||
IN EFI_CPU_IO_PROTOCOL_WIDTH Width,
|
|
||||||
IN UINT64 UserAddress,
|
|
||||||
IN UINTN Count,
|
|
||||||
OUT VOID *UserBuffer
|
|
||||||
);
|
|
||||||
|
|
||||||
/**
|
|
||||||
Enables a driver to write registers in the PI CPU I/O space.
|
|
||||||
|
|
||||||
@param[in] This A pointer to the EFI_CPU_IO2_PROTOCOL instance.
|
|
||||||
@param[in] Width Signifies the width of the I/O operation.
|
|
||||||
@param[in] UserAddress The base address of the I/O operation. The caller is responsible
|
|
||||||
for aligning the Address if required.
|
|
||||||
@param[in] Count The number of I/O operations to perform. The number of bytes moved
|
|
||||||
is Width size * Count, starting at Address.
|
|
||||||
@param[in] UserBuffer The source buffer from which to write data.
|
|
||||||
|
|
||||||
@retval EFI_SUCCESS The data was read from or written to the EFI system.
|
|
||||||
@retval EFI_INVALID_PARAMETER Width is invalid for this EFI system. Or Buffer is NULL.
|
|
||||||
@retval EFI_UNSUPPORTED The Buffer is not aligned for the given Width.
|
|
||||||
Or,The address range specified by Address, Width, and Count is not valid for this EFI system.
|
|
||||||
|
|
||||||
**/
|
|
||||||
EFI_STATUS
|
|
||||||
EFIAPI
|
|
||||||
CpuIoServiceWrite (
|
|
||||||
IN EFI_CPU_IO2_PROTOCOL *This,
|
|
||||||
IN EFI_CPU_IO_PROTOCOL_WIDTH Width,
|
|
||||||
IN UINT64 UserAddress,
|
|
||||||
IN UINTN Count,
|
|
||||||
IN VOID *UserBuffer
|
|
||||||
);
|
|
||||||
|
|
||||||
#endif
|
|
@ -3,12 +3,12 @@
|
|||||||
#
|
#
|
||||||
# This DXE driver produces of the CPU I/O 2 Protocol, as introduced by PI 1.2.
|
# This DXE driver produces of the CPU I/O 2 Protocol, as introduced by PI 1.2.
|
||||||
#
|
#
|
||||||
# Copyright (c) 2009, Intel Corporation
|
# Copyright (c) 2009 - 2010, Intel Corporation
|
||||||
# All rights reserved. This program and the accompanying materials
|
# All rights reserved. This program and the accompanying materials
|
||||||
# are licensed and made available under the terms and conditions of the BSD License
|
# 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
|
# which accompanies this distribution. The full text of the license may be found at
|
||||||
# http://opensource.org/licenses/bsd-license.php
|
# http://opensource.org/licenses/bsd-license.php
|
||||||
#
|
#
|
||||||
# THE PROGRAM IS DISTRIBUTED UNDER THE BSD LICENSE ON AN "AS IS" BASIS,
|
# THE PROGRAM IS DISTRIBUTED UNDER THE BSD LICENSE ON AN "AS IS" BASIS,
|
||||||
# WITHOUT WARRANTIES OR REPRESENTATIONS OF ANY KIND, EITHER EXPRESS OR IMPLIED.
|
# WITHOUT WARRANTIES OR REPRESENTATIONS OF ANY KIND, EITHER EXPRESS OR IMPLIED.
|
||||||
#
|
#
|
||||||
@ -19,32 +19,29 @@
|
|||||||
BASE_NAME = CpuIo2Dxe
|
BASE_NAME = CpuIo2Dxe
|
||||||
FILE_GUID = A19B1FE7-C1BC-49F8-875F-54A5D542443F
|
FILE_GUID = A19B1FE7-C1BC-49F8-875F-54A5D542443F
|
||||||
MODULE_TYPE = DXE_DRIVER
|
MODULE_TYPE = DXE_DRIVER
|
||||||
|
|
||||||
ENTRY_POINT = CpuIo2Initialize
|
ENTRY_POINT = CpuIo2Initialize
|
||||||
|
|
||||||
#
|
#
|
||||||
# The following information is for reference only and not required by the build tools.
|
# The following information is for reference only and not required by the build tools.
|
||||||
#
|
#
|
||||||
# VALID_ARCHITECTURES = IA32 X64 EBC
|
# VALID_ARCHITECTURES = IA32 X64 IPF EBC
|
||||||
#
|
#
|
||||||
|
|
||||||
[Sources.common]
|
[Sources]
|
||||||
CpuIo2Dxe.h
|
|
||||||
CpuIo2Dxe.c
|
CpuIo2Dxe.c
|
||||||
|
|
||||||
[Packages]
|
[Packages]
|
||||||
MdePkg/MdePkg.dec
|
MdePkg/MdePkg.dec
|
||||||
|
|
||||||
[LibraryClasses]
|
[LibraryClasses]
|
||||||
UefiBootServicesTableLib
|
|
||||||
UefiDriverEntryPoint
|
UefiDriverEntryPoint
|
||||||
IoLib
|
BaseLib
|
||||||
DebugLib
|
DebugLib
|
||||||
|
IoLib
|
||||||
|
UefiBootServicesTableLib
|
||||||
|
|
||||||
[Protocols]
|
[Protocols]
|
||||||
gEfiCpuIo2ProtocolGuid ## PRODUCES
|
gEfiCpuIo2ProtocolGuid ## PRODUCES
|
||||||
|
|
||||||
[Depex]
|
[Depex]
|
||||||
TRUE
|
TRUE
|
||||||
|
|
||||||
|
@ -40,10 +40,18 @@
|
|||||||
|
|
||||||
[LibraryClasses.common.PEIM]
|
[LibraryClasses.common.PEIM]
|
||||||
PeimEntryPoint|MdePkg/Library/PeimEntryPoint/PeimEntryPoint.inf
|
PeimEntryPoint|MdePkg/Library/PeimEntryPoint/PeimEntryPoint.inf
|
||||||
PeiServicesTablePointerLib|MdePkg/Library/PeiServicesTablePointerLibIdt/PeiServicesTablePointerLibIdt.inf
|
|
||||||
PeiServicesLib|MdePkg/Library/PeiServicesLib/PeiServicesLib.inf
|
PeiServicesLib|MdePkg/Library/PeiServicesLib/PeiServicesLib.inf
|
||||||
MemoryAllocationLib|MdePkg/Library/PeiMemoryAllocationLib/PeiMemoryAllocationLib.inf
|
MemoryAllocationLib|MdePkg/Library/PeiMemoryAllocationLib/PeiMemoryAllocationLib.inf
|
||||||
|
|
||||||
|
[LibraryClasses.IA32.PEIM]
|
||||||
|
PeiServicesTablePointerLib|MdePkg/Library/PeiServicesTablePointerLibIdt/PeiServicesTablePointerLibIdt.inf
|
||||||
|
|
||||||
|
[LibraryClasses.X64.PEIM]
|
||||||
|
PeiServicesTablePointerLib|MdePkg/Library/PeiServicesTablePointerLibIdt/PeiServicesTablePointerLibIdt.inf
|
||||||
|
|
||||||
|
[LibraryClasses.IPF.PEIM]
|
||||||
|
PeiServicesTablePointerLib|MdePkg/Library/PeiServicesTablePointerLibKr7/PeiServicesTablePointerLibKr7.inf
|
||||||
|
|
||||||
[LibraryClasses.common.DXE_DRIVER]
|
[LibraryClasses.common.DXE_DRIVER]
|
||||||
DxeServicesTableLib|MdePkg/Library/DxeServicesTableLib/DxeServicesTableLib.inf
|
DxeServicesTableLib|MdePkg/Library/DxeServicesTableLib/DxeServicesTableLib.inf
|
||||||
MemoryAllocationLib|MdePkg/Library/UefiMemoryAllocationLib/UefiMemoryAllocationLib.inf
|
MemoryAllocationLib|MdePkg/Library/UefiMemoryAllocationLib/UefiMemoryAllocationLib.inf
|
||||||
|
Loading…
x
Reference in New Issue
Block a user