Tentative KL25Z I2C HAL fix
Fork of mbed-src by
Diff: common/Stream.cpp
- Revision:
- 9:0ce32e54c9a7
- Parent:
- 2:143cac498751
- Child:
- 10:3bc89ef62ce7
--- /dev/null Thu Jan 01 00:00:00 1970 +0000 +++ b/common/Stream.cpp Mon Jun 10 16:03:00 2013 +0100 @@ -0,0 +1,111 @@ +/* mbed Microcontroller Library + * Copyright (c) 2006-2013 ARM Limited + * + * Licensed under the Apache License, Version 2.0 (the "License"); + * you may not use this file except in compliance with the License. + * You may obtain a copy of the License at + * + * http://www.apache.org/licenses/LICENSE-2.0 + * + * Unless required by applicable law or agreed to in writing, software + * distributed under the License is distributed on an "AS IS" BASIS, + * WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied. + * See the License for the specific language governing permissions and + * limitations under the License. + */ +#include "Stream.h" + +#include <cstdarg> + +namespace mbed { + +Stream::Stream(const char *name) : FileLike(name) { + /* open ourselves */ + char buf[12]; /* :0x12345678 + null byte */ + std::sprintf(buf, ":%p", this); + _file = std::fopen(buf, "w+"); + setbuf(_file, NULL); +} + +Stream::~Stream() { + fclose(_file); +} + +int Stream::putc(int c) { + fflush(_file); + return std::fputc(c, _file); +} +int Stream::puts(const char *s) { + fflush(_file); + return std::fputs(s, _file); +} +int Stream::getc() { + fflush(_file); + return std::fgetc(_file); +} +char* Stream::gets(char *s, int size) { + fflush(_file); + return std::fgets(s,size,_file); +} + +int Stream::close() { + return 0; +} + +ssize_t Stream::write(const void* buffer, size_t length) { + const char* ptr = (const char*)buffer; + const char* end = ptr + length; + while (ptr != end) { + if (_putc(*ptr++) == EOF) { + break; + } + } + return ptr - (const char*)buffer; +} + +ssize_t Stream::read(void* buffer, size_t length) { + char* ptr = (char*)buffer; + char* end = ptr + length; + while (ptr != end) { + int c = _getc(); + if (c==EOF) break; + *ptr++ = c; + } + return ptr - (const char*)buffer; +} + +off_t Stream::lseek(off_t offset, int whence) { + return 0; +} + +int Stream::isatty() { + return 0; +} + +int Stream::fsync() { + return 0; +} + +off_t Stream::flen() { + return 0; +} + +int Stream::printf(const char* format, ...) { + std::va_list arg; + va_start(arg, format); + fflush(_file); + int r = vfprintf(_file, format, arg); + va_end(arg); + return r; +} + +int Stream::scanf(const char* format, ...) { + std::va_list arg; + va_start(arg, format); + fflush(_file); + int r = vfscanf(_file, format, arg); + va_end(arg); + return r; +} + +} // namespace mbed