Домашнее задание
В практической части кнопка сразу переводила сервопривод из 0° в 90°. Теперь напишите программу, в которой сервопривод начинает работу со среднего положения 90°, плавно поворачивается влево при удержании кнопки D28 и вправо при удержании кнопки D15, а в крайних положениях зажигает светодиоды D48 и D51.
Сервопривод остаётся подключённым к разъёму D2 с тем же порядком проводов −, +, S.
Требования к работе устройства
- После включения или перезагрузки платы сервопривод устанавливается в среднее положение
90°, а светодиодыD48иD51погашены. - Пока удерживается кнопка
D28и отпущенаD15, угол уменьшается на1°за шаг (поворот влево). Дойдя до0°, сервопривод останавливается. - Пока удерживается кнопка
D15и отпущенаD28, угол увеличивается на1°за шаг (поворот вправо). Дойдя до180°, сервопривод останавливается. - Пауза между шагами составляет
20 мс— благодаря этому вал поворачивается плавно. - Если отпущены обе кнопки или нажаты обе кнопки одновременно, текущий угол не меняется.
- В крайнем левом положении (
0°) горит светодиодD48. В крайнем правом положении (180°) горит светодиодD51. На всех промежуточных углах (1°–179°) оба светодиода выключены.
Требования к программе
- Кнопки настроены как
INPUT, нажатию соответствует уровеньHIGH. - Текущий угол хранится в переменной (например,
int angle = 90;). - За один шаг угол изменяется на
1°, после чего выполняетсяdelay(20). - Программа не позволяет углу выйти за пределы диапазона
0°–180°. - Состояние светодиодов определяется текущим значением угла.
Как составить алгоритм
- Возьмите за основу скетч из предыдущего раздела, в котором сервопривод подключён к пину
D2. - В
setup()настройте пины кнопок и светодиодов, привяжите сервопривод, установите начальный угол90°и погасите светодиоды. - В
loop()считайте текущее состояние обеих кнопок. - Если нажата только левая кнопка (
D28) иangle > 0, уменьшитеangleна1, отправьте новый угол вservo.write(angle)и подождите20 мс. - Иначе, если нажата только правая кнопка (
D15) иangle < 180, увеличьтеangleна1, отправьте угол вservo.write(angle)и подождите20 мс. - Обновите светодиоды: включите
D48, только еслиangle == 0, иD51, только еслиangle == 180.
Поскольку в этой задаче кнопка удерживается пальцем для непрерывного движения, а каждый шаг уже содержит паузу 20 мс, отдельная функция антидребезга здесь не требуется.
Как убедиться, что всё работает правильно
- После загрузки вал встаёт посередине, оба светодиода не горят.
- При удержании
D28вал плавно поворачивается к0°примерно за 1,8 с, после чего останавливается и зажигаетD48. - При начале движения обратно к
180°кнопкойD15светодиодD48сразу гаснет, а в конце хода на180°загораетсяD51. - Одновременное нажатие двух кнопок останавливает движение.
Назад: Управление сервоприводом.
Дальше: Урок 3. Чтение данных, работа с Serial портом.