Управление сервоприводом
В этой части урока мы подключим сервопривод к штатному разъёму D2 на плате TurtleBro. Сначала проверим движение вала между двумя углами по таймеру, а затем будем переключать положение сервопривода между 0° и 90° нажатием кнопки D28 с индикацией на светодиоде D48.
Подключение сервопривода к плате
У стандартного сервопривода трёхпроводной кабель с одной трёхконтактной колодкой. На плате TurtleBro предусмотрен ряд трёхконтактных разъёмов специально для сервоприводов (D2–D7). Макетная плата не нужна — колодка сервопривода надевается прямо на штырьки разъёма D2.
Перед подключением обязательно сверьте маркировку контактов −, +, S на плате с цветами проводов кабеля:
| Маркировка на плате | Назначение контакта | Стандартный цвет провода |
|---|---|---|
− | Общий провод (GND) | Коричневый или чёрный |
+ | Питание сервопривода (5 В) | Красный |
S | Управляющий сигнал | Оранжевый, жёлтый или белый |
Питание мотор сервопривода получает с контакта + своего разъёма. Не соединяйте эту силовую линию 5 В с сигнальными пинами или пинами питания 3,3 В микроконтроллера Arduino Due.
Неправильная ориентация разъёма может вывести из строя сервопривод или плату. Сначала отключите 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 |
Вопросы для самопроверки
- Почему нажатие кнопки на плате TurtleBro даёт уровень
HIGHи почему в этих скетчах не используется режимINPUT_PULLUP? - Какой параметр сигнала ШИМ определяет угол поворота сервопривода и почему в скетче не нужно формировать импульсы вручную?
- Каким цветам проводов сервопривода соответствуют контакты
−,+иSна разъёме платы? - Зачем при проверке кнопки ждать 30 мс после изменения сигнала и почему важно обновлять
lastButtonStateтакже при отпускании кнопки? - Почему силовую линию
5 Вна разъёме сервопривода нельзя соединять с сигнальными пинами платы Arduino Due?
Справочный материал: как устроен сервопривод
Внутри корпуса обычного хоббийного сервопривода находятся электродвигатель постоянного тока, редуктор, датчик угла поворота (потенциометр) и небольшая плата управления. Плата управления непрерывно сравнивает текущий угол вала с длительностью приходящего ШИМ-импульса и вращает мотор до тех пор, пока вал не займёт нужное положение. Если валу физически мешать повернуться, мотор будет пытаться преодолеть препятствие, а потребляемый ток резко вырастет — именно поэтому заблокированный и гудящий привод нужно сразу обесточить.
Назад: Кнопки и очередь светодиодов.
Дальше: Домашнее задание.