Управление сервами с МК

Материал из roboforum.ru Wiki
Версия от 11:51, 6 ноября 2008; Hamble (обсуждение | вклад) (Программная генерация ШИМ)
Перейти к: навигация, поиск

Введение

Существует несколько основных методов управления сервами с помощью микроконтроллера:

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

Каждый метод имеет свои особенности, достоинства и недостатки. Рассмотрим их подробнее.

Использование аппаратного генератора ШИМ на МК

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

  • Слишком много сервоприводов, у МК нет столько встроенных ШИМ-генераторов;
  • ШИМ-генераторы уже заняты для управления драйвером двигателей;
  • Заняты таймеры на базе которых работают встроенные ШИМ-генераторы;

Программная генерация ШИМ

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

Вот пример управления: 8 сервоприводов, команды поступают с ПК по rs232 - контроллер ATmega16.

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

Без использования таймера

Самый простой и наименее приемлимый вариант - сделать основной цикл программы с частотой 50Гц и где-то в этом цикле выдавать в нужный порт 1, потом ждать от 1 до 2мс и после выдавать в этот порт 0.

Достоинства : никаких.

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

С использованием таймера, вариант 1

Наиболее удобным представляется использование таймера для генерации программного ШИМ. Для этого надо повесить прерывание на переполнение счетчика, установить частоту его срабатывания равной частоте дискретизации ШИМ-сигнала (то есть если нам надо 100 возможных положения сервопривода, тогда мы должны попадать в прерывание каждые 1/100мс=10мкс, то есть при частоте 16МГц это каждые 160 тактов). Внутри прерывания обеспечиваем счетчик, который обнуляем каждые 20мс, то есть 20'000*16=320'000 тактов. А теперь в каждые 320 тактов внутри прерывания мы можем управлять 2-3 сервоприводами, вначале мы устанавливаем выходы всех сервоприводов в 1, затем ждем 1мс (160 тактов), затем ждем нужное количество тактов в зависимости от требуемого положения, затем выставляем в порт 0.

Достоинства : возможность управлять большим количеством приводов с использование всего одного таймера.

Недостатки : высокая загрузка процессора, ограниченное разрешение

С использованием таймера, вариант 2

Еще одна схема с использованием таймера основывается на подготовленной заранее таблице из 256 значений порта, которые соответствуют тому, что должно выдаваться на сервопривод. В этом случае вешаем таймер на частоту вызова 1/256мс (16000/256=62.5такта), так же ставим счетчик обнуляемый каждые 20мс и как только он выставился в 0 выдаём в нужный порт 0xFF, ждем 1мс (256 тактов), а потом начинаем выдавать в порт 256 значений, которые мы заранее подготовили.

Достоинства : возможность управлять большим количеством приводов с использование всего одного таймера (при использовании нескольких портов и таблице большего размера).

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

С использованием таймера, вариант 3

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

В контроллерах ATMega удобно использовать 16-битный таймер-счетчик (Timer/counter1) и прерывание по совпадению таймера с регистром OCR1A. Таймер работает в режиме простого счетчика от 0 до 0xFFFF. Обработчик прерывания обновляет регистр OCR1A таким образом, чтобы следуещее совпадение произошло через время, равное ширине импульса:

OCR1A += servo_position[i];

В отличие от предыдущих методов, за одно прерывание обрабатывается только одна серва, из чего вытекает ограничение на максимальное число приводов - до 8 на 1 обработчик прерываний (исходим из того, что максимальная длительность импульса составляет [с запасом] 2500мкс, а период 20мс, 20000/2500 = 8). Если задействовать также регистр OCR1B (а также соответствующие прерывание и вывод контроллера), то получим 16 приводов на 1 таймере.

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

Достоинства : высокое разрешение, низкая частота прерываний (а следовательно, меньшая загрузка процессора и менее жесткие требования к обработчику прерываний)

Недостатки : сравнительно небольшое число приводов на 1 таймер.

С использованием таймера и внешних компонент

В этом методе используется таймер, способный периодически изменять состояние вывода микроконтроллера (как, например, таймеры контроллеров серии ATMega компании Atmel). К этому выводу подключается тактовый вход сдвигового регистра (например, 4015) или счетчика с декодером (например, 4017). При этом, сигналы и временные интервалы генерируются аппаратно, а работа программы заключается в установки времени следующего срабатывания таймера. Импульсы появляются на выходах регистра(счетчика) последовательно. В этом методе, как и в предыдущем, период прерываний от таймера не фиксирован, а определяется длиной импульса для сервы, обрабатываемой в текущий момент.

В контроллерах ATMega удобно использовать 16-битный таймер-счетчик (Timer/counter1) и прерывание по совпадению таймера с регистром OCR1A. Таймер работает в режиме простого счетчика от 0 до 0xFFFF. Вывод OC1A настраивается на переключение при совпадении регистра сравнения. При совпадении, вывод переключается, логическая 1 переходит на следующий выход сдвигового регистра, и возникает прерывание. Обработчик прерывания обновляет регистр OCR1A таким образом, чтобы следуещее совпадение произошло через время, равное ширине импульса:

OCR1A += servo_position[i];

Ограничение на количество серв аналогично предыдущему методу.

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

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

Недостатки : необходимость использования внешних компонент, сравнительно небольшое число приводов на 1 таймер.

Краткое описание счетчика 4017

Примеры кода

ServoExamples.zip

Архив содержит примеры кода и схему подключения 4017