def move25(): speed4 = Speed(25) speed4.start() # time.sleep(2) fc.forward(35) fc.stop() time.sleep(0.5) fc.turn_right(50) print('distance:', fc.us.get_distance())
def turnRight(): speed4 = Speed(25) speed4.start() # time.sleep(2) fc.turn_right(80) x = 0 for i in range(15): time.sleep(0.1) speed = speed4() x += speed * 0.1 print("%smm/s" % speed) print("%smm" % x) speed4.deinit() fc.stop()
def drive(self, speed=__INITIAL_SPEED): """ Main entry point of the car, and put it in drive mode Keyword arguments: speed -- speed of back wheel, range is 0 (stop) - 100 (fastest) """ logging.info('Starting to drive at speed %s...' % speed) i = 0 while self.camera.isOpened() and i < 30: _, image_lane = self.camera.read() image_objs = image_lane.copy() i += 1 self.video_orig.write(image_lane) # image_objs = self.process_objects_on_road(image_objs) # self.video_objs.write(image_objs) # show_image('Detected Objects', image_objs) image_lane = self.follow_lane(image_lane) self.video_lane.write(image_lane) # show_image('Lane Lines', image_lane) cv2.imshow('Lane Lines', image_lane) if cv2.waitKey(1) & 0xFF == ord('q'): self.cleanup() break speed4 = Speed(25) speed4.start() # time.sleep(2) fc.forward(20) x = 0 for i in range(25): time.sleep(0.1) speed = speed4() x += speed * 0.1 # time.sleep(0.5) #print("%smm/s"%speed) print("%smm" % x) speed4.deinit() fc.stop()