import motor
import distance_sensor as ds
import color_sensor as cs
import color
from hub import port
import time
Motor_1 = port.E #первый мотор
Motor_r = port.F #правый мотор
DS = port.C #датчик расстояния
CS = port.A #датчик цвета
while True:
if cs.color(CS) == color.BLACK:
#если цвет черный, отбежать назад
motor.run_for_degrees(Motor_1, 360*5, 200)
motor.run_for_degrees(Motor_r, 360*5, -200)
time.sleep(0.1)
else:
#иначе ищем керли
if ds.distance(DS) <= 250:
#если расстояние меньше или равно 250см, двигаться вправо
motor.run(Motor_1, -200)
motor.run(Motor_r, 200)
time.sleep(0.1)
else:
#если расстояние больше 250см, то двигаться влево
motor.run(Motor_1, 200)
motor.run(Motor_r, 200)
time.sleep(0.1)