print("THIS PROJECT WILL INTEGRATE WITH ESP32, ULTRASONIC SENSOR, OLED AND SERVO MOTOR FOR AUTOMATIC WELCOMING DOOR.")

import hcsr04  # ultrasonic sensor lib
import ssd1306 #OLED lib
from machine import SoftI2C,Pin,PWM
from servo import Servo
from utime import sleep

#create object for ultrasonic sensor
ultrasonic_sensor=hcsr04.HCSR04(trigger_pin=5,echo_pin=18,echo_timeout_us=500*2*30) 

#oled
i2c_oled_disp = SoftI2C(scl=Pin(22),sda=Pin(21))
oled_width = 128
oled_height = 64
oled=ssd1306.SSD1306_I2C(oled_width,oled_height,i2c_oled_disp)

#servo
servo_motor = PWM(Pin(23),Pin.OUT)
servo_motor.freq(50)

#display distance from ultrasonic
jarak_in_cm = ultrasonic_sensor.distance_cm()
jarak_in_mm = ultrasonic_sensor.distance_mm()

#display the range on serial monitor
print("An object is detected in: ",jarak_in_cm,'cm')
print ("An object is detected in: ",jarak_in_mm,'mm')

#condition of sensor vs distance
if jarak_in_cm<70:
    for i in range (10):
        servo_motor.duty(123)
        sleep(1.0)   
        oled.fill(1)
        oled.text('WELCOME!',5,20,0)
        oled.show()

else:
    servo_motor.duty(0)
    sleep(0.5)
    oled.fill(1)
    oled.text('GOODBYE!',5,20,0)
    oled.show()
 
sleep (6)