Принцип построения управления аналоговым сервоприводом от PIC-контроллера.

s3030Подключение аналогового сервопривода выполняется по трем проводам:

  • черный (коричневый) – общий.
  • красный – питание (4,8-6,0 Вольт).
  • белый (желтый) – управление.

Сервопривод позволяет поворачивать вал до 180 градусов. Для управления необходимо на белом проводе сформировать управляющие импульсы длительностью от 1 до 2 миллисекунд с периодом 20 миллисекунд. Длительность импульса управления от 1 до 2 мс – это стандартные параметры и реально могут отличаться для выполнения полного вращения вала (на 180º), но на практике для управления исполнительными механизмами применяется меньшие углы. Период тоже понятие относительное и от может быть как меньше так и больше, все зависит от параметров системы управления и самого выбранного привода.

Удобно для управления использовать CCP модули микроконтроллера. В новых современных моделях (например, PIC16F1936) их количество достигает 6. Это количество модулей достаточно для создания полноценных устройств управления моделями, роботами…

CCP-модуль позволяет создавать независимые ШИМ которые могут с успехом управлять аналоговыми (и цифровыми) приводами.

servo_02aПри настройке CCP модуля в режиме ШИМ нам доступно 10 бит управления длительностью. Для управления длительностью необходимо загружать числовое значение в регистр CCPRxL (8 бит) и младшие биты (0-1) в регистр CCPxCON. В режиме ШИМ CCP модуль работает совместно с таймерами TMP2/4/6. Эти таймеры формируют период ШИМ. Формируемая длительность тесно завязана с тактовой частотой микроконтроллера и для аналогового привода придется задавать более низкую тактовую частоту что не всегда приемлемо для быстродействия системы управления.

 Таймер имеет следующую структуру:

servo_01

На вход поступает тактовая частота деленная на 4, после этого идет предделитель и сам таймер, с регистром периода. Нам необходимо сформировать период с длительностью близко к 20 мс. 20 мс – это частота на 50 Гц. Высчитаем приемлемую тактовую частоту: как это сделать? Необходимо

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

50*256*64*4=3276800

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

servo_02

Проверим при заданной тактовой какая у нас будет длительность периода

Период = 1/(4000000/4/64/256) = 1/60 = 16 мс.

Получаем 60 герц на выходе это где то 16 мс. Для нашего привода S3003 это в приемлемом допуске.

Настройка тактового генератора в программе

Настройка модуля CCP и таймера TMP2 в режиме ШИМ.

Теперь для управления сервоприводом необходимо определиться со значениями загружаемыми в CCP модуль для формирования длительности импульса в пределах 1-2 мс.

Дискретность длительности формируемого ШИМ рассчитать просто. Если период 16 мс, то 16/1024 (10 разрядный ШИМ) получаем 0,016 мс. Для формирования длительности импульса в 1 мс необходимо загрузить число 1/0,016=62, а для формирования длительности 2 мс = 125. Но это все теоретические выкладки (но они конечно тоже будут работать и формировать вращение вала на угол в 90%). Но если необходимо будет подобрать больший угол поворота, то необходим экспериментальный подход. В моем приводе максимальный угол поворота близкий к 180 градусам формируется при подаче длительностей в диапазоне от 0,63 мс до 2,23 мс.

servo_03

servo_04

При этом максимальное и минимально значение записываемое в ШИМ составляет 40 – 140.

Для удобство управления, проще вводить (как мне кажется) данные в процентах. Т.е. привод в крайнем “левом” положении 0%, посредине – 50%, кране “правое” – 100%.

В программе введем константы

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

вычисление коэффициента сделаем при инициализации программы один раз

а для загрузки значения в ШИМ для формирования управляющих импульсов

Для тестирования возьмем плату ILLISSI-B4-03-primum с контроллером PIC16F1936. А для управления и индикации плату ILLISSI-4С-01-secundo.


Подключение сервопривода к плате ИЛЛИССИ-4В

Servo_0014


Фото демопроекта







  • Servo_007

    Servo_007
  • Servo_009

    Servo_009
  • Servo_006

    Servo_006







