# importamos modulos
from machine import Pin, PWM
from hcsr04 import hcsr04
import time
#___________________________________

servo_sg90 = PWM (Pin(21), freq = 50)
medidor1 = HCSR04(trigger_pin = 4, echo_pin =5)
medidor2 = HCSR04(trigger_pin = 18, echo_pin =19)
#__________________________________
angulo= 180.0
angulo1= 0.0
angulo2= 90.0

while True:
    distancia = round(medidor1.distance_cm(), 2)
    print("Sensor Izquierda: ",distancia)
    distancia2 = round(medidor2.distance_cm(), 2)
    print("sensor derecha: ",distancia2)
    time.sleep(2)

if distancia1 > 100 and distancia2 < 3:
    duty= ((3.06084 * angulo ** 2 + 10278 * angulo + 550000))