diff --git a/pwm_driver.py b/pwm_driver.py
index 7965acb..bf67e82 100644
--- a/pwm_driver.py
+++ b/pwm_driver.py
@@ -9,8 +9,7 @@ class PWMDriver():
 
     def _init_pwm(self) -> None:
         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:
         x, y, z = pos
@@ -22,14 +21,11 @@ class PWMDriver():
         
         # Send PWM values to the serial port
         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:
         # Check if the position has been reached
-        from time import sleep
-        sleep(0.5)
-        return True
-        # return self.serial.readline().decode().strip() == "OK"
+        return self.serial.readline().decode().strip() == "OK"
     
     def _wait_for_position(self) -> None:
         # Wait until the position is reached