from machine import Pin, I2C
import ssd1306
import time

print(time.time())
def f_gen(m):
    s = 1
    for n in range(1,m):
        yield
        s += 1
a = f_gen(5)

for i in a:
    print(i)
# ESP32 Pin assignment 
i2c = I2C(0, scl=Pin(22), sda=Pin(21))

oled_width = 128
oled_height = 64
oled = ssd1306.SSD1306_I2C(oled_width, oled_height, i2c)

oled.text('Hello, Wokwi!', 10, 10)      
oled.show()




print("test HCSR04")

from hcsr04 import HCSR04
sensor1 = HCSR04(trigger_pin=26, echo_pin=25)
sensor2 = HCSR04(trigger_pin=33, echo_pin=32)

import leds

led = leds.Leds(5)

time_old = time.ticks_ms()
while True:
    oled.fill(0)
    sensor_1 = sensor1.distance_mm()
    sensor_2 = sensor2.distance_mm()
    oled.text(f'sensor 1: {sensor_1}', 0, 0)
    oled.text(f'sensor 2: {sensor_2}', 0, 10)
    oled.text(f'sensor 2: {time.ticks_ms()-time_old}', 0, 20)
    oled.text(f'sensor 1: {led.sensor_1}', 0, 30)
    oled.text(f'sensor 2: {led.sensor_2}', 0, 40)

    led.update(sensor_1, sensor_2)
    oled.show()
    time_old = time.ticks_ms()