class FrontalDistance():
def __init__(self, trig="D0", echo="D1"):
self.ultrasonic = Ultrasonic(Pin(trig), Pin(echo)) # create an Ultrasonic object from pin
print(" [.] Created ultrasonic object", self.ultrasonic)
def read(self):
return self.ultrasonic.read() # read an analog value
def forever():
global reference, distance
distance = Ultrasonic(pin_D0, pin_D1).read()
if distance >= reference:
__SLOTH__.do_action('forward', 1, 100)
else:
__SLOTH__.do_action('backward', 1, 100)
__SLOTH__.do_action('stop', 1, 100)
__SLOTH__.do_action('turn right', 1, 100)
__SLOTH__.do_action('stop', 1, 100)
def forever():
global distance, reference
distance = Ultrasonic(pin_D0, pin_D1).read()
if distance >= reference:
sloth.do_action('forward', 1, 100)
else:
sloth.do_action('backward', 1, 100)
sloth.do_action('stop', 1, 100)
sloth.do_action('turn right', 2, 100)
sloth.do_action('stop', 1, 100)
def forever():
global Ref1, distance, Ref2
distance = Ultrasonic(pin_D0, pin_D1).read()
if distance >= Ref1:
set_dir_servo_angle(0)
forward(50)
elif distance >= Ref2:
set_dir_servo_angle(40)
forward(50)
delay(500)
else:
set_dir_servo_angle((-40))
backward(50)
delay(500)
def forever():
global distance
distance = Ultrasonic(pin_D0, pin_D1).read()
print("%s"%distance)
delay(100)
forward(50)
delay(1000)
backward(50)
delay(1000)
forward(50)
set_dir_servo_angle((-30))
delay(1000)
forward(50)
set_dir_servo_angle(30)
delay(1000)
set_dir_servo_angle(0)
stop()
delay(2000)
def forever():
global distance
distance = Ultrasonic(pin_D0, pin_D1).read()
print("%s" % distance)
delay(100)
def __init__(self, trig="D0", echo="D1"):
self.ultrasonic = Ultrasonic(
Pin(trig), Pin(echo)) # create an Ultrasonic object from pin
print(" [.] Created ultrasonic object", self.ultrasonic)