Робот на VEX IQ для соревнований Шорт-трект
January 10, 2023
Робот на VEX IQ для соревнований Шорт-трект
Подключение датчиков и электромоторов
- Левый датчик света подключается в порт 3
- Правый датчик света подключается в порт 4
- Датчик ультразвука подключается в порт 5
- Левый электромотор подключается в порт 7
- Правый электромотор подключается в порт 12
Программа для робота
В программе используется ПД регулятор для движения робота по черной линии. Основная настройка программы идет в качестве подбора коэффициентов которые в программе обозначены именами k - основная переменная для реагирования робота на изменение черной линии, переменная d это дифференциальная составляющая отвечает за проверку выравнивание робота на черной линии. Если робот слишком глубоко заехал на черную линию коэффициент d увеличит усиливающие значение для моторов и робот быстрее вернется на белую область.
Движение по черной линии с автоматической остановкой перед впереди едущим роботом
На главную Главная