def my(): wp.wiringPiSetupGpio() wp.wiringPiSetup() uls = Ultrasonic(20, 21) tesla = Tesla_motor(23, 18, 25, 24) tesla.allStop() while 1: distance = uls.distance() print(distance) if distance > 30: tesla.forwardDrive() #sleep(5) else: tesla.allStop()
def loop(): global lcd lcd = LCD() us = Ultrasonic(GPIO_TRIGGER, GPIO_ECHO) while True: distance = us.distance() if distance: lcd.message('distance:\n ') print('distance:%0.2fcm' % distance) #lcd.clear() lcd.message('distance:\n%0.2fcm' % distance) else: print('Error') time.sleep(0.2)