from machine import Pin, I2C, time_pulse_us
from ssd1306 import SSD1306_I2C
import dht
import time
#import utime

count=0

#US Pin Declare
trigger = Pin(20, Pin.OUT)
echo = Pin(21, Pin.IN)

SOUND_SPEED=340
TRIG_PULSE_DURATION_US=10

#DHT22 Pin
data_pin = Pin(13, Pin.IN, Pin.PULL_UP)
sensor = dht.DHT22(data_pin)

#SSD1306 Display
WIDTH =128
HEIGHT= 64
#Create the I2C connection
i2c=I2C(0,scl=Pin(17),sda=Pin(16),freq=200000)
#Initialize the OLED display
oled = SSD1306_I2C(WIDTH,HEIGHT,i2c)


def ultra():
    
    trigger.value(0)
    time.sleep_us(5)

    trigger.value(1)
    time.sleep_us(TRIG_PULSE_DURATION_US)
    trigger.value(0)

    ultrason_duration = time_pulse_us(echo, 1, 30000)
    distance_cm = SOUND_SPEED * ultrason_duration / 20000

    print(f"Distance : {distance_cm} cm")
    oled.fill_rect(0, 55, 128, 10, 0)
    oled.text("{:.2f} cm".format(distance_cm),4,56)
    oled.show()
    time.sleep_ms(200)


def read_DHT22sensor():
    
    try:
        sensor.measure()
        temperature = sensor.temperature()
        humidity = sensor.humidity()
        print_dht22_data(temperature, humidity)
    except OSError as e:
        print("Error reading data from the sensor")

      

def print_dht22_data(temperature, humidity):
    print("Temperature:{}, Humidity:{}".format(temperature, humidity))
    oled.fill_rect(0, 0, 128, 55, 0)
    oled.text("Temp.",4,8)
    oled.text("Humid.",4,20)
    oled.text(str(temperature),65,8)
    oled.text(str(humidity),65,20)
    oled.show()
    
   

while True:
    
    ultra()
    count+=1

    
    if count == 25:
        read_DHT22sensor()
        count=0