from machine import Pin,PWM
from time import sleep
from servo import Servo
from encoder import RotaryEncoder

print("Hello, ESP32!")

def handle_encoder_rotation(direction):
    if direction == RotaryEncoder.ROT_CW:
        servo1.rotate(9)
        servo2.rotate(-9)
    else:
        servo1.rotate(-9)
        servo2.rotate(9)

servo1 = Servo(12)
servo2 = Servo(15)
encoder = RotaryEncoder(27,14,handle_encoder_rotation)



def setup():
    pass

def main():
    pass
        


if __name__ == '__main__':
    pass
    # setup()
    # while True:
    #     main()