mirror of
https://github.com/acidanthera/audk.git
synced 2025-07-26 07:04:28 +02:00
Fix line ending issue. Update DMA Map primatives to double buffer if buffer does not start on cache line boundary. If buffer is not a multiple of a cache line only whole cache lines will be allowed in the buffer. This is part of the MAP API.
git-svn-id: https://edk2.svn.sourceforge.net/svnroot/edk2/trunk/edk2@10547 6f19259b-4bc3-4df7-8a09-765794883524
This commit is contained in:
parent
d744b79c0f
commit
8e7c9e030f
@ -21,6 +21,8 @@
|
|||||||
#include <Library/UefiBootServicesTableLib.h>
|
#include <Library/UefiBootServicesTableLib.h>
|
||||||
#include <Library/UncachedMemoryAllocationLib.h>
|
#include <Library/UncachedMemoryAllocationLib.h>
|
||||||
#include <Library/IoLib.h>
|
#include <Library/IoLib.h>
|
||||||
|
#include <Library/BaseMemoryLib.h>
|
||||||
|
#include <Library/ArmLib.h>
|
||||||
#include <Omap3530/Omap3530.h>
|
#include <Omap3530/Omap3530.h>
|
||||||
|
|
||||||
#include <Protocol/Cpu.h>
|
#include <Protocol/Cpu.h>
|
||||||
@ -30,11 +32,13 @@ typedef struct {
|
|||||||
EFI_PHYSICAL_ADDRESS DeviceAddress;
|
EFI_PHYSICAL_ADDRESS DeviceAddress;
|
||||||
UINTN NumberOfBytes;
|
UINTN NumberOfBytes;
|
||||||
DMA_MAP_OPERATION Operation;
|
DMA_MAP_OPERATION Operation;
|
||||||
|
BOOLEAN DoubleBuffer;
|
||||||
} MAP_INFO_INSTANCE;
|
} MAP_INFO_INSTANCE;
|
||||||
|
|
||||||
|
|
||||||
|
|
||||||
EFI_CPU_ARCH_PROTOCOL *gCpu;
|
EFI_CPU_ARCH_PROTOCOL *gCpu;
|
||||||
|
UINTN gCacheAlignment = 0;
|
||||||
|
|
||||||
/**
|
/**
|
||||||
Configure OMAP DMA Channel
|
Configure OMAP DMA Channel
|
||||||
@ -46,21 +50,21 @@ EFI_CPU_ARCH_PROTOCOL *gCpu;
|
|||||||
@retval EFI_INVALID_PARAMETER Channel is not valid
|
@retval EFI_INVALID_PARAMETER Channel is not valid
|
||||||
@retval EFI_DEVICE_ERROR The system hardware could not map the requested information.
|
@retval EFI_DEVICE_ERROR The system hardware could not map the requested information.
|
||||||
|
|
||||||
**/
|
**/
|
||||||
EFI_STATUS
|
EFI_STATUS
|
||||||
EFIAPI
|
EFIAPI
|
||||||
EnableDmaChannel (
|
EnableDmaChannel (
|
||||||
IN UINTN Channel,
|
IN UINTN Channel,
|
||||||
IN OMAP_DMA4 *DMA4
|
IN OMAP_DMA4 *DMA4
|
||||||
)
|
)
|
||||||
{
|
{
|
||||||
UINT32 RegVal;
|
UINT32 RegVal;
|
||||||
|
|
||||||
|
|
||||||
if (Channel > DMA4_MAX_CHANNEL) {
|
if (Channel > DMA4_MAX_CHANNEL) {
|
||||||
return EFI_INVALID_PARAMETER;
|
return EFI_INVALID_PARAMETER;
|
||||||
}
|
}
|
||||||
|
|
||||||
/* 1) Configure the transfer parameters in the logical DMA registers */
|
/* 1) Configure the transfer parameters in the logical DMA registers */
|
||||||
/*-------------------------------------------------------------------*/
|
/*-------------------------------------------------------------------*/
|
||||||
|
|
||||||
@ -135,11 +139,11 @@ EnableDmaChannel (
|
|||||||
/* 2) Start the DMA transfer by Setting the enable bit CCR[7]=1 */
|
/* 2) Start the DMA transfer by Setting the enable bit CCR[7]=1 */
|
||||||
/*--------------------------------------------------------------*/
|
/*--------------------------------------------------------------*/
|
||||||
//write enable bit
|
//write enable bit
|
||||||
MmioOr32 (DMA4_CCR(Channel), DMA4_CCR_ENABLE); //Launch transfer
|
MmioOr32 (DMA4_CCR(Channel), DMA4_CCR_ENABLE); //Launch transfer
|
||||||
|
|
||||||
return EFI_SUCCESS;
|
return EFI_SUCCESS;
|
||||||
}
|
}
|
||||||
|
|
||||||
/**
|
/**
|
||||||
Turn of DMA channel configured by EnableDma().
|
Turn of DMA channel configured by EnableDma().
|
||||||
|
|
||||||
@ -151,43 +155,43 @@ EnableDmaChannel (
|
|||||||
@retval EFI_INVALID_PARAMETER Channel is not valid
|
@retval EFI_INVALID_PARAMETER Channel is not valid
|
||||||
@retval EFI_DEVICE_ERROR The system hardware could not map the requested information.
|
@retval EFI_DEVICE_ERROR The system hardware could not map the requested information.
|
||||||
|
|
||||||
**/
|
**/
|
||||||
EFI_STATUS
|
EFI_STATUS
|
||||||
EFIAPI
|
EFIAPI
|
||||||
DisableDmaChannel (
|
DisableDmaChannel (
|
||||||
IN UINTN Channel,
|
IN UINTN Channel,
|
||||||
IN UINT32 SuccessMask,
|
IN UINT32 SuccessMask,
|
||||||
IN UINT32 ErrorMask
|
IN UINT32 ErrorMask
|
||||||
)
|
)
|
||||||
{
|
{
|
||||||
EFI_STATUS Status = EFI_SUCCESS;
|
EFI_STATUS Status = EFI_SUCCESS;
|
||||||
UINT32 Reg;
|
UINT32 Reg;
|
||||||
|
|
||||||
|
|
||||||
if (Channel > DMA4_MAX_CHANNEL) {
|
if (Channel > DMA4_MAX_CHANNEL) {
|
||||||
return EFI_INVALID_PARAMETER;
|
return EFI_INVALID_PARAMETER;
|
||||||
}
|
}
|
||||||
|
|
||||||
do {
|
do {
|
||||||
Reg = MmioRead32 (DMA4_CSR(Channel));
|
Reg = MmioRead32 (DMA4_CSR(Channel));
|
||||||
if ((Reg & ErrorMask) != 0) {
|
if ((Reg & ErrorMask) != 0) {
|
||||||
Status = EFI_DEVICE_ERROR;
|
Status = EFI_DEVICE_ERROR;
|
||||||
DEBUG ((EFI_D_ERROR, "DMA Error (%d) %x\n", Channel, Reg));
|
DEBUG ((EFI_D_ERROR, "DMA Error (%d) %x\n", Channel, Reg));
|
||||||
break;
|
break;
|
||||||
}
|
}
|
||||||
} while ((Reg & SuccessMask) != SuccessMask);
|
} while ((Reg & SuccessMask) != SuccessMask);
|
||||||
|
|
||||||
|
|
||||||
// Disable all status bits and clear them
|
// Disable all status bits and clear them
|
||||||
MmioWrite32 (DMA4_CICR (Channel), 0);
|
MmioWrite32 (DMA4_CICR (Channel), 0);
|
||||||
MmioWrite32 (DMA4_CSR (Channel), DMA4_CSR_RESET);
|
MmioWrite32 (DMA4_CSR (Channel), DMA4_CSR_RESET);
|
||||||
|
|
||||||
MmioAnd32 (DMA4_CCR(0), ~(DMA4_CCR_ENABLE | DMA4_CCR_RD_ACTIVE | DMA4_CCR_WR_ACTIVE));
|
MmioAnd32 (DMA4_CCR(0), ~(DMA4_CCR_ENABLE | DMA4_CCR_RD_ACTIVE | DMA4_CCR_WR_ACTIVE));
|
||||||
return Status;
|
return Status;
|
||||||
}
|
}
|
||||||
|
|
||||||
|
|
||||||
|
|
||||||
/**
|
/**
|
||||||
Provides the DMA controller-specific addresses needed to access system memory.
|
Provides the DMA controller-specific addresses needed to access system memory.
|
||||||
|
|
||||||
@ -207,51 +211,76 @@ DisableDmaChannel (
|
|||||||
@retval EFI_OUT_OF_RESOURCES The request could not be completed due to a lack of resources.
|
@retval EFI_OUT_OF_RESOURCES The request could not be completed due to a lack of resources.
|
||||||
@retval EFI_DEVICE_ERROR The system hardware could not map the requested address.
|
@retval EFI_DEVICE_ERROR The system hardware could not map the requested address.
|
||||||
|
|
||||||
**/
|
**/
|
||||||
EFI_STATUS
|
EFI_STATUS
|
||||||
EFIAPI
|
EFIAPI
|
||||||
DmaMap (
|
DmaMap (
|
||||||
IN DMA_MAP_OPERATION Operation,
|
IN DMA_MAP_OPERATION Operation,
|
||||||
IN VOID *HostAddress,
|
IN VOID *HostAddress,
|
||||||
IN OUT UINTN *NumberOfBytes,
|
IN OUT UINTN *NumberOfBytes,
|
||||||
OUT PHYSICAL_ADDRESS *DeviceAddress,
|
OUT PHYSICAL_ADDRESS *DeviceAddress,
|
||||||
OUT VOID **Mapping
|
OUT VOID **Mapping
|
||||||
)
|
)
|
||||||
{
|
{
|
||||||
MAP_INFO_INSTANCE *Map;
|
EFI_STATUS Status;
|
||||||
|
MAP_INFO_INSTANCE *Map;
|
||||||
if ( HostAddress == NULL || NumberOfBytes == NULL ||
|
VOID *Buffer;
|
||||||
DeviceAddress == NULL || Mapping == NULL ) {
|
|
||||||
return EFI_INVALID_PARAMETER;
|
if ( HostAddress == NULL || NumberOfBytes == NULL ||
|
||||||
}
|
DeviceAddress == NULL || Mapping == NULL ) {
|
||||||
|
return EFI_INVALID_PARAMETER;
|
||||||
|
}
|
||||||
if (Operation >= MapOperationMaximum) {
|
|
||||||
return EFI_INVALID_PARAMETER;
|
|
||||||
}
|
if (Operation >= MapOperationMaximum) {
|
||||||
|
return EFI_INVALID_PARAMETER;
|
||||||
*DeviceAddress = ConvertToPhysicalAddress (HostAddress);
|
}
|
||||||
|
|
||||||
// Remember range so we can flush on the other side
|
*DeviceAddress = ConvertToPhysicalAddress (HostAddress);
|
||||||
Map = AllocatePool (sizeof (MAP_INFO_INSTANCE));
|
|
||||||
if (Map == NULL) {
|
// Remember range so we can flush on the other side
|
||||||
return EFI_OUT_OF_RESOURCES;
|
Map = AllocatePool (sizeof (MAP_INFO_INSTANCE));
|
||||||
}
|
if (Map == NULL) {
|
||||||
|
return EFI_OUT_OF_RESOURCES;
|
||||||
*Mapping = Map;
|
}
|
||||||
|
|
||||||
Map->HostAddress = (UINTN)HostAddress;
|
*Mapping = Map;
|
||||||
Map->DeviceAddress = *DeviceAddress;
|
|
||||||
Map->NumberOfBytes = *NumberOfBytes;
|
if (((UINTN)HostAddress & (gCacheAlignment - 1)) != 0) {
|
||||||
Map->Operation = Operation;
|
Map->DoubleBuffer = TRUE;
|
||||||
|
Status = DmaAllocateBuffer (EfiBootServicesData, EFI_SIZE_TO_PAGES (*NumberOfBytes), &Buffer);
|
||||||
// EfiCpuFlushTypeWriteBack, EfiCpuFlushTypeInvalidate
|
if (EFI_ERROR (Status)) {
|
||||||
gCpu->FlushDataCache (gCpu, (EFI_PHYSICAL_ADDRESS)(UINTN)HostAddress, *NumberOfBytes, EfiCpuFlushTypeWriteBackInvalidate);
|
return Status;
|
||||||
|
}
|
||||||
return EFI_SUCCESS;
|
|
||||||
}
|
*DeviceAddress = (PHYSICAL_ADDRESS)(UINTN)Buffer;
|
||||||
|
|
||||||
|
} else {
|
||||||
|
Map->DoubleBuffer = FALSE;
|
||||||
|
}
|
||||||
|
|
||||||
|
*NumberOfBytes &= *NumberOfBytes & ~(gCacheAlignment - 1); // Only do it on full cache lines
|
||||||
|
|
||||||
|
Map->HostAddress = (UINTN)HostAddress;
|
||||||
|
Map->DeviceAddress = *DeviceAddress;
|
||||||
|
Map->NumberOfBytes = *NumberOfBytes;
|
||||||
|
Map->Operation = Operation;
|
||||||
|
|
||||||
|
if (Map->DoubleBuffer) {
|
||||||
|
if (Map->Operation == MapOperationBusMasterWrite) {
|
||||||
|
CopyMem ((VOID *)(UINTN)Map->DeviceAddress, (VOID *)(UINTN)Map->HostAddress, Map->NumberOfBytes);
|
||||||
|
}
|
||||||
|
} else {
|
||||||
|
// EfiCpuFlushTypeWriteBack, EfiCpuFlushTypeInvalidate
|
||||||
|
if (Map->Operation == MapOperationBusMasterWrite || Map->Operation == MapOperationBusMasterRead) {
|
||||||
|
gCpu->FlushDataCache (gCpu, (EFI_PHYSICAL_ADDRESS)(UINTN)HostAddress, Map->NumberOfBytes, EfiCpuFlushTypeWriteBackInvalidate);
|
||||||
|
}
|
||||||
|
}
|
||||||
|
|
||||||
|
return EFI_SUCCESS;
|
||||||
|
}
|
||||||
|
|
||||||
|
|
||||||
/**
|
/**
|
||||||
Completes the DmaMapBusMasterRead(), DmaMapBusMasterWrite(), or DmaMapBusMasterCommonBuffer()
|
Completes the DmaMapBusMasterRead(), DmaMapBusMasterWrite(), or DmaMapBusMasterCommonBuffer()
|
||||||
operation and releases any corresponding resources.
|
operation and releases any corresponding resources.
|
||||||
@ -261,33 +290,43 @@ DmaMap (
|
|||||||
@retval EFI_SUCCESS The range was unmapped.
|
@retval EFI_SUCCESS The range was unmapped.
|
||||||
@retval EFI_DEVICE_ERROR The data was not committed to the target system memory.
|
@retval EFI_DEVICE_ERROR The data was not committed to the target system memory.
|
||||||
|
|
||||||
**/
|
**/
|
||||||
EFI_STATUS
|
EFI_STATUS
|
||||||
EFIAPI
|
EFIAPI
|
||||||
DmaUnmap (
|
DmaUnmap (
|
||||||
IN VOID *Mapping
|
IN VOID *Mapping
|
||||||
)
|
)
|
||||||
{
|
{
|
||||||
MAP_INFO_INSTANCE *Map;
|
MAP_INFO_INSTANCE *Map;
|
||||||
|
|
||||||
if (Mapping == NULL) {
|
if (Mapping == NULL) {
|
||||||
ASSERT (FALSE);
|
ASSERT (FALSE);
|
||||||
return EFI_INVALID_PARAMETER;
|
return EFI_INVALID_PARAMETER;
|
||||||
}
|
}
|
||||||
|
|
||||||
Map = (MAP_INFO_INSTANCE *)Mapping;
|
Map = (MAP_INFO_INSTANCE *)Mapping;
|
||||||
if (Map->Operation == MapOperationBusMasterWrite) {
|
|
||||||
//
|
if (Map->DoubleBuffer) {
|
||||||
// Make sure we read buffer from uncached memory and not the cache
|
if (Map->Operation == MapOperationBusMasterRead) {
|
||||||
//
|
CopyMem ((VOID *)(UINTN)Map->HostAddress, (VOID *)(UINTN)Map->DeviceAddress, Map->NumberOfBytes);
|
||||||
gCpu->FlushDataCache (gCpu, Map->HostAddress, Map->NumberOfBytes, EfiCpuFlushTypeInvalidate);
|
}
|
||||||
}
|
|
||||||
|
DmaFreeBuffer (EFI_SIZE_TO_PAGES (Map->NumberOfBytes), (VOID *)(UINTN)Map->DeviceAddress);
|
||||||
FreePool (Map);
|
|
||||||
|
} else {
|
||||||
return EFI_SUCCESS;
|
if (Map->Operation == MapOperationBusMasterWrite) {
|
||||||
}
|
//
|
||||||
|
// Make sure we read buffer from uncached memory and not the cache
|
||||||
|
//
|
||||||
|
gCpu->FlushDataCache (gCpu, Map->HostAddress, Map->NumberOfBytes, EfiCpuFlushTypeInvalidate);
|
||||||
|
}
|
||||||
|
}
|
||||||
|
|
||||||
|
FreePool (Map);
|
||||||
|
|
||||||
|
return EFI_SUCCESS;
|
||||||
|
}
|
||||||
|
|
||||||
/**
|
/**
|
||||||
Allocates pages that are suitable for an DmaMap() of type MapOperationBusMasterCommonBuffer.
|
Allocates pages that are suitable for an DmaMap() of type MapOperationBusMasterCommonBuffer.
|
||||||
mapping.
|
mapping.
|
||||||
@ -304,35 +343,36 @@ DmaUnmap (
|
|||||||
@retval EFI_INVALID_PARAMETER One or more parameters are invalid.
|
@retval EFI_INVALID_PARAMETER One or more parameters are invalid.
|
||||||
@retval EFI_OUT_OF_RESOURCES The memory pages could not be allocated.
|
@retval EFI_OUT_OF_RESOURCES The memory pages could not be allocated.
|
||||||
|
|
||||||
**/EFI_STATUS
|
**/
|
||||||
EFIAPI
|
EFI_STATUS
|
||||||
DmaAllocateBuffer (
|
EFIAPI
|
||||||
IN EFI_MEMORY_TYPE MemoryType,
|
DmaAllocateBuffer (
|
||||||
|
IN EFI_MEMORY_TYPE MemoryType,
|
||||||
IN UINTN Pages,
|
IN UINTN Pages,
|
||||||
OUT VOID **HostAddress
|
OUT VOID **HostAddress
|
||||||
)
|
)
|
||||||
{
|
{
|
||||||
if (HostAddress == NULL) {
|
if (HostAddress == NULL) {
|
||||||
return EFI_INVALID_PARAMETER;
|
return EFI_INVALID_PARAMETER;
|
||||||
}
|
}
|
||||||
|
|
||||||
//
|
//
|
||||||
// The only valid memory types are EfiBootServicesData and EfiRuntimeServicesData
|
// The only valid memory types are EfiBootServicesData and EfiRuntimeServicesData
|
||||||
//
|
//
|
||||||
// We used uncached memory to keep coherency
|
// We used uncached memory to keep coherency
|
||||||
//
|
//
|
||||||
if (MemoryType == EfiBootServicesData) {
|
if (MemoryType == EfiBootServicesData) {
|
||||||
*HostAddress = UncachedAllocatePages (Pages);
|
*HostAddress = UncachedAllocatePages (Pages);
|
||||||
} else if (MemoryType != EfiRuntimeServicesData) {
|
} else if (MemoryType != EfiRuntimeServicesData) {
|
||||||
*HostAddress = UncachedAllocateRuntimePages (Pages);
|
*HostAddress = UncachedAllocateRuntimePages (Pages);
|
||||||
} else {
|
} else {
|
||||||
return EFI_INVALID_PARAMETER;
|
return EFI_INVALID_PARAMETER;
|
||||||
}
|
}
|
||||||
|
|
||||||
return EFI_SUCCESS;
|
return EFI_SUCCESS;
|
||||||
}
|
}
|
||||||
|
|
||||||
|
|
||||||
/**
|
/**
|
||||||
Frees memory that was allocated with DmaAllocateBuffer().
|
Frees memory that was allocated with DmaAllocateBuffer().
|
||||||
|
|
||||||
@ -344,35 +384,37 @@ DmaAllocateBuffer (
|
|||||||
was not allocated with DmaAllocateBuffer().
|
was not allocated with DmaAllocateBuffer().
|
||||||
|
|
||||||
**/
|
**/
|
||||||
EFI_STATUS
|
EFI_STATUS
|
||||||
EFIAPI
|
EFIAPI
|
||||||
DmaFreeBuffer (
|
DmaFreeBuffer (
|
||||||
IN UINTN Pages,
|
IN UINTN Pages,
|
||||||
IN VOID *HostAddress
|
IN VOID *HostAddress
|
||||||
)
|
)
|
||||||
{
|
{
|
||||||
if (HostAddress == NULL) {
|
if (HostAddress == NULL) {
|
||||||
return EFI_INVALID_PARAMETER;
|
return EFI_INVALID_PARAMETER;
|
||||||
}
|
}
|
||||||
|
|
||||||
UncachedFreePages (HostAddress, Pages);
|
UncachedFreePages (HostAddress, Pages);
|
||||||
return EFI_SUCCESS;
|
return EFI_SUCCESS;
|
||||||
}
|
}
|
||||||
|
|
||||||
|
|
||||||
EFI_STATUS
|
EFI_STATUS
|
||||||
EFIAPI
|
EFIAPI
|
||||||
OmapDmaLibConstructor (
|
OmapDmaLibConstructor (
|
||||||
IN EFI_HANDLE ImageHandle,
|
IN EFI_HANDLE ImageHandle,
|
||||||
IN EFI_SYSTEM_TABLE *SystemTable
|
IN EFI_SYSTEM_TABLE *SystemTable
|
||||||
)
|
)
|
||||||
{
|
{
|
||||||
EFI_STATUS Status;
|
EFI_STATUS Status;
|
||||||
|
|
||||||
// Get the Cpu protocol for later use
|
// Get the Cpu protocol for later use
|
||||||
Status = gBS->LocateProtocol (&gEfiCpuArchProtocolGuid, NULL, (VOID **)&gCpu);
|
Status = gBS->LocateProtocol (&gEfiCpuArchProtocolGuid, NULL, (VOID **)&gCpu);
|
||||||
ASSERT_EFI_ERROR(Status);
|
ASSERT_EFI_ERROR(Status);
|
||||||
|
|
||||||
return EFI_SUCCESS;
|
gCacheAlignment = ArmDataCacheLineLength ();
|
||||||
}
|
|
||||||
|
return Status;
|
||||||
|
}
|
||||||
|
|
||||||
|
@ -35,6 +35,8 @@
|
|||||||
MemoryAllocationLib
|
MemoryAllocationLib
|
||||||
UncachedMemoryAllocationLib
|
UncachedMemoryAllocationLib
|
||||||
IoLib
|
IoLib
|
||||||
|
BaseMemoryLib
|
||||||
|
ArmLib
|
||||||
|
|
||||||
|
|
||||||
[Protocols]
|
[Protocols]
|
||||||
|
Loading…
x
Reference in New Issue
Block a user