mbed-os

Dependents:   cobaLCDJoyMotor_Thread odometry_omni_3roda_v3 odometry_omni_3roda_v1 odometry_omni_3roda_v2 ... more

Committer:
be_bryan
Date:
Mon Dec 11 17:54:04 2017 +0000
Revision:
0:b74591d5ab33
motor ++

Who changed what in which revision?

UserRevisionLine numberNew contents of line
be_bryan 0:b74591d5ab33 1 /* mbed Microcontroller Library
be_bryan 0:b74591d5ab33 2 * Copyright (c) 2006-2013 ARM Limited
be_bryan 0:b74591d5ab33 3 *
be_bryan 0:b74591d5ab33 4 * Licensed under the Apache License, Version 2.0 (the "License");
be_bryan 0:b74591d5ab33 5 * you may not use this file except in compliance with the License.
be_bryan 0:b74591d5ab33 6 * You may obtain a copy of the License at
be_bryan 0:b74591d5ab33 7 *
be_bryan 0:b74591d5ab33 8 * http://www.apache.org/licenses/LICENSE-2.0
be_bryan 0:b74591d5ab33 9 *
be_bryan 0:b74591d5ab33 10 * Unless required by applicable law or agreed to in writing, software
be_bryan 0:b74591d5ab33 11 * distributed under the License is distributed on an "AS IS" BASIS,
be_bryan 0:b74591d5ab33 12 * WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied.
be_bryan 0:b74591d5ab33 13 * See the License for the specific language governing permissions and
be_bryan 0:b74591d5ab33 14 * limitations under the License.
be_bryan 0:b74591d5ab33 15 */
be_bryan 0:b74591d5ab33 16 #include "platform/Stream.h"
be_bryan 0:b74591d5ab33 17 #include "platform/mbed_error.h"
be_bryan 0:b74591d5ab33 18 #include <errno.h>
be_bryan 0:b74591d5ab33 19
be_bryan 0:b74591d5ab33 20 namespace mbed {
be_bryan 0:b74591d5ab33 21
be_bryan 0:b74591d5ab33 22 Stream::Stream(const char *name) : FileLike(name), _file(NULL) {
be_bryan 0:b74591d5ab33 23 // No lock needed in constructor
be_bryan 0:b74591d5ab33 24 /* open ourselves */
be_bryan 0:b74591d5ab33 25 _file = fdopen(this, "w+");
be_bryan 0:b74591d5ab33 26 // fdopen() will make us buffered because Stream::isatty()
be_bryan 0:b74591d5ab33 27 // wrongly returns zero which is not being changed for
be_bryan 0:b74591d5ab33 28 // backward compatibility
be_bryan 0:b74591d5ab33 29 if (_file) {
be_bryan 0:b74591d5ab33 30 mbed_set_unbuffered_stream(_file);
be_bryan 0:b74591d5ab33 31 } else {
be_bryan 0:b74591d5ab33 32 error("Stream obj failure, errno=%d\r\n", errno);
be_bryan 0:b74591d5ab33 33 }
be_bryan 0:b74591d5ab33 34 }
be_bryan 0:b74591d5ab33 35
be_bryan 0:b74591d5ab33 36 Stream::~Stream() {
be_bryan 0:b74591d5ab33 37 // No lock can be used in destructor
be_bryan 0:b74591d5ab33 38 fclose(_file);
be_bryan 0:b74591d5ab33 39 }
be_bryan 0:b74591d5ab33 40
be_bryan 0:b74591d5ab33 41 int Stream::putc(int c) {
be_bryan 0:b74591d5ab33 42 lock();
be_bryan 0:b74591d5ab33 43 fflush(_file);
be_bryan 0:b74591d5ab33 44 int ret = std::fputc(c, _file);
be_bryan 0:b74591d5ab33 45 unlock();
be_bryan 0:b74591d5ab33 46 return ret;
be_bryan 0:b74591d5ab33 47 }
be_bryan 0:b74591d5ab33 48 int Stream::puts(const char *s) {
be_bryan 0:b74591d5ab33 49 lock();
be_bryan 0:b74591d5ab33 50 fflush(_file);
be_bryan 0:b74591d5ab33 51 int ret = std::fputs(s, _file);
be_bryan 0:b74591d5ab33 52 unlock();
be_bryan 0:b74591d5ab33 53 return ret;
be_bryan 0:b74591d5ab33 54 }
be_bryan 0:b74591d5ab33 55 int Stream::getc() {
be_bryan 0:b74591d5ab33 56 lock();
be_bryan 0:b74591d5ab33 57 fflush(_file);
be_bryan 0:b74591d5ab33 58 int ret = mbed_getc(_file);
be_bryan 0:b74591d5ab33 59 unlock();
be_bryan 0:b74591d5ab33 60 return ret;
be_bryan 0:b74591d5ab33 61 }
be_bryan 0:b74591d5ab33 62 char* Stream::gets(char *s, int size) {
be_bryan 0:b74591d5ab33 63 lock();
be_bryan 0:b74591d5ab33 64 fflush(_file);
be_bryan 0:b74591d5ab33 65 char *ret = mbed_gets(s,size,_file);
be_bryan 0:b74591d5ab33 66 unlock();
be_bryan 0:b74591d5ab33 67 return ret;
be_bryan 0:b74591d5ab33 68 }
be_bryan 0:b74591d5ab33 69
be_bryan 0:b74591d5ab33 70 int Stream::close() {
be_bryan 0:b74591d5ab33 71 return 0;
be_bryan 0:b74591d5ab33 72 }
be_bryan 0:b74591d5ab33 73
be_bryan 0:b74591d5ab33 74 ssize_t Stream::write(const void* buffer, size_t length) {
be_bryan 0:b74591d5ab33 75 const char* ptr = (const char*)buffer;
be_bryan 0:b74591d5ab33 76 const char* end = ptr + length;
be_bryan 0:b74591d5ab33 77
be_bryan 0:b74591d5ab33 78 lock();
be_bryan 0:b74591d5ab33 79 while (ptr != end) {
be_bryan 0:b74591d5ab33 80 if (_putc(*ptr++) == EOF) {
be_bryan 0:b74591d5ab33 81 break;
be_bryan 0:b74591d5ab33 82 }
be_bryan 0:b74591d5ab33 83 }
be_bryan 0:b74591d5ab33 84 unlock();
be_bryan 0:b74591d5ab33 85
be_bryan 0:b74591d5ab33 86 return ptr - (const char*)buffer;
be_bryan 0:b74591d5ab33 87 }
be_bryan 0:b74591d5ab33 88
be_bryan 0:b74591d5ab33 89 ssize_t Stream::read(void* buffer, size_t length) {
be_bryan 0:b74591d5ab33 90 char* ptr = (char*)buffer;
be_bryan 0:b74591d5ab33 91 char* end = ptr + length;
be_bryan 0:b74591d5ab33 92
be_bryan 0:b74591d5ab33 93 lock();
be_bryan 0:b74591d5ab33 94 while (ptr != end) {
be_bryan 0:b74591d5ab33 95 int c = _getc();
be_bryan 0:b74591d5ab33 96 if (c==EOF) break;
be_bryan 0:b74591d5ab33 97 *ptr++ = c;
be_bryan 0:b74591d5ab33 98 }
be_bryan 0:b74591d5ab33 99 unlock();
be_bryan 0:b74591d5ab33 100
be_bryan 0:b74591d5ab33 101 return ptr - (const char*)buffer;
be_bryan 0:b74591d5ab33 102 }
be_bryan 0:b74591d5ab33 103
be_bryan 0:b74591d5ab33 104 off_t Stream::seek(off_t offset, int whence) {
be_bryan 0:b74591d5ab33 105 return 0;
be_bryan 0:b74591d5ab33 106 }
be_bryan 0:b74591d5ab33 107
be_bryan 0:b74591d5ab33 108 off_t Stream::tell() {
be_bryan 0:b74591d5ab33 109 return 0;
be_bryan 0:b74591d5ab33 110 }
be_bryan 0:b74591d5ab33 111
be_bryan 0:b74591d5ab33 112 void Stream::rewind() {
be_bryan 0:b74591d5ab33 113 }
be_bryan 0:b74591d5ab33 114
be_bryan 0:b74591d5ab33 115 int Stream::isatty() {
be_bryan 0:b74591d5ab33 116 return 0;
be_bryan 0:b74591d5ab33 117 }
be_bryan 0:b74591d5ab33 118
be_bryan 0:b74591d5ab33 119 int Stream::sync() {
be_bryan 0:b74591d5ab33 120 return 0;
be_bryan 0:b74591d5ab33 121 }
be_bryan 0:b74591d5ab33 122
be_bryan 0:b74591d5ab33 123 off_t Stream::size() {
be_bryan 0:b74591d5ab33 124 return 0;
be_bryan 0:b74591d5ab33 125 }
be_bryan 0:b74591d5ab33 126
be_bryan 0:b74591d5ab33 127 int Stream::printf(const char* format, ...) {
be_bryan 0:b74591d5ab33 128 lock();
be_bryan 0:b74591d5ab33 129 std::va_list arg;
be_bryan 0:b74591d5ab33 130 va_start(arg, format);
be_bryan 0:b74591d5ab33 131 fflush(_file);
be_bryan 0:b74591d5ab33 132 int r = vfprintf(_file, format, arg);
be_bryan 0:b74591d5ab33 133 va_end(arg);
be_bryan 0:b74591d5ab33 134 unlock();
be_bryan 0:b74591d5ab33 135 return r;
be_bryan 0:b74591d5ab33 136 }
be_bryan 0:b74591d5ab33 137
be_bryan 0:b74591d5ab33 138 int Stream::scanf(const char* format, ...) {
be_bryan 0:b74591d5ab33 139 lock();
be_bryan 0:b74591d5ab33 140 std::va_list arg;
be_bryan 0:b74591d5ab33 141 va_start(arg, format);
be_bryan 0:b74591d5ab33 142 fflush(_file);
be_bryan 0:b74591d5ab33 143 int r = vfscanf(_file, format, arg);
be_bryan 0:b74591d5ab33 144 va_end(arg);
be_bryan 0:b74591d5ab33 145 unlock();
be_bryan 0:b74591d5ab33 146 return r;
be_bryan 0:b74591d5ab33 147 }
be_bryan 0:b74591d5ab33 148
be_bryan 0:b74591d5ab33 149 int Stream::vprintf(const char* format, std::va_list args) {
be_bryan 0:b74591d5ab33 150 lock();
be_bryan 0:b74591d5ab33 151 fflush(_file);
be_bryan 0:b74591d5ab33 152 int r = vfprintf(_file, format, args);
be_bryan 0:b74591d5ab33 153 unlock();
be_bryan 0:b74591d5ab33 154 return r;
be_bryan 0:b74591d5ab33 155 }
be_bryan 0:b74591d5ab33 156
be_bryan 0:b74591d5ab33 157 int Stream::vscanf(const char* format, std::va_list args) {
be_bryan 0:b74591d5ab33 158 lock();
be_bryan 0:b74591d5ab33 159 fflush(_file);
be_bryan 0:b74591d5ab33 160 int r = vfscanf(_file, format, args);
be_bryan 0:b74591d5ab33 161 unlock();
be_bryan 0:b74591d5ab33 162 return r;
be_bryan 0:b74591d5ab33 163 }
be_bryan 0:b74591d5ab33 164
be_bryan 0:b74591d5ab33 165 } // namespace mbed