Управление сервоприводом. Управление сервоприводом (сервомашинкой) с помощью микроконтроллера ATMega

Новости 24.08.2019
Новости

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

В статье рассмотрим подключение и работу с младшими представителями сервоприводов - т.н. сервомашинками - горячо любимыми среди роботостроителей и моделистов.

Конструктив

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

В качестве обратной связи применяются потенциометры. Поэтому эти сервы имеют ограничения по углу поворота вала вокруг оси. Так, в приобретенных мной сервах Futaba S3003, угол поворота выходного вала составляет 225°.

Технические характеристики Futaba S3003

Параметр Напряжение питания, В
4,8 6,0
Усилие на валу 3,2 кг/см 4,1 кг/см
Скорость позиционирования 0,23 sec/60° 0,19 sec/60°
Размер, Д х Ш х В 41мм х 20мм х 36мм
Масса, г 37

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

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


Управление

В качестве управляющего сигнала служит импульсный сигнал с периодом 20 мс и с длительностью от 0,8 до 2,2 мс. Это некий стандарт управления сервомашинок. Чем длинее пришел импульс, тем на больший угол повернется вал сервомашинки. Для разгона сервомашинки период следования импульсов можно уменьшить до 10 мс.


Управляющий сигнал подается на серву по сигнальному проводу S. В моей сервомашинке он белый, в некоторых моделях - желтый. Помимо сигнального провода из сервомашинки выходят два провода - линии питания - земля (черный) и питание (красный)


Программная часть

Как видно управлять сервой достаточно просто - достаточно гнать импульсный сигнал с нужной частотой и скважностью. Этот сигнал можно генериовать ШИМ , или написать свою функцию обработки прерывания по таймеру. Но в Bascom-AVR уже есть встроенная команда для управления сервомашинками - Servo . Ее и рассмотрим.

Для начала необходимо сконфигурировать подключение сервомашинок:

Config Servos = X , Servo1 = Portb . 0 , Servo2 = Portb . 1 , Reload = Var

Servos = X ; указывается количество подключаемых сервомашинок, возможно подключение до 14 серв.

Servo1 = Portb . 0 ; указывается порт подключения первой сервы

Servo2 = Portb . 1 ; указывается порт подключения второй сервы

Reload = Var ; здесь Var время в микросекундах, которое проходит между прерываниями от таймера.

По умолчанию для организации прерываний используется Timer0, поэтому использовать его в своих целях уже не получиться. Bascom-AVR позволяет перебросить обслуживание прерываний на любой другой таймер, например чтобы освободить Timer0 и задествовать Timer1 достаточно указать это в строке конфигурации:

Config Servos = 2 , Servo1 = Portb . 0 , Servo2 = Portb . 1 , Reload = 10 , Timer = Timer1


После того как все сконфигурировали остается только рулить нашей сервомашинкой. Это делается следующей командой

Servo ( a) = F

а - порядковый номер сервомашинки

F - переменная, значение которой задает угол поворота вала сервы

Тестовый код целиком:


$regfile = "m8def.dat" "микроконтроллер ATmega8
$crystal = 8000000 "частота работы 8МГц

"конфигурируем порты для подключения сервоприводов
Config Portb . 0 = Output
Config Portb . 1 = Output

"настраиваем подключения двух сервомашинок
Config Servos = 2 , Servo1 = Portb . 0 , Servo2 = Portb . 1 , Reload = 15

Dim F As Byte "переменная для первой сервы
Dim S As Byte "переменная для второй сервы

"разрешаем прерывания
Enable Interrupts

F = 15 "значением переменной задается угол поворота вала сервомашинки
S = 70

Do

Servo (1 ) = F
Servo (2 ) = S

Loop

End


Схему подключения не привожу, думаю один сигнальный провод проблем не вызовет;) Его можно подключать к порту микроконтроллера напрямую, а можно через резистор сопротивлением пару сотен ом - для перестраховки.

Меняя значения перемменных F и S можем менять угол поворота первой и второй сервомашинок соответственно. Чем меньше значение параметра Reload, тем шустрее наши сервомашинки будут поворачиваться на нужный угол.

