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

Управление сервоприводом

В этой части урока мы подключим сервопривод к штатному разъёму D2 на плате TurtleBro. Сначала проверим движение вала между двумя углами по таймеру, а затем будем переключать положение сервопривода между 0° и 90° нажатием кнопки D28 с индикацией на светодиоде D48.

Подключение сервопривода к плате

У стандартного сервопривода трёхпроводной кабель с одной трёхконтактной колодкой. На плате TurtleBro предусмотрен ряд трёхконтактных разъёмов специально для сервоприводов (D2–D7). Макетная плата не нужна — колодка сервопривода надевается прямо на штырьки разъёма D2.

Перед подключением обязательно сверьте маркировку контактов −, +, S на плате с цветами проводов кабеля:

Маркировка на платеНазначение контактаСтандартный цвет провода
−Общий провод (GND)Коричневый или чёрный
+Питание сервопривода (5 В)Красный
SУправляющий сигналОранжевый, жёлтый или белый

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

Сверьте контакты −, + и S до подачи питания

Неправильная ориентация разъёма может вывести из строя сервопривод или плату. Сначала отключите USB-кабель от платы, наденьте колодку сервопривода на разъём D2, проверьте совпадение маркировки −, +, S с цветами проводов и только после этого подключайте USB-кабель.

Не отключайте сервопривод под нагрузкой

Не снимайте и не переставляйте колодку сервопривода, пока плата подключена к питанию. Сначала отсоедините USB-кабель.

Для первой проверки лучше снять с вала сервопривода рычаг (качалку), чтобы он ни во что не упёрся. Если при работе сервопривод упёрся в преграду и начал гудеть, сразу отключите питание платы.

Шаг 1. Проверочное движение без кнопки

Для управления сервоприводом подключим стандартную библиотеку Servo.h директивой #include <Servo.h>. Она сама формирует управляющие сигналы на пине, а в скетче достаточно указать номер пина и нужный угол в градусах.

#include <Servo.h>

const int SERVO_PIN = 2;

Servo servo;

void setup() {
  servo.attach(SERVO_PIN);
}

void loop() {
  servo.write(45);
  delay(1000);
  servo.write(90);
  delay(1000);
}

Нажмите Проверить, затем Загрузить.

Ожидаемый результат

Вал сервопривода поочерёдно поворачивается на угол 45° и 90°, задерживаясь в каждом положении на 1 с. Плата не перезагружается, привод не дёргается и не гудит.

Если при компиляции Arduino IDE сообщает, что файл Servo.h не найден, откройте менеджер библиотек (Инструменты → Менеджер библиотек), введите в поиске Servo и установите стандартную библиотеку Servo от Arduino.

Пока этот простой скетч не заработает, не переходите к следующему шагу. Сначала убедитесь в правильности подключения проводов и номера пина.

Разберём новые команды:

  • Servo servo; — создаёт объект для управления одним сервоприводом;
  • servo.attach(SERVO_PIN); — привязывает объект к разъёму D2;
  • servo.write(45); — даёт команду повернуть вал на угол 45°.

Как сервопривод понимает угол: сигнал ШИМ

По управляющему проводу S передаётся не постоянное напряжение, а периодические прямоугольные импульсы — широтно-импульсная модуляция (ШИМ, PWM).

Импульсы следуют с периодом около 20 мс (50 раз в секунду), а требуемый угол кодируется длительностью (шириной) каждого импульса: более короткий импульс поворачивает вал к 0°, более длинный — к 180° (по умолчанию библиотека Servo использует диапазон импульсов примерно от 544 до 2400 мкс).

В скетче рассчитывать микросекунды вручную не нужно: вы вызываете servo.write(90), а библиотека Servo сама поддерживает нужную последовательность импульсов на пине.

Шаг 2. Переключение между 0° и 90° по нажатию кнопки

Объединим управление сервоприводом с чтением кнопки D28 и защитой от дребезга из предыдущего раздела. Логическая переменная isOpen будет хранить текущее состояние механизма:

  • false — закрыто (0°, светодиод D48 погашен);
  • true — открыто (90°, светодиод D48 горит).
