#pin 5v -> vcc

#pin A1 -> echo

#pin A0 -> trigger

#----------------------------------
import time
from pyA20.gpio import gpio
from pyA20.gpio import port

GPIO_TRIGGER = port.PA0
GPIO_ECHO = port.PA1

gpio.init()
gpio.setcfg(GPIO_TRIGGER, gpio.OUTPUT)
gpio.setcfg(GPIO_ECHO, gpio.INPUT)
gpio.output(GPIO_TRIGGER, 0)

try:
print ("pulsa ctrl+c para salir")
while True:
gpio.output(GPIO_TRIGGER, 1)
time.sleep(0.0001)
gpio.output(GPIO_TRIGGER, 0)
while gpio.input(GPIO_ECHO)==0:
start = time.time()
while gpio.input(GPIO_ECHO)==1:
stop = time.time()
elapsed = stop-start
distance = (elapsed * 34300)/2
print("%.2f" %distance + "Centimetros")
time.sleep(1)
except KeyboardInterrupt:
print ("salienso")
#---------------------------------------------------------

#--------ultrasonido con mqtt para node-red--------------

import paho.mqtt.publish as publish

import time

from pyA20.gpio import gpio

from pyA20.gpio import port

GPIO_TRIGGER = port.PA0

GPIO_ECHO = port.PA1

gpio.init()

gpio.setcfg(GPIO_TRIGGER, gpio.OUTPUT)

gpio.setcfg(GPIO_ECHO, gpio.INPUT)

gpio.output(GPIO_TRIGGER, 0)
try:

while True:

gpio.output(GPIO_TRIGGER, 1)

time.sleep(0.0001)

gpio.output(GPIO_TRIGGER, 0)

while gpio.input(GPIO_ECHO)==0:

start = time.time()

while gpio.input(GPIO_ECHO)==1:

stop = time.time()

elapsed = stop-start

distance = (elapsed * 34300)/2

publish.single("distancia","%.2f" %distance+ " cm",

hostname="localhost")

#print("%.2f" %distance + "Centimetros")

time.sleep(1)

except KeyboardInterrupt:

print ("salienso")

return msg
#------------------------------------------------------