Для своих серв подобрал рабочий диапаз он значений Servo(a), в которых вал может вращаться. Крайнее положения вал занимает при значении 0 и 150, соответственно при значении 75 вал занимает промежуточное положение.


Servo(a) =0 Servo(a) =75 Servo(a) =150

Попался под руку популярный недорогой сервопривод SG90. И задумалось управлять им, но без микроконтроллера. В этой статье я изложу ход мыслей разработчика при реализации одного из вариантов решения.

Кому интересно, прошу под кат.

Идея

Надо управлять сервоприводом, но без микроконтроллера.

Знания

Всем известно, что опыт и знания помогают творить и находить решения. На страницах Гиктаймса немало примеров использования сервопривода с применением контроллеров. В них подробно рассказано про систему управления сервоприводом. Примем этот опыт других разработчиков за знания необходимые нам для решения задачи. Сервопривод SG90 управляется ШИМ сигналом, параметры которого определяют положение ротора. Период ШИМ около 20 мС, длительность сигнала управления от 500 до 2100 мкС.

Задача

Идея и знания порождают задачу, которую необходимо решить. Сформулируем задачу для воплощения идеи. Это что-то вроде Технического Задания. Кажется, все просто, надо взять генератор импульсов с изменяемой скважностью, подключить питание к сервоприводу, а с генератора подать управляющий сигнал. Особо отметим, что в требованиях есть изменения скважности - то есть должны быть органы управления или пользовательский интерфейс.

Реализация

Вот тут и начинаются муки творчества: что взять и где взять? Можно найти готовый лабораторный импульсный генератор, например Г5-54 с ручками, кнопками, выставить нужные параметры, подключить генератор к сервоприводу. Однако это громоздко и не все могут позволить себе такую роскошь. Поэтому разработчики, опираясь на свой опыт и знания, пытаются совместить желание (идею-задачу) и возможности (материальные и творческие) для реализации задачи. Материальные возможности - это та “жаба” “А сколько и чего я хочу потратить на реализацию идеи?” Творческие возможности - это, “посмотрю-ка я, что у меня уже есть”. Это не обязательно какие-то материальные ценности, а опыт и знания предыдущих разработок, которые можно приспособить под реализацию. Также не лишним будет поискать (погуглить), что кто-то уже реализовывал что-то подобное. Для сокращения вариантов решения необходимо самому добавлять дополнительные требования, ограничивающие фантазии реализации. Например, добавим к требованиям еще одно условие, пусть это будет материальное ограничение, реализация должна быть недорогой .

Поиск альтернатив

Воспользовавшись интернетом, поищем варианты, которые предлагает СЕТЬ. Зададим в поиске: “генератор прямоугольных импульсов с переменной скважностью”. Получим очень много вариантов, как с применением интегральных таймеров NE555 (отечественный аналог КР1006ВИ1), так и на логических микросхемах. Из всего разнообразия я выбрал вариант генератора на инверторе с триггером Шмитта на входе. Во-первых, он самый простой, во-вторых, требует минимум деталей и самое интересное использует единственный логический элемент из шести, если, например, использовать микросхему 74HC14.

Схема такого генератора выглядит так:

Немного теории

Теория гласит, что частота такого генератора равна f = 1/T = 1/(0.8*R*C). Для получения требуемой частоты требуется выбрать номинал одного из элементов, задающих частоту. Так как логический элемент выполнен по технологии КМОП, то имеет большое входное сопротивление, поэтому можно применять элементы задающие небольшие рабочие токи. Выберем емкость С1 из ряда распространенных номиналов, например 0.47 мкФ. Тогда для получения требуемой частоты (50Гц) резистор должен быть приблизительно 53 кОм, но такого резистора в стандартном ряду нет, поэтому выберем 51 кОм.


На выходе такого генератора формируется сигнал близкий к меандру, поэтому нам необходимо скорректировать схему таким образом, чтобы она удовлетворяла требованиям задания. Для получения регулируемой длительности импульса на выходе необходимо изменить режим перезарядки конденсатора от высокого уровня на выходе, а именно, сократить время перезарядки. Для этого добавим в схему еще два элемента: диод и переменный резистор. Подойдет любой маломощный импульсный диод.

