ST / ST_Events-old

Important changes to repositories hosted on mbed.com

Mbed hosted mercurial repositories are deprecated and are due to be permanently deleted in July 2026.

To keep a copy of this software download the repository Zip archive or clone locally using Mercurial.

It is also possible to export all your personal repositories from the account settings page.

Dependents:   HelloWorld_CCA01M1 HelloWorld_CCA02M1 CI-data-logger-server HelloWorld_CCA02M1 ... more

This is a fork of the events subdirectory of https://github.com/ARMmbed/mbed-os.

Note, you must import this library with import name: events!!!

hal/common/retarget.cpp@6547:5f2779e36035, 2016-06-07 (annotated)

Committer:
Christopher Haster
Date:
Tue Jun 07 10:08:07 2016 -0500
Revision:
6547:5f2779e36035
Parent:
6546:b7f6a8e13048
Child:
6548:c08cb6087b0a
Added newline conversion for stdin



stdin converts the following character sequences:



\n   -> \n

\r\n -> \n

\r   -> \n

\n\r -> \n



For original behaviour, a serial object can be instantiated explicitly

Who changed what in which revision?

UserRevisionLine numberNew contents of line
Mihail Stoyanov 6088:e1cf77a573c5 1 /* mbed Microcontroller Library
Mihail Stoyanov 6088:e1cf77a573c5 2 * Copyright (c) 2006-2015 ARM Limited
Mihail Stoyanov 6088:e1cf77a573c5 3 *
Mihail Stoyanov 6088:e1cf77a573c5 4 * Licensed under the Apache License, Version 2.0 (the "License");
Mihail Stoyanov 6088:e1cf77a573c5 5 * you may not use this file except in compliance with the License.
Mihail Stoyanov 6088:e1cf77a573c5 6 * You may obtain a copy of the License at
Mihail Stoyanov 6088:e1cf77a573c5 7 *
Mihail Stoyanov 6088:e1cf77a573c5 8 * http://www.apache.org/licenses/LICENSE-2.0
Mihail Stoyanov 6088:e1cf77a573c5 9 *
Mihail Stoyanov 6088:e1cf77a573c5 10 * Unless required by applicable law or agreed to in writing, software
Mihail Stoyanov 6088:e1cf77a573c5 11 * distributed under the License is distributed on an "AS IS" BASIS,
Mihail Stoyanov 6088:e1cf77a573c5 12 * WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied.
Mihail Stoyanov 6088:e1cf77a573c5 13 * See the License for the specific language governing permissions and
Mihail Stoyanov 6088:e1cf77a573c5 14 * limitations under the License.
Mihail Stoyanov 6088:e1cf77a573c5 15 */
Mihail Stoyanov 6088:e1cf77a573c5 16 #include "platform.h"
Mihail Stoyanov 6088:e1cf77a573c5 17 #include "FileHandle.h"
Mihail Stoyanov 6088:e1cf77a573c5 18 #include "FileSystemLike.h"
Mihail Stoyanov 6088:e1cf77a573c5 19 #include "FilePath.h"
Mihail Stoyanov 6088:e1cf77a573c5 20 #include "serial_api.h"
Mihail Stoyanov 6088:e1cf77a573c5 21 #include "toolchain.h"
Mihail Stoyanov 6088:e1cf77a573c5 22 #include "semihost_api.h"
Mihail Stoyanov 6088:e1cf77a573c5 23 #include "mbed_interface.h"
Mihail Stoyanov 6088:e1cf77a573c5 24 #if DEVICE_STDIO_MESSAGES
Mihail Stoyanov 6088:e1cf77a573c5 25 #include <stdio.h>
Mihail Stoyanov 6088:e1cf77a573c5 26 #endif
Mihail Stoyanov 6088:e1cf77a573c5 27 #include <errno.h>
Mihail Stoyanov 6088:e1cf77a573c5 28
Mihail Stoyanov 6088:e1cf77a573c5 29 #if defined(__ARMCC_VERSION)
Mihail Stoyanov 6088:e1cf77a573c5 30 # include <rt_sys.h>
Mihail Stoyanov 6088:e1cf77a573c5 31 # define PREFIX(x) _sys##x
Mihail Stoyanov 6088:e1cf77a573c5 32 # define OPEN_MAX _SYS_OPEN
Mihail Stoyanov 6088:e1cf77a573c5 33 # ifdef __MICROLIB
Mihail Stoyanov 6088:e1cf77a573c5 34 # pragma import(__use_full_stdio)
Mihail Stoyanov 6088:e1cf77a573c5 35 # endif
Mihail Stoyanov 6088:e1cf77a573c5 36
Mihail Stoyanov 6088:e1cf77a573c5 37 #elif defined(__ICCARM__)
Mihail Stoyanov 6088:e1cf77a573c5 38 # include <yfuns.h>
Mihail Stoyanov 6088:e1cf77a573c5 39 # define PREFIX(x) _##x
Mihail Stoyanov 6088:e1cf77a573c5 40 # define OPEN_MAX 16
Mihail Stoyanov 6088:e1cf77a573c5 41
Mihail Stoyanov 6088:e1cf77a573c5 42 # define STDIN_FILENO 0
Mihail Stoyanov 6088:e1cf77a573c5 43 # define STDOUT_FILENO 1
Mihail Stoyanov 6088:e1cf77a573c5 44 # define STDERR_FILENO 2
Mihail Stoyanov 6088:e1cf77a573c5 45
Mihail Stoyanov 6088:e1cf77a573c5 46 #else
Mihail Stoyanov 6088:e1cf77a573c5 47 # include <sys/stat.h>
Mihail Stoyanov 6088:e1cf77a573c5 48 # include <sys/unistd.h>
Mihail Stoyanov 6088:e1cf77a573c5 49 # include <sys/syslimits.h>
Mihail Stoyanov 6088:e1cf77a573c5 50 # define PREFIX(x) x
Mihail Stoyanov 6088:e1cf77a573c5 51 #endif
Mihail Stoyanov 6088:e1cf77a573c5 52
Russ Butler 6361:7b5bd40de905 53 #define FILE_HANDLE_RESERVED 0xFFFFFFFF
Russ Butler 6361:7b5bd40de905 54
Mihail Stoyanov 6088:e1cf77a573c5 55 using namespace mbed;
Mihail Stoyanov 6088:e1cf77a573c5 56
Mihail Stoyanov 6088:e1cf77a573c5 57 #if defined(__MICROLIB) && (__ARMCC_VERSION>5030000)
Mihail Stoyanov 6088:e1cf77a573c5 58 // Before version 5.03, we were using a patched version of microlib with proper names
Mihail Stoyanov 6088:e1cf77a573c5 59 extern const char __stdin_name[] = ":tt";
Mihail Stoyanov 6088:e1cf77a573c5 60 extern const char __stdout_name[] = ":tt";
Mihail Stoyanov 6088:e1cf77a573c5 61 extern const char __stderr_name[] = ":tt";
Mihail Stoyanov 6088:e1cf77a573c5 62
Mihail Stoyanov 6088:e1cf77a573c5 63 #else
Mihail Stoyanov 6088:e1cf77a573c5 64 extern const char __stdin_name[] = "/stdin";
Mihail Stoyanov 6088:e1cf77a573c5 65 extern const char __stdout_name[] = "/stdout";
Mihail Stoyanov 6088:e1cf77a573c5 66 extern const char __stderr_name[] = "/stderr";
Mihail Stoyanov 6088:e1cf77a573c5 67 #endif
Mihail Stoyanov 6088:e1cf77a573c5 68
Mihail Stoyanov 6088:e1cf77a573c5 69 /* newlib has the filehandle field in the FILE struct as a short, so
Mihail Stoyanov 6088:e1cf77a573c5 70 * we can't just return a Filehandle* from _open and instead have to
Mihail Stoyanov 6088:e1cf77a573c5 71 * put it in a filehandles array and return the index into that array
Mihail Stoyanov 6088:e1cf77a573c5 72 * (or rather index+3, as filehandles 0-2 are stdin/out/err).
Mihail Stoyanov 6088:e1cf77a573c5 73 */
Mihail Stoyanov 6088:e1cf77a573c5 74 static FileHandle *filehandles[OPEN_MAX];
Russ Butler 6361:7b5bd40de905 75 static PlatformMutex filehandle_mutex;
Mihail Stoyanov 6088:e1cf77a573c5 76
Mihail Stoyanov 6088:e1cf77a573c5 77 FileHandle::~FileHandle() {
Russ Butler 6361:7b5bd40de905 78 filehandle_mutex.lock();
Mihail Stoyanov 6088:e1cf77a573c5 79 /* Remove all open filehandles for this */
Mihail Stoyanov 6088:e1cf77a573c5 80 for (unsigned int fh_i = 0; fh_i < sizeof(filehandles)/sizeof(*filehandles); fh_i++) {
Mihail Stoyanov 6088:e1cf77a573c5 81 if (filehandles[fh_i] == this) {
Mihail Stoyanov 6088:e1cf77a573c5 82 filehandles[fh_i] = NULL;
Mihail Stoyanov 6088:e1cf77a573c5 83 }
Mihail Stoyanov 6088:e1cf77a573c5 84 }
Russ Butler 6361:7b5bd40de905 85 filehandle_mutex.unlock();
Mihail Stoyanov 6088:e1cf77a573c5 86 }
Mihail Stoyanov 6088:e1cf77a573c5 87
Mihail Stoyanov 6088:e1cf77a573c5 88 #if DEVICE_SERIAL
Mihail Stoyanov 6088:e1cf77a573c5 89 extern int stdio_uart_inited;
Mihail Stoyanov 6088:e1cf77a573c5 90 extern serial_t stdio_uart;
Christopher Haster 6547:5f2779e36035 91 static char stdio_in_prev;
Christopher Haster 6547:5f2779e36035 92 static char stdio_out_prev;
Mihail Stoyanov 6088:e1cf77a573c5 93 #endif
Mihail Stoyanov 6088:e1cf77a573c5 94
Mihail Stoyanov 6088:e1cf77a573c5 95 static void init_serial() {
Mihail Stoyanov 6088:e1cf77a573c5 96 #if DEVICE_SERIAL
Mihail Stoyanov 6088:e1cf77a573c5 97 if (stdio_uart_inited) return;
Mihail Stoyanov 6088:e1cf77a573c5 98 serial_init(&stdio_uart, STDIO_UART_TX, STDIO_UART_RX);
Mihail Stoyanov 6088:e1cf77a573c5 99 #endif
Mihail Stoyanov 6088:e1cf77a573c5 100 }
Mihail Stoyanov 6088:e1cf77a573c5 101
Mihail Stoyanov 6088:e1cf77a573c5 102 static inline int openmode_to_posix(int openmode) {
Mihail Stoyanov 6088:e1cf77a573c5 103 int posix = openmode;
Mihail Stoyanov 6088:e1cf77a573c5 104 #ifdef __ARMCC_VERSION
Mihail Stoyanov 6088:e1cf77a573c5 105 if (openmode & OPEN_PLUS) {
Mihail Stoyanov 6088:e1cf77a573c5 106 posix = O_RDWR;
Mihail Stoyanov 6088:e1cf77a573c5 107 } else if(openmode & OPEN_W) {
Mihail Stoyanov 6088:e1cf77a573c5 108 posix = O_WRONLY;
Mihail Stoyanov 6088:e1cf77a573c5 109 } else if(openmode & OPEN_A) {
Mihail Stoyanov 6088:e1cf77a573c5 110 posix = O_WRONLY|O_APPEND;
Mihail Stoyanov 6088:e1cf77a573c5 111 } else {
Mihail Stoyanov 6088:e1cf77a573c5 112 posix = O_RDONLY;
Mihail Stoyanov 6088:e1cf77a573c5 113 }
Mihail Stoyanov 6088:e1cf77a573c5 114 /* a, w, a+, w+ all create if file does not already exist */
Mihail Stoyanov 6088:e1cf77a573c5 115 if (openmode & (OPEN_A|OPEN_W)) {
Mihail Stoyanov 6088:e1cf77a573c5 116 posix |= O_CREAT;
Mihail Stoyanov 6088:e1cf77a573c5 117 }
Mihail Stoyanov 6088:e1cf77a573c5 118 /* w and w+ truncate */
Mihail Stoyanov 6088:e1cf77a573c5 119 if (openmode & OPEN_W) {
Mihail Stoyanov 6088:e1cf77a573c5 120 posix |= O_TRUNC;
Mihail Stoyanov 6088:e1cf77a573c5 121 }
Mihail Stoyanov 6088:e1cf77a573c5 122 #elif defined(__ICCARM__)
Mihail Stoyanov 6088:e1cf77a573c5 123 switch (openmode & _LLIO_RDWRMASK) {
Mihail Stoyanov 6088:e1cf77a573c5 124 case _LLIO_RDONLY: posix = O_RDONLY; break;
Mihail Stoyanov 6088:e1cf77a573c5 125 case _LLIO_WRONLY: posix = O_WRONLY; break;
Mihail Stoyanov 6088:e1cf77a573c5 126 case _LLIO_RDWR : posix = O_RDWR ; break;
Mihail Stoyanov 6088:e1cf77a573c5 127 }
Mihail Stoyanov 6088:e1cf77a573c5 128 if (openmode & _LLIO_CREAT ) posix |= O_CREAT;
Mihail Stoyanov 6088:e1cf77a573c5 129 if (openmode & _LLIO_APPEND) posix |= O_APPEND;
Mihail Stoyanov 6088:e1cf77a573c5 130 if (openmode & _LLIO_TRUNC ) posix |= O_TRUNC;
Mihail Stoyanov 6088:e1cf77a573c5 131 #elif defined(TOOLCHAIN_GCC)
Mihail Stoyanov 6088:e1cf77a573c5 132 posix &= ~O_BINARY;
Mihail Stoyanov 6088:e1cf77a573c5 133 #endif
Mihail Stoyanov 6088:e1cf77a573c5 134 return posix;
Mihail Stoyanov 6088:e1cf77a573c5 135 }
Mihail Stoyanov 6088:e1cf77a573c5 136
Mihail Stoyanov 6088:e1cf77a573c5 137 extern "C" FILEHANDLE PREFIX(_open)(const char* name, int openmode) {
Mihail Stoyanov 6088:e1cf77a573c5 138 #if defined(__MICROLIB) && (__ARMCC_VERSION>5030000)
Mihail Stoyanov 6088:e1cf77a573c5 139 // Before version 5.03, we were using a patched version of microlib with proper names
Mihail Stoyanov 6088:e1cf77a573c5 140 // This is the workaround that the microlib author suggested us
Mihail Stoyanov 6088:e1cf77a573c5 141 static int n = 0;
Mihail Stoyanov 6088:e1cf77a573c5 142 if (!std::strcmp(name, ":tt")) return n++;
Mihail Stoyanov 6088:e1cf77a573c5 143
Mihail Stoyanov 6088:e1cf77a573c5 144 #else
Mihail Stoyanov 6088:e1cf77a573c5 145 /* Use the posix convention that stdin,out,err are filehandles 0,1,2.
Mihail Stoyanov 6088:e1cf77a573c5 146 */
Mihail Stoyanov 6088:e1cf77a573c5 147 if (std::strcmp(name, __stdin_name) == 0) {
Mihail Stoyanov 6088:e1cf77a573c5 148 init_serial();
Mihail Stoyanov 6088:e1cf77a573c5 149 return 0;
Mihail Stoyanov 6088:e1cf77a573c5 150 } else if (std::strcmp(name, __stdout_name) == 0) {
Mihail Stoyanov 6088:e1cf77a573c5 151 init_serial();
Mihail Stoyanov 6088:e1cf77a573c5 152 return 1;
Mihail Stoyanov 6088:e1cf77a573c5 153 } else if (std::strcmp(name, __stderr_name) == 0) {
Mihail Stoyanov 6088:e1cf77a573c5 154 init_serial();
Mihail Stoyanov 6088:e1cf77a573c5 155 return 2;
Mihail Stoyanov 6088:e1cf77a573c5 156 }
Mihail Stoyanov 6088:e1cf77a573c5 157 #endif
Mihail Stoyanov 6088:e1cf77a573c5 158
Mihail Stoyanov 6088:e1cf77a573c5 159 // find the first empty slot in filehandles
Russ Butler 6361:7b5bd40de905 160 filehandle_mutex.lock();
Mihail Stoyanov 6088:e1cf77a573c5 161 unsigned int fh_i;
Mihail Stoyanov 6088:e1cf77a573c5 162 for (fh_i = 0; fh_i < sizeof(filehandles)/sizeof(*filehandles); fh_i++) {
Mihail Stoyanov 6088:e1cf77a573c5 163 if (filehandles[fh_i] == NULL) break;
Mihail Stoyanov 6088:e1cf77a573c5 164 }
Mihail Stoyanov 6088:e1cf77a573c5 165 if (fh_i >= sizeof(filehandles)/sizeof(*filehandles)) {
Russ Butler 6361:7b5bd40de905 166 filehandle_mutex.unlock();
Mihail Stoyanov 6088:e1cf77a573c5 167 return -1;
Mihail Stoyanov 6088:e1cf77a573c5 168 }
Russ Butler 6361:7b5bd40de905 169 filehandles[fh_i] = (FileHandle*)FILE_HANDLE_RESERVED;
Russ Butler 6361:7b5bd40de905 170 filehandle_mutex.unlock();
Mihail Stoyanov 6088:e1cf77a573c5 171
Mihail Stoyanov 6088:e1cf77a573c5 172 FileHandle *res;
Mihail Stoyanov 6088:e1cf77a573c5 173
Mihail Stoyanov 6088:e1cf77a573c5 174 /* FILENAME: ":0x12345678" describes a FileLike* */
Mihail Stoyanov 6088:e1cf77a573c5 175 if (name[0] == ':') {
Mihail Stoyanov 6088:e1cf77a573c5 176 void *p;
Mihail Stoyanov 6088:e1cf77a573c5 177 sscanf(name, ":%p", &p);
Mihail Stoyanov 6088:e1cf77a573c5 178 res = (FileHandle*)p;
Mihail Stoyanov 6088:e1cf77a573c5 179
Mihail Stoyanov 6088:e1cf77a573c5 180 /* FILENAME: "/file_system/file_name" */
Mihail Stoyanov 6088:e1cf77a573c5 181 } else {
Mihail Stoyanov 6088:e1cf77a573c5 182 FilePath path(name);
Mihail Stoyanov 6088:e1cf77a573c5 183
Russ Butler 6361:7b5bd40de905 184 if (!path.exists()) {
Russ Butler 6361:7b5bd40de905 185 // Free file handle
Russ Butler 6361:7b5bd40de905 186 filehandles[fh_i] = NULL;
Mihail Stoyanov 6088:e1cf77a573c5 187 return -1;
Russ Butler 6361:7b5bd40de905 188 } else if (path.isFile()) {
Mihail Stoyanov 6088:e1cf77a573c5 189 res = path.file();
Mihail Stoyanov 6088:e1cf77a573c5 190 } else {
Mihail Stoyanov 6088:e1cf77a573c5 191 FileSystemLike *fs = path.fileSystem();
Russ Butler 6361:7b5bd40de905 192 if (fs == NULL) {
Russ Butler 6361:7b5bd40de905 193 // Free file handle
Russ Butler 6361:7b5bd40de905 194 filehandles[fh_i] = NULL;
Russ Butler 6361:7b5bd40de905 195 return -1;
Russ Butler 6361:7b5bd40de905 196 }
Mihail Stoyanov 6088:e1cf77a573c5 197 int posix_mode = openmode_to_posix(openmode);
Mihail Stoyanov 6088:e1cf77a573c5 198 res = fs->open(path.fileName(), posix_mode); /* NULL if fails */
Mihail Stoyanov 6088:e1cf77a573c5 199 }
Mihail Stoyanov 6088:e1cf77a573c5 200 }
Mihail Stoyanov 6088:e1cf77a573c5 201
Russ Butler 6361:7b5bd40de905 202 if (res == NULL) {
Russ Butler 6361:7b5bd40de905 203 // Free file handle
Russ Butler 6361:7b5bd40de905 204 filehandles[fh_i] = NULL;
Russ Butler 6361:7b5bd40de905 205 return -1;
Russ Butler 6361:7b5bd40de905 206 }
Mihail Stoyanov 6088:e1cf77a573c5 207 filehandles[fh_i] = res;
Mihail Stoyanov 6088:e1cf77a573c5 208
Mihail Stoyanov 6088:e1cf77a573c5 209 return fh_i + 3; // +3 as filehandles 0-2 are stdin/out/err
Mihail Stoyanov 6088:e1cf77a573c5 210 }
Mihail Stoyanov 6088:e1cf77a573c5 211
Mihail Stoyanov 6088:e1cf77a573c5 212 extern "C" int PREFIX(_close)(FILEHANDLE fh) {
Mihail Stoyanov 6088:e1cf77a573c5 213 if (fh < 3) return 0;
Mihail Stoyanov 6088:e1cf77a573c5 214
Mihail Stoyanov 6088:e1cf77a573c5 215 FileHandle* fhc = filehandles[fh-3];
Mihail Stoyanov 6088:e1cf77a573c5 216 filehandles[fh-3] = NULL;
Mihail Stoyanov 6088:e1cf77a573c5 217 if (fhc == NULL) return -1;
Mihail Stoyanov 6088:e1cf77a573c5 218
Mihail Stoyanov 6088:e1cf77a573c5 219 return fhc->close();
Mihail Stoyanov 6088:e1cf77a573c5 220 }
Mihail Stoyanov 6088:e1cf77a573c5 221
Mihail Stoyanov 6088:e1cf77a573c5 222 #if defined(__ICCARM__)
Mihail Stoyanov 6088:e1cf77a573c5 223 extern "C" size_t __write (int fh, const unsigned char *buffer, size_t length) {
Mihail Stoyanov 6088:e1cf77a573c5 224 #else
Mihail Stoyanov 6088:e1cf77a573c5 225 extern "C" int PREFIX(_write)(FILEHANDLE fh, const unsigned char *buffer, unsigned int length, int mode) {
Mihail Stoyanov 6088:e1cf77a573c5 226 #endif
Mihail Stoyanov 6088:e1cf77a573c5 227 int n; // n is the number of bytes written
Mihail Stoyanov 6088:e1cf77a573c5 228 if (fh < 3) {
Mihail Stoyanov 6088:e1cf77a573c5 229 #if DEVICE_SERIAL
Mihail Stoyanov 6088:e1cf77a573c5 230 if (!stdio_uart_inited) init_serial();
Mihail Stoyanov 6088:e1cf77a573c5 231 for (unsigned int i = 0; i < length; i++) {
Christopher Haster 6547:5f2779e36035 232 if (buffer[i] == '\n' && stdio_out_prev != '\r') {
Christopher Haster 6546:b7f6a8e13048 233 serial_putc(&stdio_uart, '\r');
Christopher Haster 6546:b7f6a8e13048 234 }
Mihail Stoyanov 6088:e1cf77a573c5 235 serial_putc(&stdio_uart, buffer[i]);
Christopher Haster 6547:5f2779e36035 236 stdio_out_prev = buffer[i];
Mihail Stoyanov 6088:e1cf77a573c5 237 }
Mihail Stoyanov 6088:e1cf77a573c5 238 #endif
Mihail Stoyanov 6088:e1cf77a573c5 239 n = length;
Mihail Stoyanov 6088:e1cf77a573c5 240 } else {
Mihail Stoyanov 6088:e1cf77a573c5 241 FileHandle* fhc = filehandles[fh-3];
Mihail Stoyanov 6088:e1cf77a573c5 242 if (fhc == NULL) return -1;
Mihail Stoyanov 6088:e1cf77a573c5 243
Mihail Stoyanov 6088:e1cf77a573c5 244 n = fhc->write(buffer, length);
Mihail Stoyanov 6088:e1cf77a573c5 245 }
Mihail Stoyanov 6088:e1cf77a573c5 246 #ifdef __ARMCC_VERSION
Mihail Stoyanov 6088:e1cf77a573c5 247 return length-n;
Mihail Stoyanov 6088:e1cf77a573c5 248 #else
Mihail Stoyanov 6088:e1cf77a573c5 249 return n;
Mihail Stoyanov 6088:e1cf77a573c5 250 #endif
Mihail Stoyanov 6088:e1cf77a573c5 251 }
Mihail Stoyanov 6088:e1cf77a573c5 252
Mihail Stoyanov 6088:e1cf77a573c5 253 #if defined(__ICCARM__)
Mihail Stoyanov 6088:e1cf77a573c5 254 extern "C" size_t __read (int fh, unsigned char *buffer, size_t length) {
Mihail Stoyanov 6088:e1cf77a573c5 255 #else
Mihail Stoyanov 6088:e1cf77a573c5 256 extern "C" int PREFIX(_read)(FILEHANDLE fh, unsigned char *buffer, unsigned int length, int mode) {
Mihail Stoyanov 6088:e1cf77a573c5 257 #endif
Mihail Stoyanov 6088:e1cf77a573c5 258 int n; // n is the number of bytes read
Mihail Stoyanov 6088:e1cf77a573c5 259 if (fh < 3) {
Mihail Stoyanov 6088:e1cf77a573c5 260 // only read a character at a time from stdin
Mihail Stoyanov 6088:e1cf77a573c5 261 #if DEVICE_SERIAL
Mihail Stoyanov 6088:e1cf77a573c5 262 if (!stdio_uart_inited) init_serial();
Christopher Haster 6547:5f2779e36035 263 while (true) {
Christopher Haster 6547:5f2779e36035 264 char c = serial_getc(&stdio_uart);
Christopher Haster 6547:5f2779e36035 265 if ((c == '\r' && stdio_in_prev != '\n') ||
Christopher Haster 6547:5f2779e36035 266 (c == '\n' && stdio_in_prev != '\r')) {
Christopher Haster 6547:5f2779e36035 267 stdio_in_prev = c;
Christopher Haster 6547:5f2779e36035 268 *buffer = '\n';
Christopher Haster 6547:5f2779e36035 269 break;
Christopher Haster 6547:5f2779e36035 270 } else if ((c == '\r' && stdio_in_prev == '\n') ||
Christopher Haster 6547:5f2779e36035 271 (c == '\n' && stdio_in_prev == '\r')) {
Christopher Haster 6547:5f2779e36035 272 stdio_in_prev = c;
Christopher Haster 6547:5f2779e36035 273 // onto next character
Christopher Haster 6547:5f2779e36035 274 continue;
Christopher Haster 6547:5f2779e36035 275 } else {
Christopher Haster 6547:5f2779e36035 276 stdio_in_prev = c;
Christopher Haster 6547:5f2779e36035 277 *buffer = c;
Christopher Haster 6547:5f2779e36035 278 break;
Christopher Haster 6547:5f2779e36035 279 }
Christopher Haster 6547:5f2779e36035 280 }
Mihail Stoyanov 6088:e1cf77a573c5 281 #endif
Mihail Stoyanov 6088:e1cf77a573c5 282 n = 1;
Mihail Stoyanov 6088:e1cf77a573c5 283 } else {
Mihail Stoyanov 6088:e1cf77a573c5 284 FileHandle* fhc = filehandles[fh-3];
Mihail Stoyanov 6088:e1cf77a573c5 285 if (fhc == NULL) return -1;
Mihail Stoyanov 6088:e1cf77a573c5 286
Mihail Stoyanov 6088:e1cf77a573c5 287 n = fhc->read(buffer, length);
Mihail Stoyanov 6088:e1cf77a573c5 288 }
Mihail Stoyanov 6088:e1cf77a573c5 289 #ifdef __ARMCC_VERSION
Mihail Stoyanov 6088:e1cf77a573c5 290 return length-n;
Mihail Stoyanov 6088:e1cf77a573c5 291 #else
Mihail Stoyanov 6088:e1cf77a573c5 292 return n;
Mihail Stoyanov 6088:e1cf77a573c5 293 #endif
Mihail Stoyanov 6088:e1cf77a573c5 294 }
Mihail Stoyanov 6088:e1cf77a573c5 295
Mihail Stoyanov 6088:e1cf77a573c5 296 #ifdef __ARMCC_VERSION
Mihail Stoyanov 6088:e1cf77a573c5 297 extern "C" int PREFIX(_istty)(FILEHANDLE fh)
Mihail Stoyanov 6088:e1cf77a573c5 298 #else
Mihail Stoyanov 6088:e1cf77a573c5 299 extern "C" int _isatty(FILEHANDLE fh)
Mihail Stoyanov 6088:e1cf77a573c5 300 #endif
Mihail Stoyanov 6088:e1cf77a573c5 301 {
Mihail Stoyanov 6088:e1cf77a573c5 302 /* stdin, stdout and stderr should be tty */
Mihail Stoyanov 6088:e1cf77a573c5 303 if (fh < 3) return 1;
Mihail Stoyanov 6088:e1cf77a573c5 304
Mihail Stoyanov 6088:e1cf77a573c5 305 FileHandle* fhc = filehandles[fh-3];
Mihail Stoyanov 6088:e1cf77a573c5 306 if (fhc == NULL) return -1;
Mihail Stoyanov 6088:e1cf77a573c5 307
Mihail Stoyanov 6088:e1cf77a573c5 308 return fhc->isatty();
Mihail Stoyanov 6088:e1cf77a573c5 309 }
Mihail Stoyanov 6088:e1cf77a573c5 310
Mihail Stoyanov 6088:e1cf77a573c5 311 extern "C"
Mihail Stoyanov 6088:e1cf77a573c5 312 #if defined(__ARMCC_VERSION)
Mihail Stoyanov 6088:e1cf77a573c5 313 int _sys_seek(FILEHANDLE fh, long position)
Mihail Stoyanov 6088:e1cf77a573c5 314 #elif defined(__ICCARM__)
Mihail Stoyanov 6088:e1cf77a573c5 315 long __lseek(int fh, long offset, int whence)
Mihail Stoyanov 6088:e1cf77a573c5 316 #else
Mihail Stoyanov 6088:e1cf77a573c5 317 int _lseek(FILEHANDLE fh, int offset, int whence)
Mihail Stoyanov 6088:e1cf77a573c5 318 #endif
Mihail Stoyanov 6088:e1cf77a573c5 319 {
Mihail Stoyanov 6088:e1cf77a573c5 320 if (fh < 3) return 0;
Mihail Stoyanov 6088:e1cf77a573c5 321
Mihail Stoyanov 6088:e1cf77a573c5 322 FileHandle* fhc = filehandles[fh-3];
Mihail Stoyanov 6088:e1cf77a573c5 323 if (fhc == NULL) return -1;
Mihail Stoyanov 6088:e1cf77a573c5 324
Mihail Stoyanov 6088:e1cf77a573c5 325 #if defined(__ARMCC_VERSION)
Mihail Stoyanov 6088:e1cf77a573c5 326 return fhc->lseek(position, SEEK_SET);
Mihail Stoyanov 6088:e1cf77a573c5 327 #else
Mihail Stoyanov 6088:e1cf77a573c5 328 return fhc->lseek(offset, whence);
Mihail Stoyanov 6088:e1cf77a573c5 329 #endif
Mihail Stoyanov 6088:e1cf77a573c5 330 }
Mihail Stoyanov 6088:e1cf77a573c5 331
Mihail Stoyanov 6088:e1cf77a573c5 332 #ifdef __ARMCC_VERSION
Mihail Stoyanov 6088:e1cf77a573c5 333 extern "C" int PREFIX(_ensure)(FILEHANDLE fh) {
Mihail Stoyanov 6088:e1cf77a573c5 334 if (fh < 3) return 0;
Mihail Stoyanov 6088:e1cf77a573c5 335
Mihail Stoyanov 6088:e1cf77a573c5 336 FileHandle* fhc = filehandles[fh-3];
Mihail Stoyanov 6088:e1cf77a573c5 337 if (fhc == NULL) return -1;
Mihail Stoyanov 6088:e1cf77a573c5 338
Mihail Stoyanov 6088:e1cf77a573c5 339 return fhc->fsync();
Mihail Stoyanov 6088:e1cf77a573c5 340 }
Mihail Stoyanov 6088:e1cf77a573c5 341
Mihail Stoyanov 6088:e1cf77a573c5 342 extern "C" long PREFIX(_flen)(FILEHANDLE fh) {
Mihail Stoyanov 6088:e1cf77a573c5 343 if (fh < 3) return 0;
Mihail Stoyanov 6088:e1cf77a573c5 344
Mihail Stoyanov 6088:e1cf77a573c5 345 FileHandle* fhc = filehandles[fh-3];
Mihail Stoyanov 6088:e1cf77a573c5 346 if (fhc == NULL) return -1;
Mihail Stoyanov 6088:e1cf77a573c5 347
Mihail Stoyanov 6088:e1cf77a573c5 348 return fhc->flen();
Mihail Stoyanov 6088:e1cf77a573c5 349 }
Mihail Stoyanov 6088:e1cf77a573c5 350 #endif
Mihail Stoyanov 6088:e1cf77a573c5 351
Mihail Stoyanov 6088:e1cf77a573c5 352
Mihail Stoyanov 6088:e1cf77a573c5 353 #if !defined(__ARMCC_VERSION) && !defined(__ICCARM__)
Mihail Stoyanov 6088:e1cf77a573c5 354 extern "C" int _fstat(int fd, struct stat *st) {
Mihail Stoyanov 6088:e1cf77a573c5 355 if ((STDOUT_FILENO == fd) || (STDERR_FILENO == fd) || (STDIN_FILENO == fd)) {
Mihail Stoyanov 6088:e1cf77a573c5 356 st->st_mode = S_IFCHR;
Mihail Stoyanov 6088:e1cf77a573c5 357 return 0;
Mihail Stoyanov 6088:e1cf77a573c5 358 }
Mihail Stoyanov 6088:e1cf77a573c5 359
Mihail Stoyanov 6088:e1cf77a573c5 360 errno = EBADF;
Mihail Stoyanov 6088:e1cf77a573c5 361 return -1;
Mihail Stoyanov 6088:e1cf77a573c5 362 }
Mihail Stoyanov 6088:e1cf77a573c5 363 #endif
Mihail Stoyanov 6088:e1cf77a573c5 364
Mihail Stoyanov 6088:e1cf77a573c5 365 namespace std {
Mihail Stoyanov 6088:e1cf77a573c5 366 extern "C" int remove(const char *path) {
Mihail Stoyanov 6088:e1cf77a573c5 367 FilePath fp(path);
Mihail Stoyanov 6088:e1cf77a573c5 368 FileSystemLike *fs = fp.fileSystem();
Mihail Stoyanov 6088:e1cf77a573c5 369 if (fs == NULL) return -1;
Mihail Stoyanov 6088:e1cf77a573c5 370
Mihail Stoyanov 6088:e1cf77a573c5 371 return fs->remove(fp.fileName());
Mihail Stoyanov 6088:e1cf77a573c5 372 }
Mihail Stoyanov 6088:e1cf77a573c5 373
Mihail Stoyanov 6088:e1cf77a573c5 374 extern "C" int rename(const char *oldname, const char *newname) {
Mihail Stoyanov 6088:e1cf77a573c5 375 FilePath fpOld(oldname);
Mihail Stoyanov 6088:e1cf77a573c5 376 FilePath fpNew(newname);
Mihail Stoyanov 6088:e1cf77a573c5 377 FileSystemLike *fsOld = fpOld.fileSystem();
Mihail Stoyanov 6088:e1cf77a573c5 378 FileSystemLike *fsNew = fpNew.fileSystem();
Mihail Stoyanov 6088:e1cf77a573c5 379
Mihail Stoyanov 6088:e1cf77a573c5 380 /* rename only if both files are on the same FS */
Mihail Stoyanov 6088:e1cf77a573c5 381 if (fsOld != fsNew || fsOld == NULL) return -1;
Mihail Stoyanov 6088:e1cf77a573c5 382
Mihail Stoyanov 6088:e1cf77a573c5 383 return fsOld->rename(fpOld.fileName(), fpNew.fileName());
Mihail Stoyanov 6088:e1cf77a573c5 384 }
Mihail Stoyanov 6088:e1cf77a573c5 385
Mihail Stoyanov 6088:e1cf77a573c5 386 extern "C" char *tmpnam(char *s) {
Mihail Stoyanov 6088:e1cf77a573c5 387 return NULL;
Mihail Stoyanov 6088:e1cf77a573c5 388 }
Mihail Stoyanov 6088:e1cf77a573c5 389
Mihail Stoyanov 6088:e1cf77a573c5 390 extern "C" FILE *tmpfile() {
Mihail Stoyanov 6088:e1cf77a573c5 391 return NULL;
Mihail Stoyanov 6088:e1cf77a573c5 392 }
Mihail Stoyanov 6088:e1cf77a573c5 393 } // namespace std
Mihail Stoyanov 6088:e1cf77a573c5 394
Mihail Stoyanov 6088:e1cf77a573c5 395 #ifdef __ARMCC_VERSION
Mihail Stoyanov 6088:e1cf77a573c5 396 extern "C" char *_sys_command_string(char *cmd, int len) {
Mihail Stoyanov 6088:e1cf77a573c5 397 return NULL;
Mihail Stoyanov 6088:e1cf77a573c5 398 }
Mihail Stoyanov 6088:e1cf77a573c5 399 #endif
Mihail Stoyanov 6088:e1cf77a573c5 400
Mihail Stoyanov 6088:e1cf77a573c5 401 extern "C" DIR *opendir(const char *path) {
Mihail Stoyanov 6088:e1cf77a573c5 402 /* root dir is FileSystemLike */
Mihail Stoyanov 6088:e1cf77a573c5 403 if (path[0] == '/' && path[1] == 0) {
Mihail Stoyanov 6088:e1cf77a573c5 404 return FileSystemLike::opendir();
Mihail Stoyanov 6088:e1cf77a573c5 405 }
Mihail Stoyanov 6088:e1cf77a573c5 406
Mihail Stoyanov 6088:e1cf77a573c5 407 FilePath fp(path);
Mihail Stoyanov 6088:e1cf77a573c5 408 FileSystemLike* fs = fp.fileSystem();
Mihail Stoyanov 6088:e1cf77a573c5 409 if (fs == NULL) return NULL;
Mihail Stoyanov 6088:e1cf77a573c5 410
Mihail Stoyanov 6088:e1cf77a573c5 411 return fs->opendir(fp.fileName());
Mihail Stoyanov 6088:e1cf77a573c5 412 }
Mihail Stoyanov 6088:e1cf77a573c5 413
Mihail Stoyanov 6088:e1cf77a573c5 414 extern "C" struct dirent *readdir(DIR *dir) {
Mihail Stoyanov 6088:e1cf77a573c5 415 return dir->readdir();
Mihail Stoyanov 6088:e1cf77a573c5 416 }
Mihail Stoyanov 6088:e1cf77a573c5 417
Mihail Stoyanov 6088:e1cf77a573c5 418 extern "C" int closedir(DIR *dir) {
Mihail Stoyanov 6088:e1cf77a573c5 419 return dir->closedir();
Mihail Stoyanov 6088:e1cf77a573c5 420 }
Mihail Stoyanov 6088:e1cf77a573c5 421
Mihail Stoyanov 6088:e1cf77a573c5 422 extern "C" void rewinddir(DIR *dir) {
Mihail Stoyanov 6088:e1cf77a573c5 423 dir->rewinddir();
Mihail Stoyanov 6088:e1cf77a573c5 424 }
Mihail Stoyanov 6088:e1cf77a573c5 425
Mihail Stoyanov 6088:e1cf77a573c5 426 extern "C" off_t telldir(DIR *dir) {
Mihail Stoyanov 6088:e1cf77a573c5 427 return dir->telldir();
Mihail Stoyanov 6088:e1cf77a573c5 428 }
Mihail Stoyanov 6088:e1cf77a573c5 429
Mihail Stoyanov 6088:e1cf77a573c5 430 extern "C" void seekdir(DIR *dir, off_t off) {
Mihail Stoyanov 6088:e1cf77a573c5 431 dir->seekdir(off);
Mihail Stoyanov 6088:e1cf77a573c5 432 }
Mihail Stoyanov 6088:e1cf77a573c5 433
Mihail Stoyanov 6088:e1cf77a573c5 434 extern "C" int mkdir(const char *path, mode_t mode) {
Mihail Stoyanov 6088:e1cf77a573c5 435 FilePath fp(path);
Mihail Stoyanov 6088:e1cf77a573c5 436 FileSystemLike *fs = fp.fileSystem();
Mihail Stoyanov 6088:e1cf77a573c5 437 if (fs == NULL) return -1;
Mihail Stoyanov 6088:e1cf77a573c5 438
Mihail Stoyanov 6088:e1cf77a573c5 439 return fs->mkdir(fp.fileName(), mode);
Mihail Stoyanov 6088:e1cf77a573c5 440 }
Mihail Stoyanov 6088:e1cf77a573c5 441
Mihail Stoyanov 6088:e1cf77a573c5 442 #if defined(TOOLCHAIN_GCC)
Mihail Stoyanov 6088:e1cf77a573c5 443 /* prevents the exception handling name demangling code getting pulled in */
Mihail Stoyanov 6088:e1cf77a573c5 444 #include "mbed_error.h"
Mihail Stoyanov 6088:e1cf77a573c5 445 namespace __gnu_cxx {
Mihail Stoyanov 6088:e1cf77a573c5 446 void __verbose_terminate_handler() {
Mihail Stoyanov 6088:e1cf77a573c5 447 error("Exception");
Mihail Stoyanov 6088:e1cf77a573c5 448 }
Mihail Stoyanov 6088:e1cf77a573c5 449 }
Mihail Stoyanov 6088:e1cf77a573c5 450 extern "C" WEAK void __cxa_pure_virtual(void);
Mihail Stoyanov 6088:e1cf77a573c5 451 extern "C" WEAK void __cxa_pure_virtual(void) {
Mihail Stoyanov 6088:e1cf77a573c5 452 exit(1);
Mihail Stoyanov 6088:e1cf77a573c5 453 }
Mihail Stoyanov 6088:e1cf77a573c5 454
Mihail Stoyanov 6088:e1cf77a573c5 455 #endif
Mihail Stoyanov 6088:e1cf77a573c5 456
Jaeden Amero 6335:6fbbee1c9fd1 457 #if defined(TOOLCHAIN_GCC)
Jaeden Amero 6336:a0ee59c4aa27 458 #ifdef FEATURE_UVISOR
Jaeden Amero 6336:a0ee59c4aa27 459 #include "uvisor-lib/uvisor-lib.h"
Jaeden Amero 6336:a0ee59c4aa27 460 #endif/* FEATURE_UVISOR */
Jaeden Amero 6336:a0ee59c4aa27 461
Niklas Hauser 6337:760e146953ef 462 #ifndef FEATURE_UVISOR
Niklas Hauser 6337:760e146953ef 463 extern "C" {
Niklas Hauser 6337:760e146953ef 464 void * __wrap__malloc_r(struct _reent * r, size_t size) {
Niklas Hauser 6337:760e146953ef 465 extern void * __real__malloc_r(struct _reent * r, size_t size);
Niklas Hauser 6337:760e146953ef 466 return __real__malloc_r(r, size);
Niklas Hauser 6337:760e146953ef 467 }
Niklas Hauser 6337:760e146953ef 468 void * __wrap__realloc_r(struct _reent * r, void * ptr, size_t size) {
Niklas Hauser 6337:760e146953ef 469 extern void * __real__realloc_r(struct _reent * r, void * ptr, size_t size);
Niklas Hauser 6337:760e146953ef 470 return __real__realloc_r(r, ptr, size);
Niklas Hauser 6337:760e146953ef 471 }
Niklas Hauser 6337:760e146953ef 472 void __wrap__free_r(struct _reent * r, void * ptr) {
Niklas Hauser 6337:760e146953ef 473 extern void __real__free_r(struct _reent * r, void * ptr);
Niklas Hauser 6337:760e146953ef 474 __real__free_r(r, ptr);
Niklas Hauser 6337:760e146953ef 475 }
Niklas Hauser 6337:760e146953ef 476 }
Niklas Hauser 6337:760e146953ef 477 #endif/* FEATURE_UVISOR */
Niklas Hauser 6337:760e146953ef 478
Jaeden Amero 6335:6fbbee1c9fd1 479 extern "C" WEAK void software_init_hook_rtos(void)
Jaeden Amero 6335:6fbbee1c9fd1 480 {
Jaeden Amero 6335:6fbbee1c9fd1 481 // Do nothing by default.
Jaeden Amero 6335:6fbbee1c9fd1 482 }
Jaeden Amero 6335:6fbbee1c9fd1 483
Jaeden Amero 6335:6fbbee1c9fd1 484 extern "C" void software_init_hook(void)
Jaeden Amero 6335:6fbbee1c9fd1 485 {
Jaeden Amero 6336:a0ee59c4aa27 486 #ifdef FEATURE_UVISOR
Jaeden Amero 6336:a0ee59c4aa27 487 int return_code;
Jaeden Amero 6336:a0ee59c4aa27 488
Jaeden Amero 6336:a0ee59c4aa27 489 return_code = uvisor_lib_init();
Jaeden Amero 6336:a0ee59c4aa27 490 if (return_code) {
Jaeden Amero 6336:a0ee59c4aa27 491 mbed_die();
Jaeden Amero 6336:a0ee59c4aa27 492 }
Jaeden Amero 6336:a0ee59c4aa27 493 #endif/* FEATURE_UVISOR */
Jaeden Amero 6336:a0ee59c4aa27 494
Jaeden Amero 6335:6fbbee1c9fd1 495 software_init_hook_rtos();
Jaeden Amero 6335:6fbbee1c9fd1 496 }
Jaeden Amero 6335:6fbbee1c9fd1 497 #endif
Jaeden Amero 6335:6fbbee1c9fd1 498
Mihail Stoyanov 6088:e1cf77a573c5 499 // ****************************************************************************
Mihail Stoyanov 6088:e1cf77a573c5 500 // mbed_main is a function that is called before main()
Mihail Stoyanov 6088:e1cf77a573c5 501 // mbed_sdk_init() is also a function that is called before main(), but unlike
Mihail Stoyanov 6088:e1cf77a573c5 502 // mbed_main(), it is not meant for user code, but for the SDK itself to perform
Mihail Stoyanov 6088:e1cf77a573c5 503 // initializations before main() is called.
Mihail Stoyanov 6088:e1cf77a573c5 504
Mihail Stoyanov 6088:e1cf77a573c5 505 extern "C" WEAK void mbed_main(void);
Mihail Stoyanov 6088:e1cf77a573c5 506 extern "C" WEAK void mbed_main(void) {
Mihail Stoyanov 6088:e1cf77a573c5 507 }
Mihail Stoyanov 6088:e1cf77a573c5 508
Mihail Stoyanov 6088:e1cf77a573c5 509 extern "C" WEAK void mbed_sdk_init(void);
Mihail Stoyanov 6088:e1cf77a573c5 510 extern "C" WEAK void mbed_sdk_init(void) {
Mihail Stoyanov 6088:e1cf77a573c5 511 }
Mihail Stoyanov 6088:e1cf77a573c5 512
Mihail Stoyanov 6088:e1cf77a573c5 513 #if defined(TOOLCHAIN_ARM)
Mihail Stoyanov 6088:e1cf77a573c5 514 extern "C" int $Super$$main(void);
Mihail Stoyanov 6088:e1cf77a573c5 515
Mihail Stoyanov 6088:e1cf77a573c5 516 extern "C" int $Sub$$main(void) {
Mihail Stoyanov 6088:e1cf77a573c5 517 mbed_sdk_init();
Mihail Stoyanov 6088:e1cf77a573c5 518 mbed_main();
Mihail Stoyanov 6088:e1cf77a573c5 519 return $Super$$main();
Mihail Stoyanov 6088:e1cf77a573c5 520 }
Mihail Stoyanov 6088:e1cf77a573c5 521 #elif defined(TOOLCHAIN_GCC)
Mihail Stoyanov 6088:e1cf77a573c5 522 extern "C" int __real_main(void);
Mihail Stoyanov 6088:e1cf77a573c5 523
Mihail Stoyanov 6088:e1cf77a573c5 524 extern "C" int __wrap_main(void) {
Mihail Stoyanov 6088:e1cf77a573c5 525 mbed_sdk_init();
Mihail Stoyanov 6088:e1cf77a573c5 526 mbed_main();
Mihail Stoyanov 6088:e1cf77a573c5 527 return __real_main();
Mihail Stoyanov 6088:e1cf77a573c5 528 }
Mihail Stoyanov 6088:e1cf77a573c5 529 #elif defined(TOOLCHAIN_IAR)
Mihail Stoyanov 6088:e1cf77a573c5 530 // IAR doesn't have the $Super/$Sub mechanism of armcc, nor something equivalent
Mihail Stoyanov 6088:e1cf77a573c5 531 // to ld's --wrap. It does have a --redirect, but that doesn't help, since redirecting
Mihail Stoyanov 6088:e1cf77a573c5 532 // 'main' to another symbol looses the original 'main' symbol. However, its startup
Mihail Stoyanov 6088:e1cf77a573c5 533 // code will call a function to setup argc and argv (__iar_argc_argv) if it is defined.
Mihail Stoyanov 6088:e1cf77a573c5 534 // Since mbed doesn't use argc/argv, we use this function to call our mbed_main.
Mihail Stoyanov 6088:e1cf77a573c5 535 extern "C" void __iar_argc_argv() {
Mihail Stoyanov 6088:e1cf77a573c5 536 mbed_sdk_init();
Mihail Stoyanov 6088:e1cf77a573c5 537 mbed_main();
Mihail Stoyanov 6088:e1cf77a573c5 538 }
Mihail Stoyanov 6088:e1cf77a573c5 539 #endif
Mihail Stoyanov 6088:e1cf77a573c5 540
Mihail Stoyanov 6088:e1cf77a573c5 541 // Provide implementation of _sbrk (low-level dynamic memory allocation
Mihail Stoyanov 6088:e1cf77a573c5 542 // routine) for GCC_ARM which compares new heap pointer with MSP instead of
Mihail Stoyanov 6088:e1cf77a573c5 543 // SP. This make it compatible with RTX RTOS thread stacks.
Mihail Stoyanov 6088:e1cf77a573c5 544 #if defined(TOOLCHAIN_GCC_ARM)
Mihail Stoyanov 6088:e1cf77a573c5 545 // Linker defined symbol used by _sbrk to indicate where heap should start.
Mihail Stoyanov 6088:e1cf77a573c5 546 extern "C" int __end__;
Mihail Stoyanov 6088:e1cf77a573c5 547
Mihail Stoyanov 6088:e1cf77a573c5 548 #if defined(TARGET_CORTEX_A)
Mihail Stoyanov 6088:e1cf77a573c5 549 extern "C" uint32_t __HeapLimit;
Mihail Stoyanov 6088:e1cf77a573c5 550 #endif
Mihail Stoyanov 6088:e1cf77a573c5 551
Mihail Stoyanov 6088:e1cf77a573c5 552 // Turn off the errno macro and use actual global variable instead.
Mihail Stoyanov 6088:e1cf77a573c5 553 #undef errno
Mihail Stoyanov 6088:e1cf77a573c5 554 extern "C" int errno;
Mihail Stoyanov 6088:e1cf77a573c5 555
Mihail Stoyanov 6088:e1cf77a573c5 556 // For ARM7 only
Mihail Stoyanov 6088:e1cf77a573c5 557 register unsigned char * stack_ptr __asm ("sp");
Mihail Stoyanov 6088:e1cf77a573c5 558
Mihail Stoyanov 6088:e1cf77a573c5 559 // Dynamic memory allocation related syscall.
Mihail Stoyanov 6088:e1cf77a573c5 560 extern "C" caddr_t _sbrk(int incr) {
Mihail Stoyanov 6088:e1cf77a573c5 561 static unsigned char* heap = (unsigned char*)&__end__;
Mihail Stoyanov 6088:e1cf77a573c5 562 unsigned char* prev_heap = heap;
Mihail Stoyanov 6088:e1cf77a573c5 563 unsigned char* new_heap = heap + incr;
Mihail Stoyanov 6088:e1cf77a573c5 564
Mihail Stoyanov 6088:e1cf77a573c5 565 #if defined(TARGET_ARM7)
Mihail Stoyanov 6088:e1cf77a573c5 566 if (new_heap >= stack_ptr) {
Mihail Stoyanov 6088:e1cf77a573c5 567 #elif defined(TARGET_CORTEX_A)
Mihail Stoyanov 6088:e1cf77a573c5 568 if (new_heap >= (unsigned char*)&__HeapLimit) { /* __HeapLimit is end of heap section */
Mihail Stoyanov 6088:e1cf77a573c5 569 #else
Mihail Stoyanov 6088:e1cf77a573c5 570 if (new_heap >= (unsigned char*)__get_MSP()) {
Mihail Stoyanov 6088:e1cf77a573c5 571 #endif
Mihail Stoyanov 6088:e1cf77a573c5 572 errno = ENOMEM;
Mihail Stoyanov 6088:e1cf77a573c5 573 return (caddr_t)-1;
Mihail Stoyanov 6088:e1cf77a573c5 574 }
Mihail Stoyanov 6088:e1cf77a573c5 575
Mihail Stoyanov 6088:e1cf77a573c5 576 heap = new_heap;
Mihail Stoyanov 6088:e1cf77a573c5 577 return (caddr_t) prev_heap;
Mihail Stoyanov 6088:e1cf77a573c5 578 }
Mihail Stoyanov 6088:e1cf77a573c5 579 #endif
Mihail Stoyanov 6088:e1cf77a573c5 580
Mihail Stoyanov 6088:e1cf77a573c5 581
Mihail Stoyanov 6088:e1cf77a573c5 582 #if defined TOOLCHAIN_GCC_ARM
Mihail Stoyanov 6088:e1cf77a573c5 583 extern "C" void _exit(int return_code) {
Mihail Stoyanov 6088:e1cf77a573c5 584 #else
Mihail Stoyanov 6088:e1cf77a573c5 585 namespace std {
Mihail Stoyanov 6088:e1cf77a573c5 586 extern "C" void exit(int return_code) {
Mihail Stoyanov 6088:e1cf77a573c5 587 #endif
Mihail Stoyanov 6088:e1cf77a573c5 588
Mihail Stoyanov 6088:e1cf77a573c5 589 #if DEVICE_STDIO_MESSAGES
Mihail Stoyanov 6088:e1cf77a573c5 590 fflush(stdout);
Mihail Stoyanov 6088:e1cf77a573c5 591 fflush(stderr);
Mihail Stoyanov 6088:e1cf77a573c5 592 #endif
Mihail Stoyanov 6088:e1cf77a573c5 593
Mihail Stoyanov 6088:e1cf77a573c5 594 #if DEVICE_SEMIHOST
Mihail Stoyanov 6088:e1cf77a573c5 595 if (mbed_interface_connected()) {
Mihail Stoyanov 6088:e1cf77a573c5 596 semihost_exit();
Mihail Stoyanov 6088:e1cf77a573c5 597 }
Mihail Stoyanov 6088:e1cf77a573c5 598 #endif
Mihail Stoyanov 6088:e1cf77a573c5 599 if (return_code) {
Mihail Stoyanov 6088:e1cf77a573c5 600 mbed_die();
Mihail Stoyanov 6088:e1cf77a573c5 601 }
Mihail Stoyanov 6088:e1cf77a573c5 602
Mihail Stoyanov 6088:e1cf77a573c5 603 while (1);
Mihail Stoyanov 6088:e1cf77a573c5 604 }
Mihail Stoyanov 6088:e1cf77a573c5 605
Mihail Stoyanov 6088:e1cf77a573c5 606 #if !defined(TOOLCHAIN_GCC_ARM)
Mihail Stoyanov 6088:e1cf77a573c5 607 } //namespace std
Mihail Stoyanov 6088:e1cf77a573c5 608 #endif
Mihail Stoyanov 6088:e1cf77a573c5 609
Mihail Stoyanov 6088:e1cf77a573c5 610
Mihail Stoyanov 6088:e1cf77a573c5 611 namespace mbed {
Mihail Stoyanov 6088:e1cf77a573c5 612
Mihail Stoyanov 6088:e1cf77a573c5 613 void mbed_set_unbuffered_stream(FILE *_file) {
Mihail Stoyanov 6088:e1cf77a573c5 614 #if defined (__ICCARM__)
Mihail Stoyanov 6088:e1cf77a573c5 615 char buf[2];
Mihail Stoyanov 6088:e1cf77a573c5 616 std::setvbuf(_file,buf,_IONBF,NULL);
Mihail Stoyanov 6088:e1cf77a573c5 617 #else
Mihail Stoyanov 6088:e1cf77a573c5 618 setbuf(_file, NULL);
Mihail Stoyanov 6088:e1cf77a573c5 619 #endif
Mihail Stoyanov 6088:e1cf77a573c5 620 }
Mihail Stoyanov 6088:e1cf77a573c5 621
Mihail Stoyanov 6088:e1cf77a573c5 622 int mbed_getc(FILE *_file){
Mihail Stoyanov 6088:e1cf77a573c5 623 #if defined (__ICCARM__)
Mihail Stoyanov 6088:e1cf77a573c5 624 /*This is only valid for unbuffered streams*/
Mihail Stoyanov 6088:e1cf77a573c5 625 int res = std::fgetc(_file);
Mihail Stoyanov 6088:e1cf77a573c5 626 if (res>=0){
Mihail Stoyanov 6088:e1cf77a573c5 627 _file->_Mode = (unsigned short)(_file->_Mode & ~ 0x1000);/* Unset read mode */
Mihail Stoyanov 6088:e1cf77a573c5 628 _file->_Rend = _file->_Wend;
Mihail Stoyanov 6088:e1cf77a573c5 629 _file->_Next = _file->_Wend;
Mihail Stoyanov 6088:e1cf77a573c5 630 }
Mihail Stoyanov 6088:e1cf77a573c5 631 return res;
Mihail Stoyanov 6088:e1cf77a573c5 632 #else
Mihail Stoyanov 6088:e1cf77a573c5 633 return std::fgetc(_file);
Mihail Stoyanov 6088:e1cf77a573c5 634 #endif
Mihail Stoyanov 6088:e1cf77a573c5 635 }
Mihail Stoyanov 6088:e1cf77a573c5 636
Mihail Stoyanov 6088:e1cf77a573c5 637 char* mbed_gets(char*s, int size, FILE *_file){
Mihail Stoyanov 6088:e1cf77a573c5 638 #if defined (__ICCARM__)
Mihail Stoyanov 6088:e1cf77a573c5 639 /*This is only valid for unbuffered streams*/
Mihail Stoyanov 6088:e1cf77a573c5 640 char *str = fgets(s,size,_file);
Mihail Stoyanov 6088:e1cf77a573c5 641 if (str!=NULL){
Mihail Stoyanov 6088:e1cf77a573c5 642 _file->_Mode = (unsigned short)(_file->_Mode & ~ 0x1000);/* Unset read mode */
Mihail Stoyanov 6088:e1cf77a573c5 643 _file->_Rend = _file->_Wend;
Mihail Stoyanov 6088:e1cf77a573c5 644 _file->_Next = _file->_Wend;
Mihail Stoyanov 6088:e1cf77a573c5 645 }
Mihail Stoyanov 6088:e1cf77a573c5 646 return str;
Mihail Stoyanov 6088:e1cf77a573c5 647 #else
Mihail Stoyanov 6088:e1cf77a573c5 648 return std::fgets(s,size,_file);
Mihail Stoyanov 6088:e1cf77a573c5 649 #endif
Mihail Stoyanov 6088:e1cf77a573c5 650 }
Mihail Stoyanov 6088:e1cf77a573c5 651
Russ Butler 6200:8000bcdea61d 652 #if defined (__ICCARM__)
Russ Butler 6200:8000bcdea61d 653 // Stub out locks when an rtos is not present
Russ Butler 6200:8000bcdea61d 654 extern "C" WEAK void __iar_system_Mtxinit(__iar_Rmtx *mutex) {}
Russ Butler 6200:8000bcdea61d 655 extern "C" WEAK void __iar_system_Mtxdst(__iar_Rmtx *mutex) {}
Russ Butler 6200:8000bcdea61d 656 extern "C" WEAK void __iar_system_Mtxlock(__iar_Rmtx *mutex) {}
Russ Butler 6200:8000bcdea61d 657 extern "C" WEAK void __iar_system_Mtxunlock(__iar_Rmtx *mutex) {}
Russ Butler 6200:8000bcdea61d 658 extern "C" WEAK void __iar_file_Mtxinit(__iar_Rmtx *mutex) {}
Russ Butler 6200:8000bcdea61d 659 extern "C" WEAK void __iar_file_Mtxdst(__iar_Rmtx *mutex) {}
Russ Butler 6200:8000bcdea61d 660 extern "C" WEAK void __iar_file_Mtxlock(__iar_Rmtx *mutex) {}
Russ Butler 6200:8000bcdea61d 661 extern "C" WEAK void __iar_file_Mtxunlock(__iar_Rmtx *mutex) {}
Russ Butler 6387:1e339dc397e1 662 #elif defined(__CC_ARM)
Russ Butler 6387:1e339dc397e1 663 // Do nothing
Russ Butler 6387:1e339dc397e1 664 #elif defined (__GNUC__)
Russ Butler 6387:1e339dc397e1 665 struct _reent;
Russ Butler 6387:1e339dc397e1 666 // Stub out locks when an rtos is not present
Russ Butler 6387:1e339dc397e1 667 extern "C" WEAK void __rtos_malloc_lock( struct _reent *_r ) {}
Russ Butler 6387:1e339dc397e1 668 extern "C" WEAK void __rtos_malloc_unlock( struct _reent *_r ) {}
Russ Butler 6387:1e339dc397e1 669 extern "C" WEAK void __rtos_env_lock( struct _reent *_r ) {}
Russ Butler 6387:1e339dc397e1 670 extern "C" WEAK void __rtos_env_unlock( struct _reent *_r ) {}
Russ Butler 6387:1e339dc397e1 671
Russ Butler 6396:723dcc4c67dd 672 extern "C" void __malloc_lock( struct _reent *_r )
Russ Butler 6387:1e339dc397e1 673 {
Russ Butler 6387:1e339dc397e1 674 __rtos_malloc_lock(_r);
Russ Butler 6387:1e339dc397e1 675 }
Russ Butler 6387:1e339dc397e1 676
Russ Butler 6396:723dcc4c67dd 677 extern "C" void __malloc_unlock( struct _reent *_r )
Russ Butler 6387:1e339dc397e1 678 {
Russ Butler 6387:1e339dc397e1 679 __rtos_malloc_unlock(_r);
Russ Butler 6387:1e339dc397e1 680 }
Russ Butler 6387:1e339dc397e1 681
Russ Butler 6396:723dcc4c67dd 682 extern "C" void __env_lock( struct _reent *_r )
Russ Butler 6387:1e339dc397e1 683 {
Russ Butler 6387:1e339dc397e1 684 __rtos_env_lock(_r);
Russ Butler 6387:1e339dc397e1 685 }
Russ Butler 6387:1e339dc397e1 686
Russ Butler 6396:723dcc4c67dd 687 extern "C" void __env_unlock( struct _reent *_r )
Russ Butler 6387:1e339dc397e1 688 {
Russ Butler 6387:1e339dc397e1 689 __rtos_env_unlock(_r);
Russ Butler 6387:1e339dc397e1 690 }
Russ Butler 6200:8000bcdea61d 691 #endif
Russ Butler 6200:8000bcdea61d 692
Mihail Stoyanov 6088:e1cf77a573c5 693 } // namespace mbed