Biomimetics MBED Library w/ Added Support for CAN3

Dependents:   CAN_TEST SPIne_Plus_DYNO_SENSORS SPIne_Plus_v2 SPIne_Plus_Dyno_v2

Committer:
adimmit
Date:
Tue Mar 09 20:33:24 2021 +0000
Revision:
3:993b4d6ff61e
Parent:
0:083111ae2a11
added CAN3

Who changed what in which revision?

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