def drive(velocity_high, velocity_low, radius_high, radius_low): task1.write(Lib.DRIVE_START) task1.wait() task1.write(velocity_high) task1.wait() task1.write(velocity_low) task1.wait() task1.write(radius_high) task1.wait() task1.write(radius_low) task1.wait()
def read_sensors_2_bytes(sensor_id): task1.write(Lib.SENSOR_START) task1.wait() task1.write(sensor_id) task1.wait() data = task1.read() task1.wait() data = unpack_2_bytes(data) if data is not None: return data else: return -1
def full(): task1.write(Lib.FULL)
def play_song(song_number): task1.write(Lib.PLAY) task1.write(song_number)
def warning_song(): task1.write(Lib.SONG) task1.write(0) task1.write(3) task1.write(45) task1.write(32) task1.write(47) task1.write(32) task1.write(48) task1.write(32)
def safe(): task1.write(Lib.SAFE)
def passive(): task1.write(Lib.START)
def drive_direct(right_high, right_low, left_high, left_low): task1.write(Lib.DRIVE_DIRECT) task1.write(right_high) task1.write(right_low) task1.write(left_high) task1.write(left_low)
def reset(): task1.write(Lib.RESTART)
def stop(): task1.write(Lib.STOP)
def start(): task1.write(Lib.START)