бобот

ROB-80117

Для проезда лабиринта в одну и другую сторону мы собрали робота из конструктора Lego Mindstorms EV3 и запрограммировали. Он состоит из: блок EV3, двух моторов EV3, гироскопа EV3, двух ультразвуковых датчиков расстояния и одного датчика света в режиме цвета. Движение реализовано на больших моторах. Датчики расстояния нужны для движения вдоль стен, а датчик света для поиска конца лабиринта. Так же мы используем гироскоп для калибровки когда стены чтобы ровняться с помощью ультразвукового датчика. Мы после каждого проезда вперёд если спереди стена мы калибруемся ударом в стену. Программа состоит из 450 строчек кода.
Программа написана в ROBOTC. Робот стоит в стартовой позиции, если справа стены нет, то он поворачивается направо и заезжает. Если справа стена, то он проверяет есть ли стена спереди него, если нету, то он проезжает вперёд. Если стена и справа, и спереди, то он поворачивается налево. Когда он доезжает до метки, то записывает в файл массив и отрезает тупики. после следующего запуска с стартовой позиции он проедет в одну и другую сторону по кратчайшему пути.