add stm32l4_clib.c to support stdio

Author: GrumpyOldPizza

system/libstm32l4_dragonfly/Makefile

@@ -42,6 +42,7 @@ SRCS = \
 	dosfs_sflash.c \
 	dosfs_storage.c \
 	stm32l4_adc.c \
+	stm32l4_clib.c \
 	stm32l4_dac.c \
 	stm32l4_dma.c \
 	stm32l4_exti.c \
@@ -87,6 +88,7 @@ OBJS = \
 	dosfs_sflash.o \
 	dosfs_storage.o \
 	stm32l4_adc.o \
+	stm32l4_clib.o \
 	stm32l4_dac.o \
 	stm32l4_dma.o \
 	stm32l4_exti.o \

system/libstm32l4_dragonfly/stm32l4_clib.c

@@ -0,0 +1,184 @@
+/*
+ * Copyright (c) 2016 Thomas Roell.  All rights reserved.
+ *
+ * Permission is hereby granted, free of charge, to any person obtaining a copy
+ * of this software and associated documentation files (the "Software"), to
+ * deal with the Software without restriction, including without limitation the
+ * rights to use, copy, modify, merge, publish, distribute, sublicense, and/or
+ * sell copies of the Software, and to permit persons to whom the Software is
+ * furnished to do so, subject to the following conditions:
+ *
+ *  1. Redistributions of source code must retain the above copyright notice,
+ *     this list of conditions and the following disclaimers.
+ *  2. Redistributions in binary form must reproduce the above copyright
+ *     notice, this list of conditions and the following disclaimers in the
+ *     documentation and/or other materials provided with the distribution.
+ *  3. Neither the name of Thomas Roell, nor the names of its contributors
+ *     may be used to endorse or promote products derived from this Software
+ *     without specific prior written permission.
+ *
+ * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
+ * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
+ * FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT.  IN NO EVENT SHALL THE
+ * CONTRIBUTORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER
+ * LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING
+ * FROM, OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS
+ * WITH THE SOFTWARE.
+ */
+
+#include <errno.h>
+#include <stdint.h>
+#include <stdbool.h>
+#include <sys/stat.h>
+#include <sys/times.h>
+#include <sys/unistd.h>
+
+#include "armv7m.h"
+#include "stm32l4_usbd_cdc.h"
+
+#undef errno
+extern int errno;
+
+extern stm32l4_usbd_cdc_t stm32l4_usbd_cdc;
+
+extern uint32_t __HeapBase[];
+extern uint32_t __StackLimit[];
+
+void * _sbrk (int nbytes)
+{
+    void *p;
+
+    static void *__HeapCurrent = (void*)(&__HeapBase[0]);
+
+    if (((uint8_t*)__HeapCurrent + nbytes) <= (uint8_t*)(&__StackLimit[0]))
+    {
+	p = __HeapCurrent;
+	
+	__HeapCurrent = (void*)((uint8_t*)__HeapCurrent + nbytes);
+
+	return p;
+    }
+    else
+    {
+	errno = ENOMEM;
+
+	return  (void *) -1;
+    }
+}
+
+int _getpid(void)
+{
+    return 1;
+}
+
+int _kill(int pid, int sig)
+{
+    errno = EINVAL;
+
+    return -1;
+}
+
+int _close(int file) {
+    return -1;
+}
+
+int _isatty(int file) 
+{
+    switch (file) {
+    case STDOUT_FILENO:
+    case STDERR_FILENO:
+    case STDIN_FILENO:
+        return 1;
+
+    default:
+	errno = EBADF;
+	return 0;
+    }
+}
+
+int _fstat(int file, struct stat *st)
+{
+    st->st_mode = S_IFCHR;
+
+    return 0;
+}
+
+int _lseek(int file, int offset, int whence)
+{
+    return 0;
+}
+
+int _read(int file, char *buf, int nbytes)
+{
+    switch (file) {
+    case STDIN_FILENO:
+	return 0;
+
+    default:
+        errno = EBADF;
+        return -1;
+    }
+}
+
+int _write(int file, char *buf, int nbytes)
+{
+    switch (file) {
+    case STDOUT_FILENO:
+    case STDERR_FILENO:
+	if (stm32l4_usbd_cdc.state == USBD_CDC_STATE_NONE)
+	{
+	    stm32l4_usbd_cdc_create(&stm32l4_usbd_cdc);
+	}
+
+	if (stm32l4_usbd_cdc.state == USBD_CDC_STATE_INIT)
+	{
+	    stm32l4_usbd_cdc_enable(&stm32l4_usbd_cdc, 0, NULL, NULL, 0);
+	}
+
+	if (!stm32l4_usbd_cdc_done(&stm32l4_usbd_cdc))
+	{
+	    if (armv7m_core_priority() <= (int)NVIC_GetPriority(OTG_FS_IRQn))
+	    {
+		while (!stm32l4_usbd_cdc_done(&stm32l4_usbd_cdc))
+		{
+		    stm32l4_usbd_cdc_poll(&stm32l4_usbd_cdc);
+		}
+	    }
+	    else
+	    {
+		while (!stm32l4_usbd_cdc_done(&stm32l4_usbd_cdc))
+		{
+		    armv7m_core_yield();
+		}
+	    }
+	}
+
+	stm32l4_usbd_cdc_transmit(&stm32l4_usbd_cdc, (const uint8_t*)buf, nbytes);
+
+	if (armv7m_core_priority() <= (int)NVIC_GetPriority(OTG_FS_IRQn))
+	{
+	    while (!stm32l4_usbd_cdc_done(&stm32l4_usbd_cdc))
+	    {
+		stm32l4_usbd_cdc_poll(&stm32l4_usbd_cdc);
+	    }
+	}
+	else
+	{
+	    while (!stm32l4_usbd_cdc_done(&stm32l4_usbd_cdc))
+	    {
+		armv7m_core_yield();
+	    }
+	}
+	
+	return nbytes;
+
+    default:
+        errno = EBADF;
+        return -1;
+    }
+}
+
+void _exit(int status) 
+{
+    while (1) { };
+}