feat: monitor Stream methods impl TBT

Author: eigen-value

src/monitor.h

@@ -18,7 +18,7 @@ class BridgeMonitor: public Stream {
 
 private:
     BridgeClass& bridge;
-    RingBufferN<BufferSize> buffer;
+    RingBufferN<BufferSize> temp_buffer;
     bool is_connected = false;
 
 public:
@@ -33,18 +33,53 @@ class BridgeMonitor: public Stream {
     }
 
     int read() override {
-        return 0;
+        uint8_t c;
+        read(&c, 1);
+        return c;
+    }
+
+    int read(uint8_t* buffer, size_t size) {
+        int i = 0;
+        while (temp_buffer.available() && i < size) {
+            buffer[i++] = temp_buffer.read_char();
+        }
+        return i;
     }
 
     int available() override {
-        return 0;
+        int size = temp_buffer.availableForStore();
+        if (size > 0) _read(size);
+        return temp_buffer.available();
     }
 
     int peek() override {
-        return 0;
+        if (temp_buffer.available()) {
+            return temp_buffer.peek();
+        }
     }
 
     size_t write(uint8_t c) override {
+        return write(&c, 1);
+    }
+
+    size_t write(const uint8_t* buffer, size_t size) override {
+
+        MsgPack::str_t send_buffer;
+
+        for (size_t i = 0; i < size; ++i) {
+#ifdef ARDUINO
+            send_buffer += (char)buffer[i];
+#else
+            send_buffer.push_back(static_cast<char>(buffer[i]));
+#endif
+        }
+
+        size_t written;
+        bool ret = bridge.call(MON_WRITE_METHOD, written, send_buffer);
+        if (ret) {
+            return written;
+        }
+
         return 0;
     }
 
@@ -66,8 +101,26 @@ class BridgeMonitor: public Stream {
         return size;
     }
 
-    bool read(String& message, size_t size) {
-        return bridge.call(MON_READ_METHOD, message, size);
+    int _read(size_t size) {
+
+        if (size == 0) return 0;
+
+        MsgPack::str_t message;
+        bool ret = bridge.call(MON_READ_METHOD, message, size);
+
+        if (ret) {
+            for (size_t i = 0; i < message.length(); ++i) {
+                 temp_buffer.store_char(message[i]);
+            }
+            return message.length();
+        }
+
+        // if (bridge.lastError.code > NO_ERR) {
+        //     is_connected = false;
+        // }
+
+        return 0;
+
     }