Keyboard shortcuts

Press ← or → to navigate between chapters

Press S or / to search in the book

Press ? to show this help

Press Esc to hide this help

Урок 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();
}

Как устроено решение

  1. После запуска angle равен 90, поэтому оба условия angle == MIN_ANGLE и angle == MAX_ANGLE ложны, и оба светодиода погашены.
  2. В начале loop() считываются состояния обеих кнопок в логические переменные leftPressed и rightPressed.
  3. Шаг влево выполняется только тогда, когда нажата D28 (leftPressed), не нажата D15 (!rightPressed) и текущий угол больше 0. Шаг вправо — когда нажата только D15 и угол меньше 180. Если нажаты обе кнопки одновременно или обе отпущены, ни одно из условий не срабатывает, и угол остаётся прежним.
  4. Пауза 20 мс стоит внутри ветки шага. Пока кнопка удерживается, каждые 20 мс угол меняется на 1°. Полный поворот от середины (90°) до упора занимает около 1,8 с.
  5. Функция updateLeds() проверяет текущий угол на каждом проходе цикла: как только вал уходит с 0° на 1°, левый светодиод D48 сразу гаснет.

Как проверить решение

  1. При отключённом USB-кабеле проверьте подключение сервопривода к разъёму D2 и совпадение маркировки −, +, S с цветами проводов.
  2. Подключите плату и загрузите скетч. Вал должен встать в среднее положение (90°), оба светодиода погашены.
  3. Удерживайте кнопку D28. Вал плавно повернётся влево и остановится на 0°, после чего загорится светодиод D48.
  4. Отпустите кнопку — вал останется в положении 0°, а D48 продолжит гореть.
  5. Удерживайте кнопку D15. Светодиод D48 погаснет сразу после первого шага. Дойдя до 180°, вал остановится, и загорится светодиод D51.
  6. Попробуйте зажать обе кнопки во время движения — сервопривод должен остановиться.

Ответы на вопросы для самопроверки

  1. Почему нажатие кнопки на плате TurtleBro даёт уровень HIGH и почему в этих скетчах не используется режим INPUT_PULLUP?
    На плате TurtleBro кнопки уже снабжены внешними стягивающими резисторами к земле (GND), а при нажатии подают на пин напряжение питания (HIGH). Внутренняя подтяжка INPUT_PULLUP подтягивает вход к питанию внутри микроконтроллера, что мешало бы работе внешней схемы платы, поэтому используется режим INPUT.

  2. Какой параметр сигнала ШИМ определяет угол поворота сервопривода и почему в скетче не нужно формировать импульсы вручную?
    Угол определяется длительностью (шириной) управляющего импульса, который повторяется примерно каждые 20 мс. Вручную формировать импульсы не нужно, потому что эту работу выполняет библиотека Servo: в скетче достаточно передать желаемый угол в градусах вызовом servo.write().

  3. Каким цветам проводов сервопривода соответствуют контакты −, + и S на разъёме платы?
    Тёмный провод (коричневый или чёрный) подключается к − (GND), красный провод питания — к + (5 В), а светлый сигнальный провод (оранжевый, жёлтый или белый) — к S.

  4. Зачем при проверке кнопки ждать 30 мс после изменения сигнала и почему важно обновлять lastButtonState также при отпускании кнопки?
    За 30 мс механический дребезг контактов заканчивается, и повторное чтение пина подтверждает устойчивое состояние кнопки. Запоминать отпускание (LOW) в lastButtonState необходимо для того, чтобы при следующем нажатии программа снова увидела смену состояния с LOW на HIGH. Если не сохранять LOW при отпускании, в lastButtonState навсегда останется HIGH, и кнопка сработает только один раз.

  5. Почему силовую линию 5 В на разъёме сервопривода нельзя соединять с сигнальными пинами платы Arduino Due?
    Контакт + на разъёме сервопривода выдаёт 5 В для питания электродвигателя привода, тогда как логические входы микроконтроллера Arduino Due рассчитаны максимум на 3,3 В. Подача 5 В на пины Due может вывести микроконтроллер из строя.

Назад: Домашнее задание.
Дальше: Урок 3. Чтение данных, работа с Serial портом.