#OLED PROGRAMMING
'''from machine import Pin, I2C
import ssd1306

# 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_width = 128
oled_height = 64
oled = ssd1306.SSD1306_I2C(oled_width, oled_height, i2c)

#TO WRITE IN OLED
oled.text('TRIGGERED', 10, 10)      
        oled.show()

#TO CLEAR SCREEN IN OLED
oled.fill(0)    
        oled.show()
'''

#ULTRASONIC SENSOR
'''
from hcsr04 import HCSR04
from time import sleep

# ESP32
sensor = HCSR04(trigger_pin=5, echo_pin=18, echo_timeout_us=10000)

# ESP8266
#sensor = HCSR04(trigger_pin=12, echo_pin=14, echo_timeout_us=10000)

distance = sensor.distance_cm()
print('Distance:', distance, 'cm')
'''

#SERVO MOTOR
'''
from servo import Servo

motor1=Servo(pin=26)
motor2=Servo(pin=27)

motor1.move(0)
motor2.move(180)
sleep(0.3)
motor1.move(90)
motor2.move(90)
sleep(0.3)
'''

#To know LED Address
'''
import machine

sdaPIN=machine.Pin(21)  #for ESP32
sclPIN=machine.Pin(22)

i2c=machine.I2C(sda=sdaPIN, scl=sclPIN, freq=10000)   

devices = i2c.scan()
if len(devices) == 0:
 print("No i2c device !")
else:
 print('i2c devices found:',len(devices))
for device in devices:
 print("At address: ",hex(device))
 '''

#LCD 
'''
import machine
from machine import Pin, SoftI2C
from lcd_api import LcdApi
from i2c_lcd import I2cLcd
from time import sleep

I2C_ADDR = 0x27
totalRows = 2
totalColumns = 16

i2c = SoftI2C(scl=Pin(22), sda=Pin(21), freq=10000)     #initializing the I2C method for ESP32
#i2c = I2C(scl=Pin(5), sda=Pin(4), freq=10000)       #initializing the I2C method for ESP8266

lcd = I2cLcd(i2c, I2C_ADDR, totalRows, totalColumns)

while True:
    lcd.putstr("HELLO MY NAME IS AJ KOCI")
    sleep(2)
    lcd.clear()
    lcd.putstr("Lets Count 0-10!")
    sleep(2)
    lcd.clear()
    for i in range(11):
        lcd.putstr(str(i))
        sleep(1)
        lcd.clear()
'''
# Complete project details at https://RandomNerdTutorials.com/micropython-hc-sr04-ultrasonic-esp32-esp8266/
from hcsr04 import HCSR04
from servo import Servo
from machine import Pin, I2C
import ssd1306
from machine import Pin, SoftI2C
from lcd_api import LcdApi
from i2c_lcd import I2cLcd
from time import sleep

# ESP32
sensor = HCSR04(trigger_pin=5, echo_pin=18, echo_timeout_us=10000)

# ESP8266
#sensor = HCSR04(trigger_pin=12, echo_pin=14, echo_timeout_us=10000)

# 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)

I2C_ADDR = 0x27
totalRows = 2
totalColumns = 16

i2c = SoftI2C(scl=Pin(22), sda=Pin(21), freq=10000)     #initializing the I2C method for ESP32
#i2c = I2C(scl=Pin(5), sda=Pin(4), freq=10000)       #initializing the I2C method for ESP8266

lcd = I2cLcd(i2c, I2C_ADDR, totalRows, totalColumns)



while True:
    distance = sensor.distance_cm()
    print('Distance:', distance, 'cm')
 
    if distance<=3 and distance>=0:
        print('TRIGGERED')

        oled.text('TRIGGERED', 10, 10)      
        oled.show()

        lcd.putstr('TRIGGERED')
        lcd.clear()

        motor1=Servo(pin=26)
        motor2=Servo(pin=27)
        motor1.move(0)
        motor2.move(180)
        sleep(0.3)
        motor1.move(90)
        motor2.move(90)
        sleep(0.3)
    
    else:
        oled.fill(0)    
        oled.show()

    
    sleep(1)