Тогда схема примет следующий вид:


Казалось бы: все, задача решена, но в крайних положениях переменного резистора поведение сервопривода нестабильно. Это связано с тем, что значение длительности импульсов, в крайних положениях переменного резистора, не соответствует требуемым. Лично мне также не по душе применение переменного резистора, поэтому я хочу изменить интерфейс управления, добавив новую “хотелку” в техническое задание, например чтобы скважность менялась в зависимости от освещенности. Для этого есть простое и недорогое решение: применить в качестве регулирующего элемента фоторезистор GL55xx (используют в проектах Arduino), изменение сопротивления которого лежит в широком диапазоне.

Далее начинается самое интересное. Расчетных формул для получения значений сопротивлений обеспечивающих требуемые длительности импульсов нет, поэтому на уровне интуиции (опытным путем, с помощью переменного резистора) определяем значения сопротивления, при которых устанавливаются требуемые значения длительностей импульсов. Затем изменяем схему так, чтобы при изменении сопротивления фоторезистора общее сопротивление изменялось, устанавливая требуемые значения длительностей импульсов.

Итоговая схема принимает следующий вид:

Пояснения к итоговой схеме

Конденсатор С1 номиналом 0.47 мкФ, определяет время перезаряда. Резистор R1 номиналом 51 кОм задает основную частоту повторения импульсов в районе 50 Гц. Комбинация резисторов R2-R4 в сумме будет изменяться в диапазоне от 2.5 кОм до 24 кОм в зависимости от освещенности. Вместе с диодом D1 эти резисторы будут влиять на время перезаряда конденсатора С1 при действии положительного импульса на выходе логического элемента, тем самым определять его длительность.

Результат

Подключив данный генератор к входу управления сервопривода получим возможность управлять им, изменяя освещенность фоторезистора. На видео можно посмотреть, что из этого получилось:

Для самых начинающих. Проверенный код в статье. Подключим, повернем, разберемся с питанием.
В руки прибыл сервопривод SD90 с диагнозом неправильной работы и практически с полным отказом (По словам). Надо разобраться.
Общая информация нужна, информация важна
SD-90 - практически самый дешевый сервопривод на рынке электроники.
Вес всего 15 грамм, а крутящий момент 2кг/см. Работает данный сервопривод SD90 в температурах от -30 до +60 градусов.
Рабочее напряжение от 4В до 8В.
Потребление в движении 70 мА, а в удержании 15 мА.
Угол поворота составляет всего 180 градусов.
Сервопривод SD90 идеально подходит для установки на авиамодели.

Для управления сервоприводами с помощью Ардуин есть стандартная библиотека в IDE Arduino Servo.h , которая включает в себя функции для установки настроек сервопривода, необходимого угла, считывания состояния. Некоторые методы являются перегруженными.

Обращаемся к китайским друзьям за мануалами и судя по рисунку ниже подключение сервопривода SG90 не составляет труда.

