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