1 files changed, 33 insertions, 0 deletions

diff --git a/desktop/serial_utils.h b/desktop/serial_utils.h
new file mode 100755
index 0000000..8c351e4
--- /dev/null
+++ b/desktop/serial_utils.h
@@ -0,0 +1,33 @@
+#pragma once
+
+#include "types.h"
+
+#include <SerialStream.h>
+
+template <typename T>
+T read (LibSerial::SerialStream& serial)
+{
+    T x;
+    serial.read((char*) &x, sizeof(T));
+    return x;
+}
+
+template <>
+U32 read<U32> (LibSerial::SerialStream& serial)
+{
+    U32 x = 0;
+    for (int i = 0; i < 4; ++i)
+    {
+        U8 b;
+        serial.read((char*)&b, 1);
+        x = x >> 8;
+        x |= (b << 24);
+    }
+    return x;
+}
+
+template <typename T>
+void write (LibSerial::SerialStream& serial, const T& val)
+{
+    serial.write((const char*) &val, sizeof(T));
+}