Видео работы демонстрации работы сервопривода.


Файлы проекта

[box title=”Файлы для загрузки” color=”#521BDE”]Компилятор HI-TECH C Compiler for PIC10/12/16 MCUs (PRO Mode)  V9.83, MPLAB 8.88.

[/box]



Это может быть интересно


  • Проблемы классической светомузыкиПроблемы классической светомузыки
    Светомузыка – что это такое? Определение: Светомузыка  (жаргонное: цветомузыка)  — вид искусства, основанный на способности человека ассоциировать звуковые ощущения со световыми восприятиями. Такое явление в неврологии получило название – синестезии. …
  • Регулятор влажностиРегулятор влажности
    Регулятор ILLISSI-CH-1000 предназначен для контроля и регулировки относительной влажности в диапазоне от 0 до 100%. Регулятор позволяет работать как в режиме осушения, так и увлажнения. Для измерения возможно использовать аналоговые …
  • Проект с использованием MCC часть 10Проект с использованием MCC часть 10
    Алгоритм управления освещением от нажатия кнопки. Обработка удержания кнопки: Мы должны проверить кнопка в настоящий момент нажата и флаг удержания установлен, если да Проверить таймер удержания “отработал” – это значит, …
  • AD9833 – Programmable Waveform GeneratorAD9833 – Programmable Waveform Generator
    Простой генератор звуковых частот на AD9833. Для тестирования БПФ в светомузыке мне нужен был генератор звуковых частот. Я  использовал советский Г3-112, но он себя давно изжил.  Все думал купить чёто такое …
  • LATINO – открытый проект ch-светомузыкиLATINO – открытый проект ch-светомузыки
      Проект построенный на некоторых принципах ch-светомузыка. Проект ознакомительный предназначен, для самостоятельного построения простого и эффективного светосинтезатора. Вывод осуществляется на ВОУ собранной на драйверах HL1606. Для этого была применена светодиодная …
  • MPLAB X IDE – управление проектамиMPLAB X IDE – управление проектами
    Среда  MPLAB X IDE позволяет оперативно работать с несколькими проектами, например, если у вас в работе несколько проектов: Для того чтобы переключиться достаточно выбрать другой проект: Для выбора проекта существует …
  • Мониторинг температурыМониторинг температуры
    Настоящий проект создан как обучающий с применением библиотек ds18b20 и LCDHD44780 и компилятора Microchip MPLAB XC8 C Compiler V1.12. Если необходимо иметь информацию по состоянию температуры в помещении или в здании, с количеством до 6 точек (16), то вы сможете …
  • Trimax – кодирование и декодирование ИК-командTrimax – кодирование и декодирование ИК-команд
    Первое, что надо понять назначение кнопок клавиш пульта, а также, что за кодирование реализовано в ИК- пульте. Для назначения клавиш обратимся к описанию, а для взлома кодирования воспользуемся старым и …
  • Ссылки на интересные источникиСсылки на интересные источники
    Сбор 3D моделей от André L’Hérault конденсаторы, резисторы, индуктивности dropbox IPC-SM-782 Surface Mount Design and Land Pattern Standard Видео уроки по Altium designer Alexey Sabunin https://www.youtube.com/channel/UCG7N5CqXpyK8nQjr1EmMgng Сергей Булавинов https://www.youtube.com/channel/UCISAMXRnN_Qw9UTjUwZI1Jw Robert Feranec https://www.youtube.com/user/matarofe Самый быстрый, …
  • Проект с использованием MCC часть 09Проект с использованием MCC часть 09
      Эта часть будет посвящена созданию практического проекта управления освещение. Тех задание: Два выхода управления ШИМ – светодиодным освещением. Две кнопки управления, каждая кнопка управляет, своим каналом, логика самая простая, нажимаем …



Translate »

Copyright © Catcatcat electronics 2013-2020. Все права защищены.
Копирование разрешается только с указанием активной ссылки на правообладателя.

e-mail: catcatcat.electronics@gmail.com