Арха

ROB-63859

Для выполнения поставленной задачи мы собрали робота из конструктора Lego Mindstorms EV3. Он состоит из: блока EV3, двух больших моторов EV3, одного датчика цвета в режиме цвета,  двух ультразвуковых датчиков расстояния и одного датчика гироскопа. Движение  реализовано на больших моторах EV3. Датчик цвета служит для распознавания цвета, два датчика расстояния для проезда по лабиринту по специальному алгоритму, датчик гироскопа служит для грамотного поворота. Программа написана в среде RobotC. Робот работает по алгоритму прохождения лабиринта по правой руке: если с права есть проход то мы поворачиваем на право и немного проезжаем, иначе мы проверяем есть ли спереди проход если он есть то мы едем вперёд, а если и слева и спереди нет прохода то мы поворачиваем один раз на лево на 90 градусов и не много проезжаем. В процессе проезда лабиринта у нас присутствуют калибровки которые служат для калибровки гироскопа. Пока мы проезжаем лабиринт мы всё записываем цифрами в массив. 3 - это вперёд, 2 - это налево, 1 - направо. Когда датчик цвета видит определенный цвет то робот останавливаться начинает резать массив (то есть убирать из записи массива все тупики). Потом он перебрасывает уже обрезанный массив на другую программу. Потом мы включаем эту программу на роботе. Робот читает массив, два раза поворачивает на лево и проезжает по готовому массиву к месту старта робота.