Biomimetics MBED Library w/ Added Support for CAN3

Dependents:   CAN_TEST SPIne_Plus_DYNO_SENSORS SPIne_Plus_v2 SPIne_Plus_Dyno_v2

Committer:
saloutos
Date:
Thu Nov 26 04:08:56 2020 +0000
Revision:
0:083111ae2a11
first commit of leaned mbed dev lib

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/Stream.h"
saloutos 0:083111ae2a11 17 #include "platform/mbed_error.h"
saloutos 0:083111ae2a11 18 #include <errno.h>
saloutos 0:083111ae2a11 19
saloutos 0:083111ae2a11 20 namespace mbed {
saloutos 0:083111ae2a11 21
saloutos 0:083111ae2a11 22 Stream::Stream(const char *name) : FileLike(name), _file(NULL) {
saloutos 0:083111ae2a11 23 // No lock needed in constructor
saloutos 0:083111ae2a11 24 /* open ourselves */
saloutos 0:083111ae2a11 25 _file = fdopen(this, "w+");
saloutos 0:083111ae2a11 26 // fdopen() will make us buffered because Stream::isatty()
saloutos 0:083111ae2a11 27 // wrongly returns zero which is not being changed for
saloutos 0:083111ae2a11 28 // backward compatibility
saloutos 0:083111ae2a11 29 if (_file) {
saloutos 0:083111ae2a11 30 mbed_set_unbuffered_stream(_file);
saloutos 0:083111ae2a11 31 } else {
saloutos 0:083111ae2a11 32 error("Stream obj failure, errno=%d\r\n", errno);
saloutos 0:083111ae2a11 33 }
saloutos 0:083111ae2a11 34 }
saloutos 0:083111ae2a11 35
saloutos 0:083111ae2a11 36 Stream::~Stream() {
saloutos 0:083111ae2a11 37 // No lock can be used in destructor
saloutos 0:083111ae2a11 38 fclose(_file);
saloutos 0:083111ae2a11 39 }
saloutos 0:083111ae2a11 40
saloutos 0:083111ae2a11 41 int Stream::putc(int c) {
saloutos 0:083111ae2a11 42 lock();
saloutos 0:083111ae2a11 43 fflush(_file);
saloutos 0:083111ae2a11 44 int ret = std::fputc(c, _file);
saloutos 0:083111ae2a11 45 unlock();
saloutos 0:083111ae2a11 46 return ret;
saloutos 0:083111ae2a11 47 }
saloutos 0:083111ae2a11 48 int Stream::puts(const char *s) {
saloutos 0:083111ae2a11 49 lock();
saloutos 0:083111ae2a11 50 fflush(_file);
saloutos 0:083111ae2a11 51 int ret = std::fputs(s, _file);
saloutos 0:083111ae2a11 52 unlock();
saloutos 0:083111ae2a11 53 return ret;
saloutos 0:083111ae2a11 54 }
saloutos 0:083111ae2a11 55 int Stream::getc() {
saloutos 0:083111ae2a11 56 lock();
saloutos 0:083111ae2a11 57 fflush(_file);
saloutos 0:083111ae2a11 58 int ret = mbed_getc(_file);
saloutos 0:083111ae2a11 59 unlock();
saloutos 0:083111ae2a11 60 return ret;
saloutos 0:083111ae2a11 61 }
saloutos 0:083111ae2a11 62 char* Stream::gets(char *s, int size) {
saloutos 0:083111ae2a11 63 lock();
saloutos 0:083111ae2a11 64 fflush(_file);
saloutos 0:083111ae2a11 65 char *ret = mbed_gets(s,size,_file);
saloutos 0:083111ae2a11 66 unlock();
saloutos 0:083111ae2a11 67 return ret;
saloutos 0:083111ae2a11 68 }
saloutos 0:083111ae2a11 69
saloutos 0:083111ae2a11 70 int Stream::close() {
saloutos 0:083111ae2a11 71 return 0;
saloutos 0:083111ae2a11 72 }
saloutos 0:083111ae2a11 73
saloutos 0:083111ae2a11 74 ssize_t Stream::write(const void* buffer, size_t length) {
saloutos 0:083111ae2a11 75 const char* ptr = (const char*)buffer;
saloutos 0:083111ae2a11 76 const char* end = ptr + length;
saloutos 0:083111ae2a11 77
saloutos 0:083111ae2a11 78 lock();
saloutos 0:083111ae2a11 79 while (ptr != end) {
saloutos 0:083111ae2a11 80 if (_putc(*ptr++) == EOF) {
saloutos 0:083111ae2a11 81 break;
saloutos 0:083111ae2a11 82 }
saloutos 0:083111ae2a11 83 }
saloutos 0:083111ae2a11 84 unlock();
saloutos 0:083111ae2a11 85
saloutos 0:083111ae2a11 86 return ptr - (const char*)buffer;
saloutos 0:083111ae2a11 87 }
saloutos 0:083111ae2a11 88
saloutos 0:083111ae2a11 89 ssize_t Stream::read(void* buffer, size_t length) {
saloutos 0:083111ae2a11 90 char* ptr = (char*)buffer;
saloutos 0:083111ae2a11 91 char* end = ptr + length;
saloutos 0:083111ae2a11 92
saloutos 0:083111ae2a11 93 lock();
saloutos 0:083111ae2a11 94 while (ptr != end) {
saloutos 0:083111ae2a11 95 int c = _getc();
saloutos 0:083111ae2a11 96 if (c==EOF) break;
saloutos 0:083111ae2a11 97 *ptr++ = c;
saloutos 0:083111ae2a11 98 }
saloutos 0:083111ae2a11 99 unlock();
saloutos 0:083111ae2a11 100
saloutos 0:083111ae2a11 101 return ptr - (const char*)buffer;
saloutos 0:083111ae2a11 102 }
saloutos 0:083111ae2a11 103
saloutos 0:083111ae2a11 104 off_t Stream::seek(off_t offset, int whence) {
saloutos 0:083111ae2a11 105 return 0;
saloutos 0:083111ae2a11 106 }
saloutos 0:083111ae2a11 107
saloutos 0:083111ae2a11 108 off_t Stream::tell() {
saloutos 0:083111ae2a11 109 return 0;
saloutos 0:083111ae2a11 110 }
saloutos 0:083111ae2a11 111
saloutos 0:083111ae2a11 112 void Stream::rewind() {
saloutos 0:083111ae2a11 113 }
saloutos 0:083111ae2a11 114
saloutos 0:083111ae2a11 115 int Stream::isatty() {
saloutos 0:083111ae2a11 116 return 0;
saloutos 0:083111ae2a11 117 }
saloutos 0:083111ae2a11 118
saloutos 0:083111ae2a11 119 int Stream::sync() {
saloutos 0:083111ae2a11 120 return 0;
saloutos 0:083111ae2a11 121 }
saloutos 0:083111ae2a11 122
saloutos 0:083111ae2a11 123 off_t Stream::size() {
saloutos 0:083111ae2a11 124 return 0;
saloutos 0:083111ae2a11 125 }
saloutos 0:083111ae2a11 126
saloutos 0:083111ae2a11 127 int Stream::printf(const char* format, ...) {
saloutos 0:083111ae2a11 128 lock();
saloutos 0:083111ae2a11 129 std::va_list arg;
saloutos 0:083111ae2a11 130 va_start(arg, format);
saloutos 0:083111ae2a11 131 fflush(_file);
saloutos 0:083111ae2a11 132 int r = vfprintf(_file, format, arg);
saloutos 0:083111ae2a11 133 va_end(arg);
saloutos 0:083111ae2a11 134 unlock();
saloutos 0:083111ae2a11 135 return r;
saloutos 0:083111ae2a11 136 }
saloutos 0:083111ae2a11 137
saloutos 0:083111ae2a11 138 int Stream::scanf(const char* format, ...) {
saloutos 0:083111ae2a11 139 lock();
saloutos 0:083111ae2a11 140 std::va_list arg;
saloutos 0:083111ae2a11 141 va_start(arg, format);
saloutos 0:083111ae2a11 142 fflush(_file);
saloutos 0:083111ae2a11 143 int r = vfscanf(_file, format, arg);
saloutos 0:083111ae2a11 144 va_end(arg);
saloutos 0:083111ae2a11 145 unlock();
saloutos 0:083111ae2a11 146 return r;
saloutos 0:083111ae2a11 147 }
saloutos 0:083111ae2a11 148
saloutos 0:083111ae2a11 149 int Stream::vprintf(const char* format, std::va_list args) {
saloutos 0:083111ae2a11 150 lock();
saloutos 0:083111ae2a11 151 fflush(_file);
saloutos 0:083111ae2a11 152 int r = vfprintf(_file, format, args);
saloutos 0:083111ae2a11 153 unlock();
saloutos 0:083111ae2a11 154 return r;
saloutos 0:083111ae2a11 155 }
saloutos 0:083111ae2a11 156
saloutos 0:083111ae2a11 157 int Stream::vscanf(const char* format, std::va_list args) {
saloutos 0:083111ae2a11 158 lock();
saloutos 0:083111ae2a11 159 fflush(_file);
saloutos 0:083111ae2a11 160 int r = vfscanf(_file, format, args);
saloutos 0:083111ae2a11 161 unlock();
saloutos 0:083111ae2a11 162 return r;
saloutos 0:083111ae2a11 163 }
saloutos 0:083111ae2a11 164
saloutos 0:083111ae2a11 165 } // namespace mbed