Add tests for slc control

Author: mfacton

cap_sense.py

@@ -0,0 +1,18 @@
+import time
+
+from tools.plotter import Plot
+from tools.serial_manager import DataType, SerialManager, unpack_data
+
+manager = SerialManager("flex-control", baud=38400)
+plot = Plot(1, 20000, 40000, pixel_shift=2)
+
+while True:
+    data = manager.read_bytes(4)
+    values = unpack_data([DataType.UInt16, DataType.UInt16], data)
+    
+    # print(f"{values[0]:05d} : 0x{values[0]:04x} : 0b{(values[0]>>8):08b} {(values[0]&0xff):08b}")
+    # print(values[0]//16)
+
+    plot.push(values)
+
+    time.sleep(0.001)

compass_test.py

@@ -0,0 +1,13 @@
+import time
+
+from tools.serial_manager import DataType, SerialManager, pack_data, unpack_data
+
+manager = SerialManager("slc-control-lib", baud=115200)
+
+msg_type = [DataType.Float]
+
+while True:
+    data = unpack_data(msg_type, manager.read_bytes(4))
+    print(data[0])
+
+    time.sleep(0.001)

imu_test.py

@@ -0,0 +1,15 @@
+import time
+
+from tools.plotter import Plot
+from tools.serial_manager import DataType, SerialManager, pack_data, unpack_data
+
+manager = SerialManager("slc-control-lib", baud=115200)
+# plotter = Plot(3, -32768, 32767)
+
+msg_type = [DataType.UInt8, DataType.Int16, DataType.Int16, DataType.Int16, DataType.Int16, DataType.Int16, DataType.Int16, DataType.Int16, DataType.UInt16, DataType.UInt8, DataType.UInt8, DataType.UInt8]
+
+while True:
+    data = unpack_data(msg_type, manager.read_bytes(20))
+    print(data)
+
+    time.sleep(0.001)

mag_test.py

@@ -3,13 +3,18 @@
 from tools.plotter import Plot
 from tools.serial_manager import DataType, SerialManager, pack_data, unpack_data
 
-manager = SerialManager("mag-test", baud=115200)
-plotter = Plot(3, -32768, 32767)
+manager = SerialManager("slc-control-lib", baud=115200)
+# plotter = Plot(3, -32768, 32767)
 
-msg_type = [DataType.Int16, DataType.Int16, DataType.Int16]
+msg_type = [DataType.Int16, DataType.Int16, DataType.Int16, DataType.UInt16]
 
 while True:
-    data = unpack_data(msg_type, manager.read_bytes(6))
-    plotter.push(data)
+    data = manager.read_bytes(8)
+    values = unpack_data(msg_type, data)
+    print(values)
+    # plotter.push(data)
+
+    # data = manager.read_bytes(6)
+    # print(f"{data[0]} {data[1]}")
 
     time.sleep(0.001)

memory_test.py

@@ -0,0 +1,15 @@
+import time
+
+from tools.plotter import Plot
+from tools.serial_manager import DataType, SerialManager, pack_data, unpack_data
+
+manager = SerialManager("slc-control-lib", baud=115200)
+
+# msg_type = [DataType.UInt32, DataType.UInt32, DataType.UInt32, DataType.UInt32]
+msg_type = [DataType.Float]
+
+while True:
+    data = unpack_data(msg_type, manager.read_bytes(4))
+    print(data)
+
+    time.sleep(0.001)

nmea_test.py

@@ -0,0 +1,14 @@
+import time
+
+from tools.plotter import Plot
+from tools.serial_manager import DataType, SerialManager, pack_data, unpack_data
+
+manager = SerialManager("slc-control-lib", baud=115200)
+
+msg_type = [DataType.Float]
+
+while True:
+    data = unpack_data(msg_type, manager.read_bytes(4))
+    print(data)
+
+    time.sleep(0.001)

pressure_test.py

@@ -0,0 +1,19 @@
+import time
+
+from tools.plotter import Plot
+from tools.serial_manager import DataType, SerialManager, pack_data, unpack_data
+
+manager = SerialManager("slc-control-lib", baud=115200)
+
+while True:
+    data = manager.read_bytes(5)
+
+    pressure = data[2] << 16 | data[1] << 8 | data[0]
+    temperature = data[4] << 8 | data[3]
+
+    temperature /= 100
+    pressure /= 40.96
+
+    print(f"P: {pressure:.2f}, T: {temperature:.2f}")
+
+    time.sleep(0.001)

serial_print_raw.py

@@ -0,0 +1,11 @@
+import time
+
+from tools.serial_manager import SerialManager
+
+manager = SerialManager("slc-control-lib", baud=38400)
+
+while True:
+    data = manager.read_all()
+    if data:
+        print(data)
+    time.sleep(0.001)