Кама

ROB-63860

Робот собран на базе конструктора Lego Mindstorms EV3 Education. В нем используются: блок EV3, два больших мотора для движения, два ультразвуковых датчика расстояния для поиска стен и движения вдоль них, гироскоп для точного поворота робота и датчик цвета для определения конца пути. 

Программа написана в среде ROBOTC В ней созданы подпрограммы MoveRobot для проезда робота вперед, TurnRobot для поворота робота (по гироскопу).  А также подпрограммы CutArray и СatElement для обрезания массива.  

Алгоритм прохождения простой:  пока датчик света не увидел зеленый: проверка наличия препятствия спереди. Если оно есть, поворот налево. Если нет, то проверка стены справа. Если она есть, то движение вдоль неё. Если нет, то проезд вперед, поворот направо, проезд вперед, когда робот увидел зеленый цвет робот обрезает тупики, и выполняет проезд по короткому маршруту.