from stepperdriver import Stepper
from ultrasonicdriver import HCSR04
from time import sleep
from machine import Pin, ADC, I2C
import oleddriver
import utime
from rtc import RTC

Stepper1 = Stepper(5, 17, 0, 1)
Stepper2 = Stepper(14, 27, 0, 1)
us = HCSR04(23, 34)

opened = 0

# I2C Port
i2c = I2C(0, scl=Pin(22), sda=Pin(21), freq=400000)

# I2C OLED
oled = oleddriver.SSD1306_I2C(128, 64, i2c)

# I2C Real time clock - DS1307 
rtc = RTC(i2c)

oled.fill(0)


while True:
    if us.get_distance_cm() < 50 and opened == 0:
        Stepper1.steps(5*200)
        opened = 1
        oled.fill(0)
        oled.text("OPENDED!", 35, 20)
        oled.show()
    elif us.get_distance_cm() > 50 and opened == 1:
        Stepper2.steps(-5*200)
        opened = 0
        oled.fill(0)
        oled.text("CLOSED!", 35, 20)
        oled.show()


    sleep(.01)