initial commit

This commit is contained in:
2025-05-03 13:38:03 +02:00
commit 2e3e0e316b
10 changed files with 54 additions and 0 deletions

31
code.py Normal file
View File

@@ -0,0 +1,31 @@
import time
import board
import usb_cdc
import pwmio
import digitalio
pwm_X = pwmio.PWMOut(board.GP17, frequency=1000, duty_cycle=0)
pwm_Y = pwmio.PWMOut(board.GP18, frequency=1000, duty_cycle=0)
pen = digitalio.DigitalInOut(board.GP16)
pen.direction = digitalio.Direction.OUTPUT
pen.value = False # Set pen to up position
def message_handler(msg):
parts = msg.split(',')
if len(parts) != 3:
print("Invalid message format")
return
print(f"X: {parts[0]}, Y: {parts[1]}, Pen: {parts[2]}")
pwm_X.duty_cycle = int(parts[0])
pwm_Y.duty_cycle = int(parts[1])
pen.value = True if int(parts[2]) == 1 else False
print("Booted")
while True:
if usb_cdc.data.in_waiting:
data = usb_cdc.data.read(usb_cdc.data.in_waiting)
message = data.decode('utf-8').strip()
message_handler(message)
time.sleep(0.5)
usb_cdc.data.write(b"OK\n")
time.sleep(0.1)