#include <Servo.h>

const int BUTTON_PIN = 28;
const int LED_PIN = 48;
const int SERVO_PIN = 2;

const int DEBOUNCE_DELAY_MS = 30;
const int CLOSED_ANGLE = 0;
const int OPEN_ANGLE = 90;

Servo servo;
bool isOpen = false;
int lastButtonState;

void setup() {
  pinMode(BUTTON_PIN, INPUT);
  pinMode(LED_PIN, OUTPUT);
  digitalWrite(LED_PIN, LOW);

  servo.attach(SERVO_PIN);
  servo.write(CLOSED_ANGLE);

  lastButtonState = digitalRead(BUTTON_PIN);
}

void loop() {
  int reading = digitalRead(BUTTON_PIN);

  if (reading != lastButtonState) {
    delay(DEBOUNCE_DELAY_MS);
    reading = digitalRead(BUTTON_PIN);
  }

  if (reading != lastButtonState) {
    lastButtonState = reading;

    if (lastButtonState == HIGH) {
      if (isOpen) {
        servo.write(CLOSED_ANGLE);
        digitalWrite(LED_PIN, LOW);
        isOpen = false;
      } else {
        servo.write(OPEN_ANGLE);
        digitalWrite(LED_PIN, HIGH);
        isOpen = true;
      }
    }
  }
}

Нажимайте кнопку D28 и давайте валу сервопривода завершить поворот перед следующим нажатием.

Ожидаемый результат

После загрузки вал устанавливается в положение 0°, светодиод D48 погашен. Первое нажатие кнопки D28 поворачивает вал на 90° и зажигает светодиод D48. Следующее нажатие возвращает вал в 0° и гасит светодиод.

В этом примере сервопривод переходит между двумя фиксированными углами сразу на полной скорости. В самостоятельном задании вы сделаете плавный пошаговый поворот в обе стороны с помощью двух кнопок.

Если сервопривод работает не так, как ожидалось

НаблюдениеЧто проверить
Вал не двигаетсяПроверьте подключение к разъёму D2, соответствие проводов маркировке −, +, S и наличие вызова servo.attach(SERVO_PIN) в setup()
Привод дёргается или плата перезагружаетсяСразу отключите USB. Проверьте, что красный провод питания находится на центральном контакте +, а не перепутан с − или S
Кнопка не переключает уголПроверьте номер пина кнопки (28) и условие перехода lastButtonState == HIGH
Сервопривод гудит в крайнем положенииОтключите питание платы и проверьте, не мешает ли повороту механическое препятствие; при необходимости сузьте диапазон углов (например, 10°–170°)
Светодиод не загорается при 90°Проверьте номер пина светодиода (48) и вызов digitalWrite(LED_PIN, HIGH) в ветке else

Вопросы для самопроверки

  1. Почему нажатие кнопки на плате TurtleBro даёт уровень HIGH и почему в этих скетчах не используется режим INPUT_PULLUP?
  2. Какой параметр сигнала ШИМ определяет угол поворота сервопривода и почему в скетче не нужно формировать импульсы вручную?
  3. Каким цветам проводов сервопривода соответствуют контакты −, + и S на разъёме платы?
  4. Зачем при проверке кнопки ждать 30 мс после изменения сигнала и почему важно обновлять lastButtonState также при отпускании кнопки?
  5. Почему силовую линию 5 В на разъёме сервопривода нельзя соединять с сигнальными пинами платы Arduino Due?

Справочный материал: как устроен сервопривод

Внутри корпуса обычного хоббийного сервопривода находятся электродвигатель постоянного тока, редуктор, датчик угла поворота (потенциометр) и небольшая плата управления. Плата управления непрерывно сравнивает текущий угол вала с длительностью приходящего ШИМ-импульса и вращает мотор до тех пор, пока вал не займёт нужное положение. Если валу физически мешать повернуться, мотор будет пытаться преодолеть препятствие, а потребляемый ток резко вырастет — именно поэтому заблокированный и гудящий привод нужно сразу обесточить.

Назад: Кнопки и очередь светодиодов.
Дальше: Домашнее задание.