Урок 2. Решение задания
На этой странице разобрано задание с плавным поворотом сервопривода. Сервопривод подключён к разъёму D2. Кнопка D28 поворачивает вал влево (к 0°), кнопка D15 — вправо (к 180°). В крайнем левом положении (0°) загорается светодиод D48, в крайнем правом (180°) — светодиод D51.
Полный код скетча
#include <Servo.h>
const int LEFT_BUTTON_PIN = 28;
const int RIGHT_BUTTON_PIN = 15;
const int SERVO_PIN = 2;
const int LEFT_LED_PIN = 48;
const int RIGHT_LED_PIN = 51;
const int STEP_DELAY_MS = 20;
const int CENTER_ANGLE = 90;
const int MIN_ANGLE = 0;
const int MAX_ANGLE = 180;
Servo servo;
int angle = CENTER_ANGLE;
// Включает светодиоды только в крайних положениях вала (0° и 180°).
void updateLeds() {
if (angle == MIN_ANGLE) {
digitalWrite(LEFT_LED_PIN, HIGH);
} else {
digitalWrite(LEFT_LED_PIN, LOW);
}
if (angle == MAX_ANGLE) {
digitalWrite(RIGHT_LED_PIN, HIGH);
} else {
digitalWrite(RIGHT_LED_PIN, LOW);
}
}
void setup() {
pinMode(LEFT_BUTTON_PIN, INPUT);
pinMode(RIGHT_BUTTON_PIN, INPUT);
pinMode(LEFT_LED_PIN, OUTPUT);
pinMode(RIGHT_LED_PIN, OUTPUT);
servo.attach(SERVO_PIN);
servo.write(angle);
updateLeds();
}
void loop() {
bool leftPressed = digitalRead(LEFT_BUTTON_PIN) == HIGH;
bool rightPressed = digitalRead(RIGHT_BUTTON_PIN) == HIGH;
if (leftPressed && !rightPressed && angle > MIN_ANGLE) {
angle = angle - 1;
servo.write(angle);
delay(STEP_DELAY_MS);
} else if (rightPressed && !leftPressed && angle < MAX_ANGLE) {
angle = angle + 1;
servo.write(angle);
delay(STEP_DELAY_MS);
}
updateLeds();
}
Как устроено решение
- После запуска
angleравен90, поэтому оба условияangle == MIN_ANGLEиangle == MAX_ANGLEложны, и оба светодиода погашены. - В начале
loop()считываются состояния обеих кнопок в логические переменныеleftPressedиrightPressed. - Шаг влево выполняется только тогда, когда нажата
D28(leftPressed), не нажатаD15(!rightPressed) и текущий угол больше0. Шаг вправо — когда нажата толькоD15и угол меньше180. Если нажаты обе кнопки одновременно или обе отпущены, ни одно из условий не срабатывает, и угол остаётся прежним. - Пауза
20 мсстоит внутри ветки шага. Пока кнопка удерживается, каждые20 мсугол меняется на1°. Полный поворот от середины (90°) до упора занимает около1,8 с. - Функция
updateLeds()проверяет текущий угол на каждом проходе цикла: как только вал уходит с0°на1°, левый светодиодD48сразу гаснет.
Как проверить решение
- При отключённом USB-кабеле проверьте подключение сервопривода к разъёму
D2и совпадение маркировки−,+,Sс цветами проводов. - Подключите плату и загрузите скетч. Вал должен встать в среднее положение (
90°), оба светодиода погашены. - Удерживайте кнопку
D28. Вал плавно повернётся влево и остановится на0°, после чего загорится светодиодD48. - Отпустите кнопку — вал останется в положении
0°, аD48продолжит гореть. - Удерживайте кнопку
D15. СветодиодD48погаснет сразу после первого шага. Дойдя до180°, вал остановится, и загорится светодиодD51. - Попробуйте зажать обе кнопки во время движения — сервопривод должен остановиться.
Ответы на вопросы для самопроверки
-
Почему нажатие кнопки на плате TurtleBro даёт уровень
HIGHи почему в этих скетчах не используется режимINPUT_PULLUP?
На плате TurtleBro кнопки уже снабжены внешними стягивающими резисторами к земле (GND), а при нажатии подают на пин напряжение питания (HIGH). Внутренняя подтяжкаINPUT_PULLUPподтягивает вход к питанию внутри микроконтроллера, что мешало бы работе внешней схемы платы, поэтому используется режимINPUT. -
Какой параметр сигнала ШИМ определяет угол поворота сервопривода и почему в скетче не нужно формировать импульсы вручную?
Угол определяется длительностью (шириной) управляющего импульса, который повторяется примерно каждые20 мс. Вручную формировать импульсы не нужно, потому что эту работу выполняет библиотекаServo: в скетче достаточно передать желаемый угол в градусах вызовомservo.write(). -
Каким цветам проводов сервопривода соответствуют контакты
−,+иSна разъёме платы?
Тёмный провод (коричневый или чёрный) подключается к−(GND), красный провод питания — к+(5 В), а светлый сигнальный провод (оранжевый, жёлтый или белый) — кS. -
Зачем при проверке кнопки ждать 30 мс после изменения сигнала и почему важно обновлять
lastButtonStateтакже при отпускании кнопки?
За30 мсмеханический дребезг контактов заканчивается, и повторное чтение пина подтверждает устойчивое состояние кнопки. Запоминать отпускание (LOW) вlastButtonStateнеобходимо для того, чтобы при следующем нажатии программа снова увидела смену состояния сLOWнаHIGH. Если не сохранятьLOWпри отпускании, вlastButtonStateнавсегда останетсяHIGH, и кнопка сработает только один раз. -
Почему силовую линию
5 Вна разъёме сервопривода нельзя соединять с сигнальными пинами платы Arduino Due?
Контакт+на разъёме сервопривода выдаёт5 Вдля питания электродвигателя привода, тогда как логические входы микроконтроллера Arduino Due рассчитаны максимум на3,3 В. Подача5 Вна пины Due может вывести микроконтроллер из строя.
Назад: Домашнее задание.
Дальше: Урок 3. Чтение данных, работа с Serial портом.