Fix VS2003 cast issue

[mirror_edk2.git] / EmbeddedPkg / TemplateCpuDxe / Arm / Exception.c

/** @file\r
\r
  Copyright (c) 2008-2009, Apple Inc. All rights reserved.\r
  \r
  All rights reserved. This program and the accompanying materials\r
  are licensed and made available under the terms and conditions of the BSD License\r
  which accompanies this distribution.  The full text of the license may be found at\r
  http://opensource.org/licenses/bsd-license.php\r
\r
  THE PROGRAM IS DISTRIBUTED UNDER THE BSD LICENSE ON AN "AS IS" BASIS,\r
  WITHOUT WARRANTIES OR REPRESENTATIONS OF ANY KIND, EITHER EXPRESS OR IMPLIED.\r
\r
**/\r
 \r
#include <CpuDxe.h>\r
#include <Library/CacheMaintenanceLib.h>\r
\r
VOID\r
ExceptionHandlersStart (\r
	VOID\r
	);\r
\r
VOID\r
ExceptionHandlersEnd (\r
	VOID\r
	);\r
\r
VOID\r
CommonExceptionEntry (\r
	VOID\r
	);\r
\r
VOID\r
AsmCommonExceptionEntry (\r
	VOID\r
	);\r
\r
\r
EFI_EXCEPTION_CALLBACK  gExceptionHandlers[MAX_ARM_EXCEPTION + 1];\r
\r
\r
/**\r
  This function registers and enables the handler specified by InterruptHandler for a processor \r
  interrupt or exception type specified by InterruptType. If InterruptHandler is NULL, then the \r
  handler for the processor interrupt or exception type specified by InterruptType is uninstalled. \r
  The installed handler is called once for each processor interrupt or exception.\r
\r
  @param  InterruptType    A pointer to the processor's current interrupt state. Set to TRUE if interrupts\r
                           are enabled and FALSE if interrupts are disabled.\r
  @param  InterruptHandler A pointer to a function of type EFI_CPU_INTERRUPT_HANDLER that is called\r
                           when a processor interrupt occurs. If this parameter is NULL, then the handler\r
                           will be uninstalled.\r
\r
  @retval EFI_SUCCESS           The handler for the processor interrupt was successfully installed or uninstalled.\r
  @retval EFI_ALREADY_STARTED   InterruptHandler is not NULL, and a handler for InterruptType was\r
                                previously installed.\r
  @retval EFI_INVALID_PARAMETER InterruptHandler is NULL, and a handler for InterruptType was not\r
                                previously installed.\r
  @retval EFI_UNSUPPORTED       The interrupt specified by InterruptType is not supported.\r
\r
**/\r
EFI_STATUS\r
RegisterInterruptHandler (\r
  IN EFI_EXCEPTION_TYPE             InterruptType,\r
  IN EFI_CPU_INTERRUPT_HANDLER      InterruptHandler\r
  )\r
{\r
	if (InterruptType > MAX_ARM_EXCEPTION) {\r
		return EFI_UNSUPPORTED;\r
	}\r
\r
	if ((InterruptHandler == NULL) && (gExceptionHandlers[InterruptType] == NULL)) {\r
		return EFI_INVALID_PARAMETER;\r
	}\r
\r
	if ((InterruptHandler != NULL) && (gExceptionHandlers[InterruptType] != NULL)) {\r
		return EFI_ALREADY_STARTED;\r
	}\r
\r
	gExceptionHandlers[InterruptType] = InterruptHandler;\r
\r
	return EFI_SUCCESS;\r
}\r
\r
\r
\r
\r
VOID\r
EFIAPI\r
DefaultSWIExceptionHandler(\r
	IN     EFI_EXCEPTION_TYPE						ExceptionType,\r
	IN OUT EFI_SYSTEM_CONTEXT						SystemContext\r
	)\r
{\r
	return;\r
}\r
\r
\r
VOID\r
EFIAPI\r
DefaultExceptionHandler(\r
	IN     EFI_EXCEPTION_TYPE						ExceptionType,\r
	IN OUT EFI_SYSTEM_CONTEXT						SystemContext\r
	)\r
{\r
	DEBUG ((EFI_D_ERROR, "Exception %d from %x\n", ExceptionType, SystemContext.SystemContextArm->PC));\r
  ASSERT (FALSE);\r
\r
	return;\r
}\r
\r
\r
\r
EFI_STATUS\r
InitializeExceptions (\r
	IN EFI_CPU_ARCH_PROTOCOL    *Cpu\r
	)\r
{\r
	EFI_STATUS    Status = EFI_SUCCESS;\r
	UINTN					Offset;\r
	UINTN					Length;\r
	UINTN					Index;\r
	BOOLEAN				Enabled;\r
\r
  //\r
  // Disable interrupts\r
  //\r
	Cpu->GetInterruptState (Cpu, &Enabled);\r
  Cpu->DisableInterrupt (Cpu);\r
\r
  //\r
  // Initialize the C entry points for interrupts\r
  //\r
	for (Index = 0; Index <= MAX_ARM_EXCEPTION; Index++) {\r
    if (Index == EXCEPT_ARM_SOFTWARE_INTERRUPT) {\r
      Status = Cpu->RegisterInterruptHandler (Cpu, Index, DefaultSWIExceptionHandler);\r
    } else {\r
      Status = Cpu->RegisterInterruptHandler (Cpu, Index, DefaultExceptionHandler);\r
		}\r
		ASSERT_EFI_ERROR (Status);\r
	}\r
\r
	//\r
	// Copy an implementation of the ARM exception vectors to 0x0.\r
	//\r
	Length = (UINTN)ExceptionHandlersEnd - (UINTN)ExceptionHandlersStart;\r
\r
	CopyMem ((VOID *)(UINTN)PcdGet32 (PcdCpuVectorBaseAddress), (VOID *)ExceptionHandlersStart, Length);\r
\r
  //\r
  // Patch in the common Assembly exception handler\r
  //\r
	Offset = (UINTN)CommonExceptionEntry - (UINTN)ExceptionHandlersStart;\r
	*(UINTN *) ((UINT8 *)(UINTN)PcdGet32 (PcdCpuVectorBaseAddress)  + Offset) = (UINTN)AsmCommonExceptionEntry;\r
\r
  //\r
  // Flush Caches since we updated executable stuff\r
  //\r
	InvalidateInstructionCache ();\r
\r
	if (Enabled) {\r
	  // \r
	  // Restore interrupt state\r
	  //\r
		Status = Cpu->EnableInterrupt (Cpu);\r
	}\r
\r
	return Status;\r
}\r
\r
\r
\r
/**\r
  This function reads the processor timer specified by TimerIndex and returns it in TimerValue.\r
\r
  @param  TimerIndex       Specifies which processor timer is to be returned in TimerValue. This parameter\r
                           must be between 0 and NumberOfTimers-1.\r
  @param  TimerValue       Pointer to the returned timer value.\r
  @param  TimerPeriod      A pointer to the amount of time that passes in femtoseconds for each increment\r
                           of TimerValue.\r
\r
  @retval EFI_SUCCESS           The processor timer value specified by TimerIndex was returned in TimerValue.\r
  @retval EFI_DEVICE_ERROR      An error occurred attempting to read one of the processor's timers.\r
  @retval EFI_INVALID_PARAMETER TimerValue is NULL or TimerIndex is not valid.\r
  @retval EFI_UNSUPPORTED       The processor does not have any readable timers.\r
\r
**/\r
EFI_STATUS\r
EFIAPI\r
GetTimerValue (\r
  IN  UINT32                         TimerIndex,\r
  OUT UINT64                         *TimerValue,\r
  OUT UINT64                         *TimerPeriod   OPTIONAL\r
  )\r
{\r
  return EFI_UNSUPPORTED;\r
}\r
\r
\r
/**\r
  This function flushes the range of addresses from Start to Start+Length \r
  from the processor's data cache. If Start is not aligned to a cache line \r
  boundary, then the bytes before Start to the preceding cache line boundary \r
  are also flushed. If Start+Length is not aligned to a cache line boundary, \r
  then the bytes past Start+Length to the end of the next cache line boundary \r
  are also flushed. The FlushType of EfiCpuFlushTypeWriteBackInvalidate must be \r
  supported. If the data cache is fully coherent with all DMA operations, then \r
  this function can just return EFI_SUCCESS. If the processor does not support \r
  flushing a range of the data cache, then the entire data cache can be flushed.\r
\r
  @param  Start            The beginning physical address to flush from the processor's data\r
                           cache.\r
  @param  Length           The number of bytes to flush from the processor's data cache. This\r
                           function may flush more bytes than Length specifies depending upon\r
                           the granularity of the flush operation that the processor supports.\r
  @param  FlushType        Specifies the type of flush operation to perform.\r
\r
  @retval EFI_SUCCESS           The address range from Start to Start+Length was flushed from\r
                                the processor's data cache.\r
  @retval EFI_UNSUPPORTED       The processor does not support the cache flush type specified\r
                                by FlushType.\r
  @retval EFI_DEVICE_ERROR      The address range from Start to Start+Length could not be flushed\r
                                from the processor's data cache.\r
\r
**/\r
EFI_STATUS\r
EFIAPI\r
FlushCpuDataCache (\r
  IN EFI_PHYSICAL_ADDRESS            Start,\r
  IN UINT64                          Length,\r
  IN EFI_CPU_FLUSH_TYPE              FlushType\r
  )\r
{\r
  if (FlushType == EfiCpuFlushTypeWriteBackInvalidate) {\r
    WriteBackInvalidateDataCacheRange((VOID *)(UINTN)Start, (UINTN)Length);\r
    return EFI_SUCCESS;\r
  } else if (FlushType == EfiCpuFlushTypeInvalidate) {\r
    InvalidateDataCacheRange((VOID *)(UINTN)Start, (UINTN)Length);\r
    return EFI_SUCCESS;\r
  } else if (FlushType == EfiCpuFlushTypeWriteBack) {\r
    WriteBackDataCacheRange((VOID *)(UINTN)Start, (UINTN)Length);\r
    return EFI_SUCCESS;\r
  } else {\r
    return EFI_UNSUPPORTED;\r
  }\r
}\r
\r
\r
\r
\r