from PiBot import PiBot

# Create a robot instance
robot = PiBot()
'''[0] - left left
    [1] - left
    [2] - middle left
    [3] - middle right
    [4] - right
    [5] - right right'''

listmove = robot.get_line_sensors
while True:
    if listmove[0] < 255 or listmove[1] < 255:
        robot.set_left_wheel_speed(-1)
        robot.set_right_wheel_speed(10)
        robot.sleep(0.5)
        listmove = robot.get_line_sensors
        print("levo suka")
    elif listmove[2] < 255 or listmove[3] < 255:
        robot.set_left_wheel_speed(10)
        robot.set_right_wheel_speed(10)
        listmove = robot.get_line_sensors
        robot.sleep(0.5)
        print("idu nahuy prjamo")
    elif listmove[4] < 255 or listmove[5] < 255:
        robot.set_right_wheel_speed(10)
        robot.set_left_wheel_speed(-1)
        robot.sleep(0.5)
        listmove = robot.get_line_sensors
        print("sosu pravo")