Оценка положения и скорости электропривода средствами МК презентация

Оценка положения
и скорости электропривода средствами МК

Датчики положения и скорости на элементах Холла.
Применение модуля захвата eCAP.

Измерение скорости вращения различных машин, например, с помощью датчиков на основе элементов Холла;
Измерение времени между импульсами с датчика положения с последующим программным расчетом скорости;
Измерение периода и скважности сигнала в виде последовательности импульсов, расчет частоты;
Декодирование амплитуды тока или напряжения, полученной с датчика тока/напряжения с выходным частотным сигналом, скважность которого пропорциональна измеренному значению.
Основные области применения расширенного модуля захвата eCAP

Установка элементов Холла

Сигнал с 3-х датчиков

Сигнал и его обработка с 3-х датчиков

Сигнал и его обработка с 3-х датчиков

Сигнал и его обработка с 3-х датчиков

РАСЧЕТ СКОРОСТИ

РАСЧЕТ СКОРОСТИ

32-битовый модуль базового времени
32-разрядный регистр «временного штампа» внешних событий – времени захвата;
Предварительный делитель частоты входного сигнала захвата;
Селектор полярности перепада входного сигнала для захвата последовательности входных событий
Генерация прерывания;
Одно-тактный режим захвата до 4-х внешних событий (захват макрособытия из 4-х событий);
Непрерывный режим захвата с размещением «временных штампов» событий в кольцевом буфере глубиной 4 слова;
Режим захвата абсолютного времени;
Режим захвата относительного времени – режим захвата приращения (Delta mode);
Возможности расширенного модуля захвата

Блок схема eCAP

Блок схема eCAP

Возможности расширенного модуля захвата

Предварительный делитель событий (Event Prescaler)
Входной сигнал, подлежащий захвату, и представляющий собой последовательность импульсов может быть пропущен через предварительный делитель частоты с коэффициентом деления N= 2-62 (с умножением на 2). Можно обойти предварительный делитель частоты (by-pass). При этом будут обрабатываться все исходные события.
Режим предварительного деления применяется при очень большой частоте входных сигналов.
Возможности расширенного модуля захвата

Селектор полярности перепада и квалификатор событий
Используются четыре независящих друг от друга селектора полярности перепада входного сигнала, по одному для каждого события захвата.
Каждый перепад (вплоть до 4-го) представляет собой событие, которое квалифицируется задатчиком последовательности событий (упорядочивателем событий)
Событие по заданному перепаду стробирует загрузку «временного штампа» в собственный регистр «времени захвата события» в соответствии с текущим номером события, хранящимся в счетчике событий. Регистры «времени событий» CAPx загружаются по заднему фронту.
Возможности расширенного модуля захвата

Возможности расширенного модуля захвата

Режим одно-кратного и непрерывного захвата событий
Счетчик событий является 2-битовым и инкрементируется по перепаду каждого детектированного входного события.
Счетчик событий считает непрерывно и продолжает считать без остановки после переполнения (0->1->2->3->0). При этом реализуется режим непрерывного захвата последних четырех событий.
Для выполнения однократной операции захвата используется 2-битовый регистр останова (stop register). Текущее содержимое считчика числа захваченных событий сравнивается с содержимым стопового регистра и при совпадении (захвате нужного числа событий) перезагрузка регистров времени захвата CAP1-CAP4 блокируется до момента считывания содержимого этих регистров центральным процессором и инициирования нового цикла захвата.
Возможности расширенного модуля захвата

32-разрядный счетчик и управление фазой
Этот счетчик обеспечивает временную базу для модуля захвата событий и тактируется системной тактовой частотой процессора.
Опционально 32-разрядный счетчик временной базы может сбрасываться по любому из четырех захваченных событий. Эта опция используется в режиме захвата относительного времени (time defference – приращения времени). Вначале выполняется захват времени события (текущего состояния 32-разрядного счетчика временной базы), а затем обнуление счетчика.
Возможности расширенного модуля захвата

Регистры «временных штампов» CAP1-CAP4
32-разрядные регистры «временных штампов» захваченных внешних событий CAP1-CAP4 подключены к 32-разрядной шине текущего состояния счетчика временной базы.
Загрузка регистров времени захвата может быть заблокирована путем очистки бита разрешения загрузки.
При выполнении операций однократного захвата (one-shot) этот бит автоматически очищается, когда выполняется условие стопорения модуля захвата, т.е. тогда, когда заданное число внешних событий захвачено.
Возможности расширенного модуля захвата

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

