The code from https://github.com/vpcola/Nucleo

Committer:
sinrab
Date:
Wed Oct 08 11:00:24 2014 +0000
Revision:
0:5464d5e415e5
The code from https://github.com/vpcola/Nucleo

Who changed what in which revision?

UserRevisionLine numberNew contents of line
sinrab 0:5464d5e415e5 1 /* mbed Microcontroller Library
sinrab 0:5464d5e415e5 2 * Copyright (c) 2006-2013 ARM Limited
sinrab 0:5464d5e415e5 3 *
sinrab 0:5464d5e415e5 4 * Licensed under the Apache License, Version 2.0 (the "License");
sinrab 0:5464d5e415e5 5 * you may not use this file except in compliance with the License.
sinrab 0:5464d5e415e5 6 * You may obtain a copy of the License at
sinrab 0:5464d5e415e5 7 *
sinrab 0:5464d5e415e5 8 * http://www.apache.org/licenses/LICENSE-2.0
sinrab 0:5464d5e415e5 9 *
sinrab 0:5464d5e415e5 10 * Unless required by applicable law or agreed to in writing, software
sinrab 0:5464d5e415e5 11 * distributed under the License is distributed on an "AS IS" BASIS,
sinrab 0:5464d5e415e5 12 * WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied.
sinrab 0:5464d5e415e5 13 * See the License for the specific language governing permissions and
sinrab 0:5464d5e415e5 14 * limitations under the License.
sinrab 0:5464d5e415e5 15 */
sinrab 0:5464d5e415e5 16 #include "LocalFileSystem.h"
sinrab 0:5464d5e415e5 17
sinrab 0:5464d5e415e5 18 #if DEVICE_LOCALFILESYSTEM
sinrab 0:5464d5e415e5 19
sinrab 0:5464d5e415e5 20 #include "semihost_api.h"
sinrab 0:5464d5e415e5 21 #include <string.h>
sinrab 0:5464d5e415e5 22 #include <stdio.h>
sinrab 0:5464d5e415e5 23
sinrab 0:5464d5e415e5 24 namespace mbed {
sinrab 0:5464d5e415e5 25
sinrab 0:5464d5e415e5 26 /* Extension to FINFO type defined in RTL.h (in Keil RL) - adds 'create time'. */
sinrab 0:5464d5e415e5 27 typedef struct {
sinrab 0:5464d5e415e5 28 unsigned char hr; /* Hours [0..23] */
sinrab 0:5464d5e415e5 29 unsigned char min; /* Minutes [0..59] */
sinrab 0:5464d5e415e5 30 unsigned char sec; /* Seconds [0..59] */
sinrab 0:5464d5e415e5 31 unsigned char day; /* Day [1..31] */
sinrab 0:5464d5e415e5 32 unsigned char mon; /* Month [1..12] */
sinrab 0:5464d5e415e5 33 unsigned short year; /* Year [1980..2107] */
sinrab 0:5464d5e415e5 34 } FTIME;
sinrab 0:5464d5e415e5 35
sinrab 0:5464d5e415e5 36 typedef struct { /* File Search info record */
sinrab 0:5464d5e415e5 37 char name[32]; /* File name */
sinrab 0:5464d5e415e5 38 long size; /* File size in bytes */
sinrab 0:5464d5e415e5 39 int fileID; /* System File Identification */
sinrab 0:5464d5e415e5 40 FTIME create_time; /* Date & time file was created */
sinrab 0:5464d5e415e5 41 FTIME write_time; /* Date & time of last write */
sinrab 0:5464d5e415e5 42 } XFINFO;
sinrab 0:5464d5e415e5 43
sinrab 0:5464d5e415e5 44 #define RESERVED_FOR_USER_APPLICATIONS (0x100) /* 0x100 - 0x1ff */
sinrab 0:5464d5e415e5 45 #define USR_XFFIND (RESERVED_FOR_USER_APPLICATIONS + 0)
sinrab 0:5464d5e415e5 46
sinrab 0:5464d5e415e5 47 static int xffind (const char *pattern, XFINFO *info) {
sinrab 0:5464d5e415e5 48 unsigned param[4];
sinrab 0:5464d5e415e5 49
sinrab 0:5464d5e415e5 50 param[0] = (unsigned long)pattern;
sinrab 0:5464d5e415e5 51 param[1] = (unsigned long)strlen(pattern);
sinrab 0:5464d5e415e5 52 param[2] = (unsigned long)info;
sinrab 0:5464d5e415e5 53 param[3] = (unsigned long)sizeof(XFINFO);
sinrab 0:5464d5e415e5 54
sinrab 0:5464d5e415e5 55 return __semihost(USR_XFFIND, param);
sinrab 0:5464d5e415e5 56 }
sinrab 0:5464d5e415e5 57
sinrab 0:5464d5e415e5 58 #define OPEN_R 0
sinrab 0:5464d5e415e5 59 #define OPEN_B 1
sinrab 0:5464d5e415e5 60 #define OPEN_PLUS 2
sinrab 0:5464d5e415e5 61 #define OPEN_W 4
sinrab 0:5464d5e415e5 62 #define OPEN_A 8
sinrab 0:5464d5e415e5 63 #define OPEN_INVALID -1
sinrab 0:5464d5e415e5 64
sinrab 0:5464d5e415e5 65 int posix_to_semihost_open_flags(int flags) {
sinrab 0:5464d5e415e5 66 /* POSIX flags -> semihosting open mode */
sinrab 0:5464d5e415e5 67 int openmode;
sinrab 0:5464d5e415e5 68 if (flags & O_RDWR) {
sinrab 0:5464d5e415e5 69 /* a plus mode */
sinrab 0:5464d5e415e5 70 openmode = OPEN_PLUS;
sinrab 0:5464d5e415e5 71 if (flags & O_APPEND) {
sinrab 0:5464d5e415e5 72 openmode |= OPEN_A;
sinrab 0:5464d5e415e5 73 } else if (flags & O_TRUNC) {
sinrab 0:5464d5e415e5 74 openmode |= OPEN_W;
sinrab 0:5464d5e415e5 75 } else {
sinrab 0:5464d5e415e5 76 openmode |= OPEN_R;
sinrab 0:5464d5e415e5 77 }
sinrab 0:5464d5e415e5 78 } else if (flags & O_WRONLY) {
sinrab 0:5464d5e415e5 79 /* write or append */
sinrab 0:5464d5e415e5 80 if (flags & O_APPEND) {
sinrab 0:5464d5e415e5 81 openmode = OPEN_A;
sinrab 0:5464d5e415e5 82 } else {
sinrab 0:5464d5e415e5 83 openmode = OPEN_W;
sinrab 0:5464d5e415e5 84 }
sinrab 0:5464d5e415e5 85 } else if (flags == O_RDONLY) {
sinrab 0:5464d5e415e5 86 /* read mode */
sinrab 0:5464d5e415e5 87 openmode = OPEN_R;
sinrab 0:5464d5e415e5 88 } else {
sinrab 0:5464d5e415e5 89 /* invalid flags */
sinrab 0:5464d5e415e5 90 openmode = OPEN_INVALID;
sinrab 0:5464d5e415e5 91 }
sinrab 0:5464d5e415e5 92
sinrab 0:5464d5e415e5 93 return openmode;
sinrab 0:5464d5e415e5 94 }
sinrab 0:5464d5e415e5 95
sinrab 0:5464d5e415e5 96 FILEHANDLE local_file_open(const char* name, int flags) {
sinrab 0:5464d5e415e5 97 int openmode = posix_to_semihost_open_flags(flags);
sinrab 0:5464d5e415e5 98 if (openmode == OPEN_INVALID) {
sinrab 0:5464d5e415e5 99 return (FILEHANDLE)NULL;
sinrab 0:5464d5e415e5 100 }
sinrab 0:5464d5e415e5 101
sinrab 0:5464d5e415e5 102 FILEHANDLE fh = semihost_open(name, openmode);
sinrab 0:5464d5e415e5 103 if (fh == -1) {
sinrab 0:5464d5e415e5 104 return (FILEHANDLE)NULL;
sinrab 0:5464d5e415e5 105 }
sinrab 0:5464d5e415e5 106
sinrab 0:5464d5e415e5 107 return fh;
sinrab 0:5464d5e415e5 108 }
sinrab 0:5464d5e415e5 109
sinrab 0:5464d5e415e5 110 LocalFileHandle::LocalFileHandle(FILEHANDLE fh) : _fh(fh), pos(0) {
sinrab 0:5464d5e415e5 111 }
sinrab 0:5464d5e415e5 112
sinrab 0:5464d5e415e5 113 int LocalFileHandle::close() {
sinrab 0:5464d5e415e5 114 int retval = semihost_close(_fh);
sinrab 0:5464d5e415e5 115 delete this;
sinrab 0:5464d5e415e5 116 return retval;
sinrab 0:5464d5e415e5 117 }
sinrab 0:5464d5e415e5 118
sinrab 0:5464d5e415e5 119 ssize_t LocalFileHandle::write(const void *buffer, size_t length) {
sinrab 0:5464d5e415e5 120 ssize_t n = semihost_write(_fh, (const unsigned char*)buffer, length, 0); // number of characters not written
sinrab 0:5464d5e415e5 121 n = length - n; // number of characters written
sinrab 0:5464d5e415e5 122 pos += n;
sinrab 0:5464d5e415e5 123 return n;
sinrab 0:5464d5e415e5 124 }
sinrab 0:5464d5e415e5 125
sinrab 0:5464d5e415e5 126 ssize_t LocalFileHandle::read(void *buffer, size_t length) {
sinrab 0:5464d5e415e5 127 ssize_t n = semihost_read(_fh, (unsigned char*)buffer, length, 0); // number of characters not read
sinrab 0:5464d5e415e5 128 n = length - n; // number of characters read
sinrab 0:5464d5e415e5 129 pos += n;
sinrab 0:5464d5e415e5 130 return n;
sinrab 0:5464d5e415e5 131 }
sinrab 0:5464d5e415e5 132
sinrab 0:5464d5e415e5 133 int LocalFileHandle::isatty() {
sinrab 0:5464d5e415e5 134 return semihost_istty(_fh);
sinrab 0:5464d5e415e5 135 }
sinrab 0:5464d5e415e5 136
sinrab 0:5464d5e415e5 137 off_t LocalFileHandle::lseek(off_t position, int whence) {
sinrab 0:5464d5e415e5 138 if (whence == SEEK_CUR) {
sinrab 0:5464d5e415e5 139 position += pos;
sinrab 0:5464d5e415e5 140 } else if (whence == SEEK_END) {
sinrab 0:5464d5e415e5 141 position += semihost_flen(_fh);
sinrab 0:5464d5e415e5 142 } /* otherwise SEEK_SET, so position is fine */
sinrab 0:5464d5e415e5 143
sinrab 0:5464d5e415e5 144 /* Always seems to return -1, so just ignore for now. */
sinrab 0:5464d5e415e5 145 semihost_seek(_fh, position);
sinrab 0:5464d5e415e5 146 pos = position;
sinrab 0:5464d5e415e5 147 return position;
sinrab 0:5464d5e415e5 148 }
sinrab 0:5464d5e415e5 149
sinrab 0:5464d5e415e5 150 int LocalFileHandle::fsync() {
sinrab 0:5464d5e415e5 151 return semihost_ensure(_fh);
sinrab 0:5464d5e415e5 152 }
sinrab 0:5464d5e415e5 153
sinrab 0:5464d5e415e5 154 off_t LocalFileHandle::flen() {
sinrab 0:5464d5e415e5 155 return semihost_flen(_fh);
sinrab 0:5464d5e415e5 156 }
sinrab 0:5464d5e415e5 157
sinrab 0:5464d5e415e5 158 class LocalDirHandle : public DirHandle {
sinrab 0:5464d5e415e5 159
sinrab 0:5464d5e415e5 160 public:
sinrab 0:5464d5e415e5 161 struct dirent cur_entry;
sinrab 0:5464d5e415e5 162 XFINFO info;
sinrab 0:5464d5e415e5 163
sinrab 0:5464d5e415e5 164 LocalDirHandle() : cur_entry(), info() {
sinrab 0:5464d5e415e5 165 }
sinrab 0:5464d5e415e5 166
sinrab 0:5464d5e415e5 167 virtual int closedir() {
sinrab 0:5464d5e415e5 168 delete this;
sinrab 0:5464d5e415e5 169 return 0;
sinrab 0:5464d5e415e5 170 }
sinrab 0:5464d5e415e5 171
sinrab 0:5464d5e415e5 172 virtual struct dirent *readdir() {
sinrab 0:5464d5e415e5 173 if (xffind("*", &info)!=0) {
sinrab 0:5464d5e415e5 174 return NULL;
sinrab 0:5464d5e415e5 175 }
sinrab 0:5464d5e415e5 176 memcpy(cur_entry.d_name, info.name, sizeof(info.name));
sinrab 0:5464d5e415e5 177 return &cur_entry;
sinrab 0:5464d5e415e5 178 }
sinrab 0:5464d5e415e5 179
sinrab 0:5464d5e415e5 180 virtual void rewinddir() {
sinrab 0:5464d5e415e5 181 info.fileID = 0;
sinrab 0:5464d5e415e5 182 }
sinrab 0:5464d5e415e5 183
sinrab 0:5464d5e415e5 184 virtual off_t telldir() {
sinrab 0:5464d5e415e5 185 return info.fileID;
sinrab 0:5464d5e415e5 186 }
sinrab 0:5464d5e415e5 187
sinrab 0:5464d5e415e5 188 virtual void seekdir(off_t offset) {
sinrab 0:5464d5e415e5 189 info.fileID = offset;
sinrab 0:5464d5e415e5 190 }
sinrab 0:5464d5e415e5 191 };
sinrab 0:5464d5e415e5 192
sinrab 0:5464d5e415e5 193 FileHandle *LocalFileSystem::open(const char* name, int flags) {
sinrab 0:5464d5e415e5 194 /* reject filenames with / in them */
sinrab 0:5464d5e415e5 195 for (const char *tmp = name; *tmp; tmp++) {
sinrab 0:5464d5e415e5 196 if (*tmp == '/') {
sinrab 0:5464d5e415e5 197 return NULL;
sinrab 0:5464d5e415e5 198 }
sinrab 0:5464d5e415e5 199 }
sinrab 0:5464d5e415e5 200
sinrab 0:5464d5e415e5 201 int openmode = posix_to_semihost_open_flags(flags);
sinrab 0:5464d5e415e5 202 if (openmode == OPEN_INVALID) {
sinrab 0:5464d5e415e5 203 return NULL;
sinrab 0:5464d5e415e5 204 }
sinrab 0:5464d5e415e5 205
sinrab 0:5464d5e415e5 206 FILEHANDLE fh = semihost_open(name, openmode);
sinrab 0:5464d5e415e5 207 if (fh == -1) {
sinrab 0:5464d5e415e5 208 return NULL;
sinrab 0:5464d5e415e5 209 }
sinrab 0:5464d5e415e5 210 return new LocalFileHandle(fh);
sinrab 0:5464d5e415e5 211 }
sinrab 0:5464d5e415e5 212
sinrab 0:5464d5e415e5 213 int LocalFileSystem::remove(const char *filename) {
sinrab 0:5464d5e415e5 214 return semihost_remove(filename);
sinrab 0:5464d5e415e5 215 }
sinrab 0:5464d5e415e5 216
sinrab 0:5464d5e415e5 217 DirHandle *LocalFileSystem::opendir(const char *name) {
sinrab 0:5464d5e415e5 218 return new LocalDirHandle();
sinrab 0:5464d5e415e5 219 }
sinrab 0:5464d5e415e5 220
sinrab 0:5464d5e415e5 221 } // namespace mbed
sinrab 0:5464d5e415e5 222
sinrab 0:5464d5e415e5 223 #endif
sinrab 0:5464d5e415e5 224