Рис. 7
Предлагаем реализовать следующий алгоритм управления роботом:
Нажатие верхней левой кнопки включает вращение левого мотора, робот поворачивает вправо (Рис. 7 поз. 2 значение: 1)
Нажатие верхней правой кнопки включает вращение правого мотора, робот поворачивает влево (Рис. 7 поз. 2 значение: 3)
Одновременное нажатие верхних левой и правой кнопок включает одновременное вращение вперед левого и правого мотора, робот двигается вперед прямолинейно (Рис. 7 поз. 2 значение: 5)
Одновременное нажатие нижних левой и правой кнопок включает одновременное вращение назад левого и правого мотора, робот двигается назад прямолинейно (Рис. 7 поз. 2 значение: 8)
Если не нажата ни одна кнопка маяка - робот останавливается (Рис. 7 поз. 2 значение: 0).
При разработке алгоритма дистанционного управления вы должны знать следующее: когда нажата одна из комбинаций серых кнопок - инфракрасный маяк непрерывно посылает соответствующий сигнал, если кнопки отпущены, то отправка сигнала прекращается. Исключение составляет отдельная горизонтальная серая кнопка (Рис. 7 поз 2 значение: 9). Эта кнопка имеет два состояния: "ВКЛ" - "ВЫКЛ". Во включенном состоянии маяк продолжает посылать сигнал, даже если вы отпустите кнопку
(о чём сигнализирует загорающийся зеленый светодиод), чтобы выключить отправку сигнала в этом режиме - нажмите горизонтальную серую кнопку еще раз.
Приступим к реализации программы:
Наш алгоритм дистанционного управления предусматривает 5 вариантов поведения, соответственно наш программный блок "Переключатель" будет состоять из пяти программных контейнеров. Займемся их настройкой.
Вариантом по умолчанию назначим вариант, когда не нажата ни одна кнопка (Рис. 7 поз. 2 значение: 0). Установим в контейнер программный блок "Независимое управление моторами", выключающий моторы "B" и "C".
В контейнер варианта нажатия верхней левой кнопки (Рис. 7 поз. 2 значение: 1) установим программный блок "Большой мотор", включающий мотор "B".
В контейнер варианта нажатия верхней правой кнопки (Рис. 7 поз. 2 значение: 3) установим программный блок "Большой мотор", включающий мотор "C".
В контейнер варианта одновременного нажатия верхних левой и правой кнопок (Рис. 7 поз. 2 значение: 5) установим программный блок "Независимое управление моторами", включающий вращение моторов "B" и "C" вперед.
В контейнер варианта одновременного нажатия нижних левой и правой кнопок (Рис. 7 поз. 2 значение: 8) установим программный блок "Независимое управление моторами", включающий вращение моторов "B" и "C" назад.
Поместим наш настроенный программный блок "Переключатель" внутрь программного блока "Цикл".
По предложенной схеме попробуйте создать программу самостоятельно, не подглядывая в решение!
Загрузите получившуюся программу в робота и запустите её на выполнение. Попробуйте управлять роботом с помощью инфракрасного маяка. Всё ли у вас получилось? Понятен ли вам принцип реализации дистанционного управления?
Заключение .
Мы ознакомились с 4 темой «Датчики и их возможности». Научились собирать базовые конструкции роботов, разобрали функции датчиков Lego mindstorms, научились их программировать.
Достарыңызбен бөлісу: |