Квадратурные (оптические) датчики положения и скорости.
Применение модуля обработки квадратурного сигнала eQEP.

Сигналы с датчика

Сигналы с датчика

Сигналы с датчика

Квадратурные энкодеры различных производителей могут иметь разную форму (реперного) индексного сигнала, как показано на рисунке. Индексный импульс может быть «ведомым» одним или обоими квадратурными сигналами или «неведомым» (как бы автономным). Последний вариант не стандартизуется.
Индексный (реперный) сигнал

Функциональная схема eQEP

Детектирование направления движения

Режим «квадратурного» счета

Другие режимы счёта
Режим «направленного» счета
Этот режим используется тогда, когда сам датчик положения содержит в себе электронику для выделения счетных импульсов и сигнала направления движения, т.е. собственно «квадратурный» декодер. При этом вход QEPA используется для ввода внешних счетных импульсов (XCLK), а вход QEPB – для ввода внешнего сигнала направления счета (XDIR). Счетчик положения инкрементируется по каждому положительному фронту счетного импульса на входе QEPA, если сигнал направления движения (QEPB) высокого уровня, в противном случае, - декрементируется.
Режим суммирующего счетчика
Сигнал направления счета принудительно устанавливается в состояние, соответствующее режиму суммирования. Счетчик положения тактируется импульсами, поступающими на вход QEPA микроконтроллера. Этот режим работы может использоваться для измерения положения с помощью одноканальных датчиков положения и частоты импульсов по входу QEPA.
Если установить бит QDECCTL[XCR], то будет разрешен режим генерации счетных импульсов по обоим фронтам входного сигнала QEPA. При этом разрешение по положению можно увеличить в два раза – 2-х кратная интерполяция применительно к одноканальным датчикам положения.
Режим вычитающего счетчика
В этом режиме работы сигнал направления счета принудительно устанавливается в состояние, соответствующее режиму вычитания. Одно из назначений - измерение частоты импульсов по входу QEPA. Так же, как и в режиме суммирующего счетчика, установка бита QDECCTL[XCR] разрешает режим генерации счетных импульсов по обоим фронтам входного сигнала QEPA для получения 2-х кратного разрешение по положению.

Режимы работы счётчик положения
Сброс счетчика положения по индексному (реперному) событию (Index Event). Применяется для измерения относительного положения.
Сброс счетчика положения при достижении максимальной позиции (Maximum Position). Применяется для измерения абсолютного положения.
Сброс счетчика положения по первому индексному событию (First Index Event). Применяется в позиционных системах с процедурой причаливания к «реперу».
Сброс счетчика положения по выходному событию в модуле временной базы (Unit Time Out Event). Этот режим чаще всего применяется для измерения частоты входных импульсов.

Сброс счетчика положения по индексному (реперному) событию

Операции сброса и установки счетчика положения при положительных и отрицательных переполнениях при QPOSMAX=4

Расчёт скорости и положения
На аппаратном уровне поддерживаются два алгоритма оценки скорости:
Для низких скоростей: автоматическое измерение временного интервала отработки заданного путевого приращения – «кванта перемещения» в количестве квадратурных импульсов. Возможность программного поддержания максимальной точности измерения за счет увеличения «кванта перемещения» по мере роста скорости (1, 2, 4, 8, …2048).
Для высоких скоростей: автоматическое измерение путевого приращения за заданный «квант времени» (тайм-аут). Возможность автоматического поддержания максимальной точности измерения за счет регулирования величины тайм-аута.

Технология расчета скорости

Расчет скорости на основе измерения периода импульсов инкрементального датчика

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

Расчет скорости на основе измерения частоты импульсов инкрементального датчика

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

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

Синхронизированный метод постоянного времени измерения
С помощью энкодера QEP и модуля захвата CAP получаем следующие данные:
Текущее положение в импульсах энкодера;
Направление вращения;
Времена передних и задних фронтов каналов А и В энкодера из предыдущего вызова функции расчета;
Времена передних и задних фронтов каналов А и В энкодера текущего вызова функции.
Тогда для случая, когда количество импульсов, прошедших между двумя вызовами функции, кратно 4, используются следующие формулы расчета:

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

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