123456789101112131415161718192021222324252627282930313233343536373839 |
- #include "Stream.h"
- #include "trace.h"
- #include <iostream>
- #include <Arduino.h>
- Stream::Stream() {
- this->expectBuffer = new Buffer();
- this->_error = false;
- this->_written = 0;
- }
- size_t Stream::write(uint8_t b) {
- this->_written++;
- TRACE(std::hex << (unsigned int)b);
- if (this->expectBuffer->available()) {
- uint8_t expected = this->expectBuffer->next();
- if (expected != b) {
- this->_error = true;
- TRACE("!=" << (unsigned int)expected);
- }
- } else {
- this->_error = true;
- }
- TRACE("\n"<< std::dec);
- return 1;
- }
- bool Stream::error() {
- return this->_error;
- }
- void Stream::expect(uint8_t *buf, size_t size) {
- this->expectBuffer->add(buf,size);
- }
- uint16_t Stream::length() {
- return this->_written;
- }
|