Programa de Orden de restricción

# hc-sr04.py - print distance to object in cm
# (c) BotBook.com - Karvinen, Karvinen, Valtokari
from turtle import*
import time
import botbook_gpio as gpio


t=Turtle()
t2=Turtle()
t3=Turtle()
t4=Turtle()
t5=Turtle()

screen=t.getscreen()

setup(650,650,0,0)
screensize(120,120)
colormode(255)
t3.hideturtle()
t4.hideturtle()
t5.hideturtle()

#Color tortugas
t2.color("red")

#NO DIBUJAR
t.penup()
t2.penup()
t3.penup()
t4.penup()
t5.penup()

#VELOCIDAD
t.speed(5)
t2.speed(5)
t3.speed(0)
t4.speed(0)
t5.speed(0)

#FIGURAS
t.shape("turtle")
t2.shape("turtle")
t3.shape("turtle")
t4.shape("turtle")
t5.shape("turtle")

#Tamano
t.turtlesize(2)
t2.turtlesize(2)
t3.turtlesize(2)

def readDistanceCm():
triggerPin = 22
echoPin = 27

v=(331.5+0.6*20) # m/s

gpio.mode(triggerPin, "out")

gpio.mode(echoPin, "in")
gpio.interruptMode(echoPin, "both")

gpio.write(triggerPin, gpio.LOW)
time.sleep(0.5)

gpio.write(triggerPin, gpio.HIGH)
time.sleep(1/1000.0/1000.0)
gpio.write(triggerPin, gpio.LOW)

t = gpio.pulseInHigh(echoPin) # s

d = t*v
d = d/2
return d*100 # cm

#Lugares
t2.left(180)
t.goto(0,0)
t2.goto(300,0)
t3.goto(0,-200)
t3.pendown()
t3.color("green")
t3.circle(200)
t3.penup()
t3.goto(170,-290)

#Semaforo
t4.goto(250,250)
t4.dot(50,255,200,200)
t5.goto(250,190)
t5.dot(50,0,255,0)

t2.speed(1)

q = 200
t = 0

def main():
for i in range (100):
d = readDistanceCm() # <2>
t=q+d
print( "Distance is %.2f cm" % d)
time.sleep(.5)
t2.goto(t,0)
if t < 225 :

t4.dot(50,255,0,0)#circulo rojo ENCENDIDO
t5.dot(50,200,255,200)#CIRCULO VERDE APAGADO
t3.color("red")
t3.write("PELIGRO!!",False,"right", ("Arial", 50,))
t3.color("white")
t3.write("ok!!",False,"left", ("Arial", 50,))

else:
if t>225:
t4.dot(50,255,200,200)#circulo rojo APAGADO
t5.dot(50,0,255,0)#circulo verde ENCENDIDO
t3.color("white")
t3.write("PELIGRO!!",False,"right", ("Arial", 50,))
t3.color("green")
t3.write("ok!!",False,"left", ("Arial", 50,))


if __name__ == "__main__":
main()


screen.exitonclick()

MUESTRAS: