fix: use serial driver
This commit is contained in:
@@ -9,8 +9,7 @@ class PWMDriver():
|
|||||||
|
|
||||||
def _init_pwm(self) -> None:
|
def _init_pwm(self) -> None:
|
||||||
from serial import Serial
|
from serial import Serial
|
||||||
pass
|
self.serial = Serial(self.port, self.baudrate)
|
||||||
#self.serial = Serial(self.port, self.baudrate)
|
|
||||||
|
|
||||||
def _send_position(self, pos : tuple[float, float, float]) -> None:
|
def _send_position(self, pos : tuple[float, float, float]) -> None:
|
||||||
x, y, z = pos
|
x, y, z = pos
|
||||||
@@ -22,14 +21,11 @@ class PWMDriver():
|
|||||||
|
|
||||||
# Send PWM values to the serial port
|
# Send PWM values to the serial port
|
||||||
print(f"Sending PWM values: X={pwm_x:<5}, Y={pwm_y:<5}, Pen={pen}")
|
print(f"Sending PWM values: X={pwm_x:<5}, Y={pwm_y:<5}, Pen={pen}")
|
||||||
#self.serial.write(f"{pwm_x},{pwm_y},{pen}\n".encode())
|
self.serial.write(f"{pwm_x},{pwm_y},{pen}\n".encode())
|
||||||
|
|
||||||
def _position_reached(self) -> bool:
|
def _position_reached(self) -> bool:
|
||||||
# Check if the position has been reached
|
# Check if the position has been reached
|
||||||
from time import sleep
|
return self.serial.readline().decode().strip() == "OK"
|
||||||
sleep(0.5)
|
|
||||||
return True
|
|
||||||
# return self.serial.readline().decode().strip() == "OK"
|
|
||||||
|
|
||||||
def _wait_for_position(self) -> None:
|
def _wait_for_position(self) -> None:
|
||||||
# Wait until the position is reached
|
# Wait until the position is reached
|
||||||
|
|||||||
Reference in New Issue
Block a user