Example #1
0
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
Example #2
0
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)
Example #3
0
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)
Example #4
0
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)
Example #5
0
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)