From ade1aba1b17bfe8ae97402ea5adc64f4d8310ae7 Mon Sep 17 00:00:00 2001
From: =?UTF-8?q?Marcus=20Nordstr=C3=B6m?= <marcus.nordstrom@plejd.com>
Date: Wed, 28 May 2025 19:53:33 +0200
Subject: [PATCH] feat: works on actual HW now

---
 set_pos.py | 26 ++++++++++++++++++++++++++
 1 file changed, 26 insertions(+)
 create mode 100755 set_pos.py

diff --git a/set_pos.py b/set_pos.py
new file mode 100755
index 0000000..e8e2431
--- /dev/null
+++ b/set_pos.py
@@ -0,0 +1,26 @@
+#! /usr/bin/env python3
+import serial
+import argparse
+
+if __name__ == "__main__":
+    parser = argparse.ArgumentParser(description="Set the position of the PWM driver.")
+    parser.add_argument("x", type=float, help="X coordinate [0 - 1]")
+    parser.add_argument("y", type=float, help="Y coordinate [0 - 1]")
+    parser.add_argument("pen", type=int, help="pen down (True) or pen up (False)")
+    parser.add_argument("-p", "--port", type=str, required=True, help="Serial port")
+    args = parser.parse_args()
+
+    # Open the serial port
+    ser = serial.Serial(args.port, 115200)
+
+    # Saturate values to [0, 1]
+    args.x = int(max(0, min(1, args.x)) * 0xFFFF)
+    args.y = int(max(0, min(1, args.y)) * 0xFFFF)
+    args.z = int(max(0, min(1, args.pen)))
+
+    # Send the position
+    print(f"{args.x},{args.y},{args.z}\n")
+    ser.write(f"{args.x},{args.y},{args.z}\n".encode())
+
+    # Close the serial port
+    ser.close()
\ No newline at end of file