from machine import Pin, PWM
import time
# Configuración de los pines del L293
enaA = PWM(Pin(14), freq=490) # Pin D1 en la ESP8266 para PWM GPIO5
enaB = PWM(Pin(12), freq=490) #Pin D2 en la ESP8266 para PWM GPIO4
motad = Pin(15, Pin.OUT) # Pin D3 en la ESP8266, motor1 GPIO0
motbd = Pin(13, Pin.OUT) # Pin D4 en la ESP8266, motor2 GPIO2
#Sensores
sensIz=Pin(10,Pin.IN) #Pin D7 Shield
sensDr=Pin(9,Pin.IN) #Pin D5 Shield
motad.value(0)
motbd.value(0)
enaA.duty(0)
enaB.duty(0)
print ('Dispositivo Listo')
def adelante():
print ('Adelante')
motad.value(1)
motbd.value(1)
enaA.duty(900)
enaB.duty(900)
def izquierda():
print ('Izquierda')
motad.value(0)
motbd.value(1)
enaA.duty(900)
enaB.duty(900)
def derecha():
print ('Derecha')
motad.value(1)
motbd.value(0)
enaA.duty(900)
enaB.duty(900)
def stop():
print ('Stop')
motad.value(0)
motbd.value(0)
enaA.duty(0)
enaB.duty(0)
while True:
izq=not(sensIz.value())
der=not(sensDr.value())
print (izq,'-',der)
if izq & der:
adelante()
elif der==True:
izquierda()
elif izq==True:
derecha()
else:
stop()
time.sleep(0.5)