Spacer
ROB-77529Робот имеет размеры: 30 на 27 см и полностью помещается в стартовую зону
Конструкция робота: двухмоторная тележка на 2х больших моторах на средних колёсах (диаметром 56 мм из набора 45544), а также 2 пассивных колеса сзади (Ступица, 24x4 мм, темно-серая 4587275) для баланса и 2 пассивных колеса на балках спереди для устойчивости устройств спереди (коническое зубчатое колесо, 12 зубьев, бежевое). Спереди на контроллер установлен средний мотор с незамысловатым устройством для «выпинывания» шайб, устройство может проворачиваться на 360, устройство создано из осей, углового блока 6 (90º) и двойного конического зубчатого колеса, 36 зубьев. Конструкция этого устройства перерабатывалась несколько раз, но на практике мы поняли, что самая простая конструкция самая рабочая. Так же спереди сконструировали широкую раму, на которую установили по середине датчик цвета вниз, для определения линии и цветов шайб и ультразвуковой датчик вниз для определения местонахождения шайб, датчик ультразвука установлен немного под углом для лучшего обнаружения шайб не случайно, его установку так же переделывали несколько раз. Справа (со стороны белой части поля) сконструировали и установили специальный «карман» для шайб жёлтого цвета с зашитой колеса, так же конструкция обеспечивает защиту от случайного попадания синих шайб.
Алгоритм программы: в цикле робот выезжает из стартовой зоны выравниваясь по линии, и движется вдоль чёрной линии, ультразвуковой датчик считывает изменения расстояния от датчика до поля, если зафиксировал изменения, значит обнаружил фишку, робот проезжает вперёд, что бы датчик цвета оказался над фишкой, переключает режим на определение цвета, определяет цвет далее проезжает еще немного, так что бы фишка оказалась над устройством для выпинывания, устройство срабатывает, с силой прокручивается если фишка синяя или зёленая, чуть слабее прокручивается если фишка жёлтая, если фишка красная то робот проезжает мимо фишки, оставляя её на месте одновременно с этим идёт подсчет энкодера, при прокрутке моторов на определённое количество оборотов робот останавливается в зоне финиша
Файлы
Добавлен 27.12.2024