Adding support for BeagleBoard.

[mirror_edk2.git] / EmbeddedPkg / DebugSupportDxe / DebugSupport.c

diff --git a/EmbeddedPkg/DebugSupportDxe/DebugSupport.c b/EmbeddedPkg/DebugSupportDxe/DebugSupport.c
new file mode 100644 (file)
index 0000000..26f4c38
--- /dev/null
+++ b/EmbeddedPkg/DebugSupportDxe/DebugSupport.c
@@ -0,0 +1,119 @@
+/** @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 <Uefi.h>\r
+\r
+#include <Library/CacheMaintenanceLib.h>\r
+#include <Library/DebugLib.h>\r
+#include <Library/UefiBootServicesTableLib.h>\r
+\r
+#include <Protocol/Cpu.h>\r
+#include <Protocol/DebugSupport.h>\r
+#include <Protocol/TimerDebugSupport.h>\r
+\r
+EFI_STATUS\r
+EFIAPI\r
+DebugSupportGetMaximumProcessorIndex (\r
+  IN  EFI_DEBUG_SUPPORT_PROTOCOL  *This,\r
+  OUT UINTN                       *MaxProcessorIndex\r
+  )\r
+{\r
+  if (MaxProcessorIndex == NULL) {\r
+    return EFI_INVALID_PARAMETER;\r
+  }\r
+\r
+  *MaxProcessorIndex = 0;\r
+\r
+  return EFI_SUCCESS;\r
+}\r
+\r
+EFI_STATUS\r
+EFIAPI\r
+DebugSupportRegisterPeriodicCallback (\r
+  IN  EFI_DEBUG_SUPPORT_PROTOCOL  *This,\r
+  IN  UINTN                       ProcessorIndex,\r
+  IN  EFI_PERIODIC_CALLBACK       PeriodicCallback\r
+  )\r
+{\r
+  TIMER_DEBUG_SUPPORT_PROTOCOL  *Timer;\r
+  EFI_STATUS                    Status;\r
+\r
+  Status = gBS->LocateProtocol(&gTimerDebugSupportProtocolGuid, NULL, (VOID **)&Timer);\r
+  if (EFI_ERROR(Status)) {\r
+    return Status;\r
+  }\r
+\r
+  Status = Timer->RegisterPeriodicCallback(Timer, PeriodicCallback);\r
+\r
+  return Status;\r
+}\r
+\r
+EFI_STATUS\r
+EFIAPI\r
+DebugSupportRegisterExceptionCallback (\r
+  IN  EFI_DEBUG_SUPPORT_PROTOCOL  *This,\r
+  IN  UINTN                       ProcessorIndex,\r
+  IN  EFI_EXCEPTION_CALLBACK      ExceptionCallback,\r
+  IN  EFI_EXCEPTION_TYPE          ExceptionType\r
+  )\r
+{\r
+  EFI_CPU_ARCH_PROTOCOL *Cpu;\r
+  EFI_STATUS            Status;\r
+\r
+  Status = gBS->LocateProtocol(&gEfiCpuArchProtocolGuid, NULL, (VOID **)&Cpu);\r
+  if (EFI_ERROR(Status)) {\r
+    return Status;\r
+  }\r
+\r
+  Status = Cpu->RegisterInterruptHandler(Cpu, ExceptionType, (EFI_CPU_INTERRUPT_HANDLER)ExceptionCallback);\r
+\r
+  return Status;\r
+}\r
+\r
+EFI_STATUS\r
+EFIAPI\r
+DebugSupportInvalidateInstructionCache (\r
+  IN  EFI_DEBUG_SUPPORT_PROTOCOL  *This,\r
+  IN  UINTN                       ProcessorIndex,\r
+  IN  VOID                        *Start,\r
+  IN  UINT64                      Length\r
+  )\r
+{\r
+  InvalidateInstructionCacheRange(Start, Length);\r
+  return EFI_SUCCESS;\r
+}\r
+\r
+EFI_DEBUG_SUPPORT_PROTOCOL  mDebugSupport = {\r
+  IsaArm,\r
+  DebugSupportGetMaximumProcessorIndex,\r
+  DebugSupportRegisterPeriodicCallback,\r
+  DebugSupportRegisterExceptionCallback,\r
+  DebugSupportInvalidateInstructionCache\r
+};\r
+\r
+EFI_STATUS\r
+DebugSupportDxeInitialize (\r
+  IN EFI_HANDLE         ImageHandle,\r
+  IN EFI_SYSTEM_TABLE   *SystemTable\r
+  )\r
+{\r
+  EFI_STATUS  Status;\r
+  EFI_HANDLE  Handle = NULL;\r
+\r
+  ASSERT_PROTOCOL_ALREADY_INSTALLED (NULL, &gEfiDebugSupportProtocolGuid);\r
+  Status = gBS->InstallMultipleProtocolInterfaces(&Handle, &gEfiDebugSupportProtocolGuid, &mDebugSupport, NULL);\r
+\r
+  return Status;\r
+}\r
+\r