from machine import Pin,PWM
from time import sleep
import math
from servo import Servo
from encoder import Encoder
import encoder
# from pir import PIR

led_pin = PWM(Pin(14),freq=2)
#0.1 from 0.5 
led_pin.duty(int((20/100)*(2**10-1)))

def handle_encoder_rotation(direction):
  if direction == Encoder.ROT_CW:
    my_servo1.rotate(9)
    my_servo2.rotate(-9)
  else: 
    my_servo1.rotate(-9)
    my_servo2.rotate(9)

# def handlerfunction():
#     if pir_pin.value() == 1:
#         my_servo1.move(90)
#         my_servo2.move(90)
#     else:
#       my_servo1.move(0)
#       my_servo2.move(0)




my_servo1 = Servo(15)
my_servo2 = Servo(16)
# pir = PIR(5)
# my_encoder = Encoder(25,26,handle_encoder_rotation)
# my_servo1.configure(0,180,0.55,2.55)

print("Hello, ESP32!")

while True:
  pass