def test(): ZumoButton().wait_for_press() ultra = Ultrasonic() m = Motors() ultra.update() tall = ultra.get_value() print("tall: ", tall) while tall < 5.0: m.backward(0.2, 1) print(tall) ultra.update() tall = ultra.get_value() print(tall)
def sensorTest(): ZumoButton().wait_for_press() sensor = Ultrasonic() count = 0 while count < 5: sensor.update() print(sensor.get_value()) count += 1
def explorer(dist=10): ZumoButton().wait_for_press() m = Motors() u = Ultrasonic() u.update() while u.get_value() > dist: m.forward(.2, 0.2) u.update() m.backward(.1, .5) m.left(.5, 3) m.right(.5, 3.5) sleep(2) u.update() while u.get_value() < dist * 5: m.backward(.2, 0.2) u.update() m.left(.75, 5)
def distance(): us = Ultrasonic() button = ZumoButton() while True: button.wait_for_press() us.update() reading = us.get_value() print(reading) time.sleep(0.6)
def get_distance_value(self): """ Shortcut for getting distance :return: Distance """ ultra = Ultrasonic() ultra.update() value = ultra.get_value() return value
def calculateFront(self): u_sensor = Ultrasonic() u_sensor.update() distance = u_sensor.get_value() if distance < 5: self.pri_value = 1000 else: self.pri_value = 0 return self.pri_value
class UltrasonicSensob(Sensob): def __init__(self): super(UltrasonicSensob, self).__init__() self.sensor = Ultrasonic() self.sensors.append(self.sensor) def get_value(self): ''' returnerer en verdi = avstand i cm''' return self.value def update(self): self.sensor.update() self.value = self.sensor.get_value() return self.value
class Peeper(Sensob): def __init__(self): super(Peeper, self).__init__() self.sensor = Ultrasonic() self.value = -1.0 self.interpretation = 1.0 def update(self): self.sensor.update() self.value = self.sensor.get_value() self.interpret() def reset(self): pass def interpret(self): if self.value > 90: self.interpretation = 1.0 else: self.interpretation = self.value / 90 return self.interpretation def get_interpretation(self): return self.interpretation
def main(): ultra = Ultrasonic() while True: ultra.update() ultra.get_value() time.sleep(0.001)