Está en la página 1de 2

1

#!/usr/bin/python3
import time
import RPi.GPIO as GPIO
import os

INA = 37
INB = 38
ENA = 40
ciclo = 50
derecha = False
izquierda = False

GPIO.setmode(GPIO.BOARD)
GPIO.setup(INA, GPIO.OUT)
GPIO.setup(INB, GPIO.OUT)
GPIO.setup(ENA, GPIO.OUT)
motor = GPIO.PWM(ENA,100)
motor.start(ciclo)

def menu():
os.system('clear')
print("\t1 - GIRO DERECHA")
print("\t2 - GIRO IZQUIERDA")
print("\t3 - AUMENTAR VELOCIDAD")
print("\t4 - DISMINUIR VELOCIDAD")
print("\t5 - PARADA")
print("\t6 - SALIR DEL MENU")
#print("Ciclo de trabajo: ",ciclo)
if derecha == True:
print("GIRO DERECHA, " + str(ciclo) + "% " + "ciclo de trabajo")
elif izquierda == True:
print("GIRO IZQUIERDA, " + str(ciclo) + "% " + "ciclo de trabajo")
if (derecha == False and izquierda == False):
print("Ciclo de trabajo: ",ciclo)

def giro_derecha():
global ciclo
global derecha
global izquierda
motor.ChangeDutyCycle(ciclo)
GPIO.output(INA,0)
GPIO.output(INB,1)
derecha = True
izquierda = False

def giro_izquierda():
global ciclo
global derecha
global izquierda
motor.ChangeDutyCycle(ciclo)
GPIO.output(INA,1)
GPIO.output(INB,0)
derecha = False
izquierda = True

def parada():
GPIO.output(INA,0)
GPIO.output(INB,0)

def aumentar():
global ciclo
2

global derecha
global izquierda
if (ciclo >= 0 and ciclo <= 100):
ciclo += 10
if ciclo == 110:
ciclo = 100
if derecha == True:
giro_derecha()
elif izquierda == True:
giro_izquierda()

def disminuir():
global ciclo
global derecha
global izquierda
if (ciclo >= 0 and ciclo <= 100):
ciclo -= 10
if ciclo == -10:
ciclo = 0
if izquierda == True:
giro_izquierda()
elif derecha == True:
giro_derecha()

try:
while True:
menu()
opcionMenu = input("OPCIONES DEL MENU>> ")
if opcionMenu == "1":
giro_derecha()
#input("PULSASTE LA OPCION 1. ENTER PARA CONTINUAR")
elif opcionMenu == "2":
giro_izquierda()
#input("PULSASTE LA OPCION 2. ENTER PARA CONTINUAR")
elif opcionMenu == "3":
aumentar()
elif opcionMenu == "4":
disminuir()
elif opcionMenu == "5":
parada()
#input("PULSASTE LA OPCION 3. ENTER PARA CONTINUAR")
elif opcionMenu == "6":
parada()
os.system('clear')
break
else:
input("NO PULSASTE LA TECLA CORRECTA...\nCONTINUAR")
except KeyboardInterrupt:
parada()
GPIO.cleanup()
os.system('clear')
os.system('date')

También podría gustarte