|
21 | 21 | #include "cbuf.h"
|
22 | 22 | #include "c_types.h"
|
23 | 23 |
|
| 24 | +cbuf::cbuf(size_t size) : |
| 25 | + _size(size), _buf(new char[size]), _bufend(_buf + size), _begin(_buf), _end(_begin) { |
| 26 | +} |
| 27 | + |
| 28 | +cbuf::~cbuf() { |
| 29 | + delete[] _buf; |
| 30 | +} |
| 31 | + |
| 32 | +size_t cbuf::resizeAdd(size_t addSize) { |
| 33 | + return resize(_size + addSize); |
| 34 | +} |
| 35 | + |
| 36 | +size_t cbuf::resize(size_t newSize) { |
| 37 | + |
| 38 | + size_t available = getSize(); |
| 39 | + |
| 40 | + // not lose any data |
| 41 | + // if data can be lost use remove or flush before resize |
| 42 | + if((newSize < available) || (newSize == _size)) { |
| 43 | + return _size; |
| 44 | + } |
| 45 | + |
| 46 | + char *newbuf = new char[newSize]; |
| 47 | + char *oldbuf = _buf; |
| 48 | + |
| 49 | + if(!newbuf) { |
| 50 | + return _size; |
| 51 | + } |
| 52 | + |
| 53 | + if(_buf) { |
| 54 | + read(newbuf, available); |
| 55 | + memset((newbuf + available), 0x00, (newSize - available)); |
| 56 | + } |
| 57 | + |
| 58 | + _begin = newbuf; |
| 59 | + _end = newbuf + available; |
| 60 | + _bufend = newbuf + newSize; |
| 61 | + _size = newSize; |
| 62 | + |
| 63 | + _buf = newbuf; |
| 64 | + delete[] oldbuf; |
| 65 | + |
| 66 | + return _size; |
| 67 | +} |
| 68 | + |
24 | 69 | size_t ICACHE_RAM_ATTR cbuf::getSize() const {
|
25 | 70 | if(_end >= _begin) {
|
26 | 71 | return _end - _begin;
|
27 | 72 | }
|
28 | 73 | return _size - (_begin - _end);
|
29 | 74 | }
|
30 | 75 |
|
| 76 | +size_t cbuf::room() const { |
| 77 | + if(_end >= _begin) { |
| 78 | + return _size - (_end - _begin) - 1; |
| 79 | + } |
| 80 | + return _begin - _end - 1; |
| 81 | +} |
| 82 | + |
| 83 | +int cbuf::peek() { |
| 84 | + if(empty()) |
| 85 | + return -1; |
| 86 | + |
| 87 | + return static_cast<int>(*_begin); |
| 88 | +} |
| 89 | + |
| 90 | +size_t cbuf::peek(char *dst, size_t size) { |
| 91 | + size_t bytes_available = getSize(); |
| 92 | + size_t size_to_read = (size < bytes_available) ? size : bytes_available; |
| 93 | + size_t size_read = size_to_read; |
| 94 | + char * begin = _begin; |
| 95 | + if(_end < _begin && size_to_read > (size_t) (_bufend - _begin)) { |
| 96 | + size_t top_size = _bufend - _begin; |
| 97 | + memcpy(dst, _begin, top_size); |
| 98 | + begin = _buf; |
| 99 | + size_to_read -= top_size; |
| 100 | + dst += top_size; |
| 101 | + } |
| 102 | + memcpy(dst, begin, size_to_read); |
| 103 | + return size_read; |
| 104 | +} |
| 105 | + |
31 | 106 | int ICACHE_RAM_ATTR cbuf::read() {
|
32 |
| - if(empty()) return -1; |
| 107 | + if(empty()) |
| 108 | + return -1; |
33 | 109 |
|
34 | 110 | char result = *_begin;
|
35 | 111 | _begin = wrap_if_bufend(_begin + 1);
|
36 | 112 | return static_cast<int>(result);
|
37 | 113 | }
|
38 | 114 |
|
| 115 | +size_t cbuf::read(char* dst, size_t size) { |
| 116 | + size_t bytes_available = getSize(); |
| 117 | + size_t size_to_read = (size < bytes_available) ? size : bytes_available; |
| 118 | + size_t size_read = size_to_read; |
| 119 | + if(_end < _begin && size_to_read > (size_t) (_bufend - _begin)) { |
| 120 | + size_t top_size = _bufend - _begin; |
| 121 | + memcpy(dst, _begin, top_size); |
| 122 | + _begin = _buf; |
| 123 | + size_to_read -= top_size; |
| 124 | + dst += top_size; |
| 125 | + } |
| 126 | + memcpy(dst, _begin, size_to_read); |
| 127 | + _begin = wrap_if_bufend(_begin + size_to_read); |
| 128 | + return size_read; |
| 129 | +} |
| 130 | + |
39 | 131 | size_t ICACHE_RAM_ATTR cbuf::write(char c) {
|
40 |
| - if(full()) return 0; |
| 132 | + if(full()) |
| 133 | + return 0; |
| 134 | + |
| 135 | + *_end = c; |
| 136 | + _end = wrap_if_bufend(_end + 1); |
| 137 | + return 1; |
| 138 | +} |
| 139 | + |
| 140 | +size_t cbuf::write(const char* src, size_t size) { |
| 141 | + size_t bytes_available = room(); |
| 142 | + size_t size_to_write = (size < bytes_available) ? size : bytes_available; |
| 143 | + size_t size_written = size_to_write; |
| 144 | + if(_end >= _begin && size_to_write > (size_t) (_bufend - _end)) { |
| 145 | + size_t top_size = _bufend - _end; |
| 146 | + memcpy(_end, src, top_size); |
| 147 | + _end = _buf; |
| 148 | + size_to_write -= top_size; |
| 149 | + src += top_size; |
| 150 | + } |
| 151 | + memcpy(_end, src, size_to_write); |
| 152 | + _end = wrap_if_bufend(_end + size_to_write); |
| 153 | + return size_written; |
| 154 | +} |
| 155 | + |
| 156 | +void cbuf::flush() { |
| 157 | + _begin = _buf; |
| 158 | + _end = _buf; |
| 159 | +} |
41 | 160 |
|
42 |
| - *_end = c; |
43 |
| - _end = wrap_if_bufend(_end + 1); |
44 |
| - return 1; |
| 161 | +size_t cbuf::remove(size_t size) { |
| 162 | + size_t bytes_available = getSize(); |
| 163 | + if(size >= bytes_available) { |
| 164 | + flush(); |
| 165 | + return 0; |
| 166 | + } |
| 167 | + size_t size_to_remove = (size < bytes_available) ? size : bytes_available; |
| 168 | + if(_end < _begin && size_to_remove > (size_t) (_bufend - _begin)) { |
| 169 | + size_t top_size = _bufend - _begin; |
| 170 | + _begin = _buf; |
| 171 | + size_to_remove -= top_size; |
| 172 | + } |
| 173 | + _begin = wrap_if_bufend(_begin + size_to_remove); |
| 174 | + return getSize(); |
45 | 175 | }
|
0 commit comments