|
@@ -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;
|
|
|
+}
|