code -> fw

1 files changed, 22 insertions, 0 deletions

diff --git a/fw/fe310/bsp/gloss/sys_write.c b/fw/fe310/bsp/gloss/sys_write.c
new file mode 100644
index 0000000..2095940
--- /dev/null
+++ b/fw/fe310/bsp/gloss/sys_write.c
@@ -0,0 +1,22 @@
+#include <sys/types.h>
+#include <errno.h>
+#include <unistd.h>
+
+#include "platform.h"
+
+/* Write to a file.  */
+ssize_t
+_write(int fd, const void *ptr, size_t len)
+{
+  if ((fd != STDOUT_FILENO) && (fd != STDERR_FILENO)) {
+    errno = ENOSYS;
+    return -1;
+  }
+
+  const char *current = ptr;
+  for (size_t i = 0; i < len; i++) {
+    while (UART0_REG(UART_REG_TXFIFO) & 0x80000000);
+    UART0_REG(UART_REG_TXFIFO) = current[i];
+  }
+  return len;
+}