Adding support for BeagleBoard.

[mirror_edk2.git] / ArmPkg / Library / SemiHostingSerialPortLib / SerialPortLib.c

diff --git a/ArmPkg/Library/SemiHostingSerialPortLib/SerialPortLib.c b/ArmPkg/Library/SemiHostingSerialPortLib/SerialPortLib.c
new file mode 100644 (file)
index 0000000..df43f31
--- /dev/null
+++ b/ArmPkg/Library/SemiHostingSerialPortLib/SerialPortLib.c
@@ -0,0 +1,144 @@
+/** @file\r
+  Serial I/O Port library functions with no library constructor/destructor\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
+#include <Library/DebugLib.h>\r
+#include <Library/SemihostLib.h>\r
+#include <Library/SerialPortLib.h>\r
+\r
+\r
+/*\r
+\r
+  Programmed hardware of Serial port.\r
+\r
+  @return    Always return EFI_UNSUPPORTED.\r
+\r
+**/\r
+RETURN_STATUS\r
+EFIAPI\r
+SerialPortInitialize (\r
+  VOID\r
+  )\r
+{\r
+  if (SemihostConnectionSupported ()) {\r
+    return RETURN_SUCCESS;\r
+  } else {\r
+    return RETURN_UNSUPPORTED;\r
+  }\r
+}\r
+\r
+/**\r
+  Write data to serial device.\r
+\r
+  @param  Buffer           Point of data buffer which need to be writed.\r
+  @param  NumberOfBytes    Number of output bytes which are cached in Buffer.\r
+\r
+  @retval 0                Write data failed.\r
+  @retval !0               Actual number of bytes writed to serial device.\r
+\r
+**/\r
+\r
+#define PRINT_BUFFER_SIZE       512\r
+#define PRINT_BUFFER_THRESHOLD  (PRINT_BUFFER_SIZE - 4)\r
+\r
+UINTN\r
+EFIAPI\r
+SerialPortWrite (\r
+  IN UINT8     *Buffer,\r
+  IN UINTN     NumberOfBytes\r
+)\r
+{\r
+  UINT8 PrintBuffer[PRINT_BUFFER_SIZE];\r
+  UINTN SourceIndex      = 0;\r
+  UINTN DestinationIndex = 0;\r
+  UINT8 CurrentCharacter;\r
+\r
+  while (SourceIndex < NumberOfBytes)\r
+  {\r
+      CurrentCharacter = Buffer[SourceIndex++];\r
+      \r
+      switch (CurrentCharacter)\r
+      {\r
+      case '\r':\r
+          continue;\r
+\r
+      case '\n':\r
+          PrintBuffer[DestinationIndex++] = ' ';\r
+          // fall through\r
+\r
+      default:\r
+          PrintBuffer[DestinationIndex++] = CurrentCharacter;\r
+          break;\r
+      }\r
+\r
+      if (DestinationIndex > PRINT_BUFFER_THRESHOLD)\r
+      {\r
+          PrintBuffer[DestinationIndex] = '\0';\r
+          SemihostWriteString ((CHAR8 *) PrintBuffer);\r
+\r
+          DestinationIndex = 0;\r
+      }\r
+  }\r
+  \r
+  if (DestinationIndex > 0)\r
+  {\r
+      PrintBuffer[DestinationIndex] = '\0';\r
+      SemihostWriteString ((CHAR8 *) PrintBuffer);\r
+  }\r
+\r
+  return 0;\r
+}\r
+\r
+\r
+/**\r
+  Read data from serial device and save the datas in buffer.\r
+\r
+  @param  Buffer           Point of data buffer which need to be writed.\r
+  @param  NumberOfBytes    Number of output bytes which are cached in Buffer.\r
+\r
+  @retval 0                Read data failed.\r
+  @retval !0               Aactual number of bytes read from serial device.\r
+\r
+**/\r
+UINTN\r
+EFIAPI\r
+SerialPortRead (\r
+  OUT UINT8     *Buffer,\r
+  IN  UINTN     NumberOfBytes\r
+)\r
+{\r
+  *Buffer = SemihostReadCharacter ();\r
+  return 1;\r
+}\r
+\r
+\r
+\r
+/**\r
+  Check to see if any data is avaiable to be read from the debug device.\r
+\r
+  @retval TRUE       At least one byte of data is avaiable to be read\r
+  @retval FALS     No data is avaiable to be read\r
+\r
+**/\r
+BOOLEAN\r
+EFIAPI\r
+SerialPortPoll (\r
+  VOID\r
+  )\r
+{\r
+  // Since SemiHosting read character is blocking always say we have a char ready?\r
+  return SemihostConnectionSupported ();\r
+}\r
+\r