Pārlūkot izejas kodu

add syscalls for iap

balbekova 7 gadi atpakaļ
vecāks
revīzija
9182c0c6c9
1 mainītis faili ar 301 papildinājumiem un 0 dzēšanām
  1. 301 0
      iap/syscalls/syscalls.c

+ 301 - 0
iap/syscalls/syscalls.c

@@ -0,0 +1,301 @@
+/*
+ * newlib_stubs.c
+ *
+ *  Created on: 2 Nov 2010
+ *      Author: nanoage.co.uk
+ */
+#include <errno.h>
+#include <sys/stat.h>
+#include <sys/times.h>
+#include <sys/unistd.h>
+#include "stm32f4xx_usart.h"
+#include "stm32f4xx.h"
+
+#ifdef SWOTRACE
+/* Set STDIO_USART to 255 as flag that trace output on SWO pin used instead */
+#define STDIO_USART 255
+#else
+/* Set USART number */
+#define STDIO_USART 1 /* Disable UART stdio */
+#endif /* SWOTRACE */
+
+
+#ifndef STDOUT_USART
+#define STDOUT_USART STDIO_USART
+#endif
+
+#ifndef STDERR_USART
+#define STDERR_USART STDIO_USART
+#endif
+
+#ifndef STDIN_USART
+#define STDIN_USART STDIO_USART
+#endif
+
+
+#undef errno
+extern int errno;
+
+/* Variable to receive characters on SWO */
+volatile int32_t ITM_RxBuffer;
+
+/*
+ environ
+ A pointer to a list of environment variables and their values.
+ For a minimal environment, this empty list is adequate:
+ */
+char *__env[1] = { 0 };
+char **environ = __env;
+
+int _write(int file, char *ptr, int len);
+
+void _exit(int status) {
+    _write(1, "exit", 4);
+    while (1) {
+        ;
+    }
+}
+
+int _close(int file) {
+    return -1;
+}
+/*
+ execve
+ Transfer control to a new process. Minimal implementation (for a system without processes):
+ */
+int _execve(char *name, char **argv, char **env) {
+    errno = ENOMEM;
+    return -1;
+}
+/*
+ fork
+ Create a new process. Minimal implementation (for a system without processes):
+ */
+
+int _fork() {
+    errno = EAGAIN;
+    return -1;
+}
+/*
+ fstat
+ Status of an open file. For consistency with other minimal implementations in these examples,
+ all files are regarded as character special devices.
+ The `sys/stat.h' header file required is distributed in the `include' subdirectory for this C library.
+ */
+int _fstat(int file, struct stat *st) {
+    st->st_mode = S_IFCHR;
+    return 0;
+}
+
+/*
+ getpid
+ Process-ID; this is sometimes used to generate strings unlikely to conflict with other processes. Minimal implementation, for a system without processes:
+ */
+
+int _getpid() {
+    return 1;
+}
+
+/*
+ isatty
+ Query whether output stream is a terminal. For consistency with the other minimal implementations,
+ */
+int _isatty(int file) {
+    switch (file){
+    case STDOUT_FILENO:
+    case STDERR_FILENO:
+    case STDIN_FILENO:
+        return 1;
+    default:
+        //errno = ENOTTY;
+        errno = EBADF;
+        return 0;
+    }
+}
+
+
+/*
+ kill
+ Send a signal. Minimal implementation:
+ */
+int _kill(int pid, int sig) {
+    errno = EINVAL;
+    return (-1);
+}
+
+/*
+ link
+ Establish a new name for an existing file. Minimal implementation:
+ */
+
+int _link(char *old, char *new) {
+    errno = EMLINK;
+    return -1;
+}
+
+/*
+ lseek
+ Set position in a file. Minimal implementation:
+ */
+int _lseek(int file, int ptr, int dir) {
+    return 0;
+}
+
+/*
+ sbrk
+ Increase program data space.
+ Malloc and related functions depend on this
+ */
+caddr_t _sbrk(int incr) {
+
+    extern char _ebss; // Defined by the linker
+    extern char __bss_end__;
+    static char *heap_end;
+    char *prev_heap_end;
+
+    if (heap_end == 0) {
+    	//heap_end = &_ebss;
+    	heap_end = &__bss_end__;
+    }
+    prev_heap_end = heap_end;
+
+char * stack = (char*) __get_MSP();
+     if (heap_end + incr >  stack)
+     {
+         _write (STDERR_FILENO, "Heap and stack collision\n", 25);
+         errno = ENOMEM;
+         return  (caddr_t) -1;
+         //abort ();
+     }
+
+    heap_end += incr;
+    return (caddr_t) prev_heap_end;
+
+}
+
+/*
+ read
+ Read a character to a file. `libc' subroutines will use this system routine for input from all files, including stdin
+ Returns -1 on error or blocks until the number of characters have been read.
+ */
+
+
+int _read(int file, char *ptr, int len) {
+    int n;
+    int num = 0;
+    switch (file) {
+    case STDIN_FILENO:
+        for (n = 0; n < len; n++) {
+#if   STDIN_USART == 1
+            while ((USART1->SR & USART_FLAG_RXNE) == (uint16_t)RESET) {}
+            char c = (char)(USART1->DR & (uint16_t)0x01FF);
+#elif STDIN_USART == 2
+            while ((USART2->SR & USART_FLAG_RXNE) == (uint16_t) RESET) {}
+            char c = (char) (USART2->DR & (uint16_t) 0x01FF);
+#elif STDIN_USART == 3
+            while ((USART3->SR & USART_FLAG_RXNE) == (uint16_t)RESET) {}
+            char c = (char)(USART3->DR & (uint16_t)0x01FF);
+#elif STDIN_USART == 255
+            /* TODO Test this feature */
+            char c = (char)ITM_ReceiveChar();
+#elif STDIN_USART == 0
+            /* Return NULL */
+            char c = '\0';
+#endif
+            *ptr++ = c;
+            num++;
+        }
+        break;
+    default:
+        errno = EBADF;
+        return -1;
+    }
+    return num;
+}
+
+/*
+ stat
+ Status of a file (by name). Minimal implementation:
+ int    _EXFUN(stat,( const char *__path, struct stat *__sbuf ));
+ */
+
+int _stat(const char *filepath, struct stat *st) {
+    st->st_mode = S_IFCHR;
+    return 0;
+}
+
+/*
+ times
+ Timing information for current process. Minimal implementation:
+ */
+
+clock_t _times(struct tms *buf) {
+    return -1;
+}
+
+/*
+ unlink
+ Remove a file's directory entry. Minimal implementation:
+ */
+int _unlink(char *name) {
+    errno = ENOENT;
+    return -1;
+}
+
+/*
+ wait
+ Wait for a child process. Minimal implementation:
+ */
+int _wait(int *status) {
+    errno = ECHILD;
+    return -1;
+}
+
+/*
+ write
+ Write a character to a file. `libc' subroutines will use this system routine for output to all files, including stdout
+ Returns -1 on error or number of bytes sent
+ */
+int _write(int file, char *ptr, int len) {
+    int n;
+    switch (file) {
+    case STDOUT_FILENO: /*stdout*/
+        for (n = 0; n < len; n++) {
+#if STDOUT_USART == 1
+            while ((USART1->SR & USART_FLAG_TC) == (uint16_t)RESET) {}
+            USART1->DR = (*ptr++ & (uint16_t)0x01FF);
+#elif  STDOUT_USART == 2
+            while ((USART2->SR & USART_FLAG_TC) == (uint16_t) RESET) {
+            }
+            USART2->DR = (*ptr++ & (uint16_t) 0x01FF);
+#elif  STDOUT_USART == 3
+            while ((USART3->SR & USART_FLAG_TC) == (uint16_t)RESET) {}
+            USART3->DR = (*ptr++ & (uint16_t)0x01FF);
+#elif STDOUT_USART == 255
+            ITM_SendChar(*ptr++ & (uint16_t)0x00FF);
+#endif
+        }
+        break;
+    case STDERR_FILENO: /* stderr */
+        for (n = 0; n < len; n++) {
+#if STDERR_USART == 1
+            while ((USART1->SR & USART_FLAG_TC) == (uint16_t)RESET) {}
+            USART1->DR = (*ptr++ & (uint16_t)0x01FF);
+#elif  STDERR_USART == 2
+            while ((USART2->SR & USART_FLAG_TC) == (uint16_t) RESET) {
+            }
+            USART2->DR = (*ptr++ & (uint16_t) 0x01FF);
+#elif  STDERR_USART == 3
+            while ((USART3->SR & USART_FLAG_TC) == (uint16_t)RESET) {}
+            USART3->DR = (*ptr++ & (uint16_t)0x01FF);
+#elif STDERR_USART == 255
+            ITM_SendChar(*ptr++ & (uint16_t)0x00FF);
+#endif
+        }
+        break;
+    default:
+        errno = EBADF;
+        return -1;
+    }
+    return len;
+}