Два провода отвечают за питание и один провод для управления. Ниже приведен код программы для ардуино который даст некоторые пояснения.

    * Специально для сайта сайт

    * Сервопривод SG90 + Arduino. Подключение

    //Библиотека для работы с сервоприводом

    #include ‹Servo.h›

    //Обьявление переменной - объекта

    Servo servo;

  1. void setup()

    //К пину №7 подключен управляющий вывод сервопривода

    //Данный метод библиотеки указывает пин через который происходит управление

    servo.attach (7 ) ;

    //servo.detach(7); - этот метод отключит управление от указанного пина.

  2. void loop()

    //Установка вала в 0 градусов

    servo.write (0 ) ;

    delay(2000 ) ; //ждем 2 секунды. Необходимо как минимум 30 микросекунд для установки.

  3. servo.write (90 ) ; //ставим вал под 90 градусов

  4. // В библиотеке есть функция для чтения текущего положения (угла) сервопривода.

    // Будет считано последнее установленное значение в сервоприводе.

    // int AngleServo=servo.read();

    // От 0 до 180 градусов.

  5. servo.write (180 ) ; //ставим вал под 190 градусов

    delay(2000 ) ; //ждем 2 секунды.

  6. //Медленно возвращаемся обратно с интервалом в 1 градус

    for (int p= 179 ; p>= 1 ; p-- )

    servo.write (p) ;

    delay(20 ) ;

    //Угол (Установить) можно задать во времени от нуля.

    //Так как у сервопривода есть характеристика скорости поворота 0.12 сек/60 град

    1 - Коннектор для подключения
    2 - Схема управления сервоприводом, обработки сигналов
    3 - Потенциометр
    4 - Двигатель
    5 - Вал

    Так вот, в самом начале я говорил что в руки попал почти не рабочий сервопривод (По словам). После разбирательств стало понятно что Ардуина имела питание от USB компьютера, а сам сервопривод от Arduino.
    Если углубится в подробности то в экспериментах с было установлено то что китайская версия MEGA не вытягивает нагрузку 150 мА. Сервопривод SG90 в момент движения вала создает нагрузку 75-90 мА в зависимости от нагрузки вала. В итоге при старте Ардуины у человека который попросил разобраться в данной проблеме происходил сброс самой ардуины от повышенной нагрузки и соответственно сервопривод не подавал никаких признаков.

    Решение проблемы самое простое. Необходимо усилить питание для ардуины с помощью внешнего источника (блока питания) или отдельно для сервопривода SG90.
    Но ситуация была такова что в месте установки сервопривода не было возможности применить внешний источник питания. Решение нашлось ниже на рисунке.

    В итоге что бы предотвратить нагрузку на Arduino необходимо между питанием и землей установить поддерживающий конденсатор емкостью 1000мФ 10V. И керамический конденсатор любой емкости для предотвращения дребезга от сервопривода (при нагрузке) на Ардуину. Это решение нельзя использовать для постоянного использования, но в экстренных случаях этот вариант вполне подойдет.

    Обратите внимание что данный вариант подойдет для сервоприводов типа "микро". Для больших сервоприводов данный метод для питания все равно даст просадку напряжения, это будет заметно по LED индикаторам ардуины, но все же предотвратит полный сброс.

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

Совместное применение серводвигателей с радиомодулями примема-передачи не создает никаких трудностей, достаточно на стороне приемника просто подключить к серводвигателю соответствующий разъем, содержащий питающее напряжение и управляющий сигнал, и дело сделано.

Но если мы хотим управлять серводвигателем «вручную», например, с помощью потенциометра, нам необходим генератор импульсного управления. Ниже представлена достаточно простая схема генератора на основе интегральной микросхемы 74HC00.

Данная схема позволяет осуществлять ручное управление серводвигателями путем подачи управляющих импульсов шириной 0,6 до 2 мс. Схему можно применить, например, для поворота небольших антенн, наружных прожекторов, камер видеонаблюдения и т.д.

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

Основой схемы является микросхема 74HC00 (IC1) представляющая собой 4 логических элемента И-НЕ. На элементах IC1A и IC1B создан генератор, на выходе которого образуются импульсы с частотой 50 Гц. Эти импульсы активируют RS-триггер, состоящий из логических элементов IC1C и IC1D.

С каждым импульсом идущим с генератора выход IC1D устанавливается в «0» и конденсатор С2 разряжается через резистор R2 и потенциометр P1. Если напряжение на конденсаторе С2 снижается до определенного уровня, то RC-цепь переводит элемент в противоположное состояние. Таким образом, мы на выходе получаем прямоугольные импульсы с периодом 20 мс. Ширина импульсов устанавливается потенциометром P1.

Например, сервопривод Futaba S3003 изменяет угол вращения вала на 90 градусов за счет управляющих импульсов продолжительностью от 1 до 2 мс. Если мы изменим ширину импульса от 0,6 до 2 мс, то угол поворота составит до 120 °. Компоненты в схеме подобраны таким образом, что выходной импульс находится в диапазоне от 0,6 до 2 мс, и поэтому угол установки составляет 120 °. Серводвигатель S3003 от Futaby имеет достаточно большой крутящий момент, и ток потребления может составлять от десятков до сотен мА в зависимости от механической нагрузки.

