[drivewire][cpm] implement write.

FujiNetWIFI · Apr 29, 2024 · 6cca032 · 6cca032
1 parent c4d2eb4
commit 6cca032
Showing 1 changed file with 10 additions and 0 deletions.
diff --git a/lib/device/drivewire/cpm.cpp b/lib/device/drivewire/cpm.cpp
@@ -104,7 +104,17 @@ void drivewireCPM::read()
 
 void drivewireCPM::write()
 {
+    uint8_t lenh = fnUartBUS.read();
+    uint8_t lenl = fnUartBUS.read();
+    uint16_t len = (lenh * 256) + lenl;
 
+    for (uint16_t i=0;i<len;i++)
+    {
+        char b = fnUartBUS.read();
+#ifdef ESP_PLATFORM
+        xQueueSend(txq, &b, portMAX_DELAY);
+#endif /* ESP_PLATFORM */
+    }
 }
 
 void drivewireCPM::status()