不韋 呂 / F746_AcousticEffector_MIC

Audio singal input and output example for DISCO-F746. Input: MEMS mic, Output: CN10 OUT, Acoustic effect: echo and frequency shift. DISCO-F746 によるオーディオ信号入出力．入力：MEMS マイク，出力：CN10 OUT，音響効果：エコー，周波数変換．

Dependencies:   F746_GUI F746_SAI_IO

mbed_src_STM32F7/common/retarget.cpp@10:56f2f01df983, 2017-04-10 (annotated)

Committer:
MikamiUitOpen
Date:
Mon Apr 10 13:44:13 2017 +0000
Revision:
10:56f2f01df983
Parent:
6:38f7dce055d0 
11

Who changed what in which revision?

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