Конструкция

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

Сервоприводом (англ. servo) называется такой привод, точное управление которым осуществляется через отрицательную обратную связь, и позволяет таким образом добиться требуемых параметров движения рабочего органа.

Механизмы этого типа имеют датчик, отслеживающий конкретный параметр, например скорость, положение или усилие, а также блок управления (механические тяги или электронную схему), задача которого - поддерживать в автоматическом режиме необходимый параметр в процессе работы устройства, в зависимости от сигнала с датчика в каждый момент времени.

Исходное значение рабочего параметра задается посредством управления, например или при помощи другой внешней системы, куда вводится численное значение. Так, сервопривод автоматически исполняет поставленную задачу, - опираясь на сигнал с датчика, он точно подстраивает заданный параметр, и поддерживает его устойчиво на исполнительном органе.

Многие усилители и регуляторы с отрицательной обратной связью могут быть отнесены к сервоприводам. Например, к сервоприводам относятся тормозная система и рулевое управление в автомобилях, где усилитель ручного привода обязательно имеет отрицательную обратную связь по положению.

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

    Привод;

    Датчик;

    Блок управления;

    Конвертер.

В качестве привода может использоваться например пневмоцилиндр со штоком или электродвигатель с редуктором. Датчиком обратной связи может быть или, например, . Блок управления - индивидуальный инвертор, преобразователь частоты, сервоусилитель (англ. Servodrive). В блок управления может сразу входить и датчик управляющего сигнала (конвертер, вход, датчик воздействия).


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

Если требуется плавный разгон или плавное торможение, с целью избежать динамических перегрузок электродвигателя, то реализуют более сложные схемы управления на микропроцессорах, способные позиционировать рабочий орган более точно. Так к примеру устроен привод позиционирования головок в жестких дисках.

Точное управление группами или одиночными сервоприводами достигается применением контроллеров ЧПУ, которые, кстати, могут быть построены на программируемых логических контроллерах. Сервоприводы на основе таких контроллеров достигают по мощности 15 кВт, и могут развивать крутящий момент до 50 Нм.

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

Синхронные сервоприводы способны весьма быстро разгоняться до номинальных оборотов. Также распространены круглые и плоские сервоприводы линейного движения, позволяющие достигать ускорений вплоть до 70 м/с².

Принципиально сервоприводы подразделяются на электрогидромеханические и электромеханические. У первых движение порождается системой поршень-цилиндр, и быстродействие получается очень высоким. Вторые используют просто электромотор с редуктором, однако быстродействие получается ниже на порядок.

Область применения сервоприводов сегодня весьма широка, благодаря возможности исключительно точного позиционирования рабочего органа.

Здесь и механические задвижки, и клапаны, и рабочие органы различных инструментов и станков, особенно с ЧПУ, включая автоматы для заводского изготовления печатных плат, и различные промышленные роботы, и многие другие точные приборы. Очень популярны высокоскоростные сервоприводы в среде авиамоделистов. Конкретно у сервомоторов примечательна характерная равномерность движения и эффективность в плане энергопотребления.

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

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

В последние годы весьма популярными становятся сервомоторы , благодаря чему открываются широкие возможности как для любительского авиа и роботостроения (квадрокоптеры и т.д.), так и для создания точных станков.

В большинстве своем обычные сервоприводы для работы использует три провода. Один из них для питания, второй сигнальный, третий - общий. На сигнальный провод подается управляющий сигнал, согласно которому требуется установить положение выходного вала. Положение вала определяется схемой с потенциометром.

Контроллер по сопротивлению и значению сигнала управления определяет, в каком направлении нужно осуществить вращение, чтобы вал пришел в требуемое положение. Выше напряжение снимаемое с потенциометра - больше крутящий момент.

Благодаря высокой энергоэффективности, возможности точного управления, и отличным рабочим характеристикам, именно сервоприводы на базе бесколлекторных моторов все чаще можно встретить как в игрушках, так и в бытовой технике (сверхмощные пылесосы с фильтрами HEPA) и в промышленном оборудовании.



Рекомендуем почитать

Наверх