3.3.2 Блок ввода и преобразования аналоговых сигналов
Базовым элементом блока ввода и преобразования аналоговых сигналов является аналогово-цифровой преобразователь (АЦП), который преобразует сигнал постоянного двуполярного тока в цифровой десятиразрядный двоичный код.
При поступлении сигнала на разрешение преобразования от контроллера АЦП замеряет сигнал на входе, и после завершения преобразования вместе с сигналом “Конец преобразования” выставляет на шину данных код.
3.3.3 Блок ввода-вывода дискретных сигналов
Блок ввода дискретных сигналов предназначен для ввода, нормализации и гальванической развязки сигналов от дискретных датчиков. Блок ввода дискретных сигналов работает совместно с выносными линейными модулями, объединение которых производится двухпроводной линией связи.
Опрос датчиков осуществляется последовательно время-импульсным квитированием сигналов. Цикл опроса разбит на 2 временных интервала - подготовительный и контрольный. Подготовительный сигнал необходим для заряда линейных модулей. Контрольный интервал разбит на 64 временных позиции, 62 из которых несут информацию о состоянии датчиков, 2 позиции выделены для контроля обрыва проводов линии связи.
Блок ввода дискретных сигналов формирует в линию связи специальные положительные и отрицательные импульсы. Импульсами положительной полярности пpоизводится питание и синхронизация pаботы модулей линейных. Ответные импульсы от модулей линейных фоpмиpуются во время пpохождения импульсов отрицательной полярности.
3.3.4 Математическое описание асинхронного двигателя
Асинхронная машина представляет собой систему, как минимум двух обмоток, одна из которых расположена на неподвижной части (статоре), другая на вращающейся части (роторе) машины. Момент машины образуется в результате взаимодействия токов в этих обмотках. Трехфазная обмотка статора подключается к питающей сети, трехфазная обмотка ротора замкнутая. Обмотки статора и ротора магнитосвязаны, поэтому потокосцепление обмотки статора определяется как токами, протекающими по трем фазам обмотки статора, так и токами фаз ротора. Это же относится и к обмотке ротора. Таким образом, имеются две трехфазные обмотки, вращающиеся одна относительно другой. Если к обмотке статора приложено трехфазное напряжение, а обмотка ротора замкнута, то мгновенные значения фазных напряжений статора и ротора задаются следующими уравнениями:
Исходя из теории результирующего вектора, описанной в [ ], умножим первое и четвертое уравнения системы (1) на , второе и пятое на , третье и шестое на . Суммируя полученные произведения, получим:
, или
где потокосцепления Y1 и Y2 зависят от токов ротора и статора, а также от индуктивностей обмоток машины.
Определим величины потокосцеплений статора и ротора. Предположим, что статор и ротор трехфазного асинхронного двигателя имеют симметричные обмотки, воздушный зазор по всей окружности ротора одинаков, магнитное поле в воздушном зазоре распределено синусоидально, оси обмоток статора и ротора не совпадают, образуя произвольный угол j (рис. 1).
Устанавливаем величину полного магнитного потока, сцепленного со статорной обмоткой фазы A. Для этого учитываем магнитные поля, созданные фазными токами I1A , I1B , I1C . Принимаем, что индуктивности фазных обмоток статора одинаковы и равны l1 , взаимные индуктивности фаз A-B, A-C и B-C также одинаковы и равны l0 (по условиям симметрии асинхронной машины). Тогда общий магнитный поток, сцепленный со статорной обмоткой фазы A выразится следующим образом:
.
Подставив вместо I1C величину (-I1A -I1B ) (так как сумма фазных токов асинхронного двигателя равна нулю), получим:
.
Проделав аналогичные операции с фазами B и C, запишем следующую систему уравнений:
Заметим, что индуктивность фазной обмотки статора включает в себя индуктивности от полей рассеяния и от главного потока, то есть
l1 =l1l +l10 (4).
Так как, в общем случае, взаимная индуктивность двух обмоток со сдвинутыми на некоторый угол осями равна произведению взаимной индуктивности, которая имела бы место при совпадении осей обмоток, на косинус угла между осями, то взаимную индуктивность можно выразить соотношением:
(5).
Учитывая выражения (4) и (5), преобразуем систему уравнений (3) к следующему виду:
где L1 = l1l + 1,5×l10 = l1l + L0 - полная индуктивность фазы статора.
Рассуждая аналогичным образом относительно обмотки ротора, получим следующие выражения для фазных потокосцеплений роторной обмотки с собственным потоком:
где L2 = l2l + L0 - полная индуктивность фазы ротора.
Определяем величину общего потокосцепления фазы A статора, созданного намагничивающими силами статора и ротора, исходя из рис. 1 и (6):
или, учитывая, что I2a + I2b + I2c = 0 и :
Выразив аналогичным образом потокосцепления для фаз статора B и C, запишем следующую систему уравнений:
Учитывая, что и , умножим первое уравнение системы (8) на , второе на , третье на и просуммируем полученные произведения:
или (9).
Таким же образом получим формулу потокосцепления ротора:
. (10)
Объединив уравнения (2), (10) и (11), получим систему уравнений обобщенного асинхронного двигателя:
где L0 - взаимная индуктивность обмоток статора и ротора, L1 - индуктивность статора от потоков рассеяния, L2 - индуктивность ротора от потоков рассеяния.
Система уравнений асинхронной машины (11) непригодна для математического моделирования на ЭВМ, так как векторы, относящиеся к статору и ротору, записаны в различных системах координат.
Приведем систему (11) к системе координат, неподвижной относительно поля статора, вращающегося с угловой скоростью w0 . Так как система координат поля статора повернута на угол (w0 ×t) относительно системы координат статора и на угол (w0 ×t-j), относительно системы координат ротора, где - угол между системами координат неподвижно связанными со статором и ротором, вращающемся с угловой скоростью w2 , то для перехода в систему координат поля статора умножаем все слагаемые первого и третьего уравнений системы (11) на , а слагаемые второго и четвертого уравнений системы (11) на , предварительно представив вектор потокосцепления статора как и вектор потокосцепления ротора как , где Y10 и Y20 - векторы потокосцеплений статора и ротора в системе координат поля статора:
или
где Y10 , Y20 , I10 , I20 - векторы потокосцеплений и токов статора и ротора в системе координат, неподвижной относительно поля статора, а - абсолютное скольжение асинхронного двигателя.
Приведем систему уравнений (12) к трем переменным: напряжению статора U1 и потокосцеплениям Y1 и Y2 . Для этого из третьего уравнения системы (12) выразим ток статора, представленный во вращающейся системе координат: , где Y10 - потокосцепление статора во вращающейся системе координат. Подставив найденное значение тока статора в четвертое уравнение системы (12), получим:
.
Приняв, что - коэффициент электромагнитной связи статора, - переходная индуктивность ротора, определим значение тока ротора во вращающейся системе координат: . Подставляем найденное значение тока ротора во вращающейся системе координат во второе уравнение системы (12):
.
Откуда, приняв что , окончательно получим:
. (13)
Приведем первое уравнение системы (12) к вращающейся системе координат. Для этого из четвертого уравнения системы (12) выразим ток ротора, представленный во вращающейся системе координат: , где Y20 - вектор потокосцепления ротора во вращающейся системе координат. Подставив найденное значение тока ротора в третье уравнение системы (12), получим:
.
Приняв, что - коэффициент электромагнитной связи ротора, - переходная индуктивность ротора, определим значение тока статора во вращающейся системе координат: . Подставляем найденное значение тока статора в первое уравнение системы (12):
.
Откуда, приняв что , окончательно получим:
. (14)
Спроецируем уравнения (13) и (14) на оси d и q вращающейся с частотой поля системы координат, учитывая, что U10 = U10d + j·U10q , Y10 = Y10d + j·Y10q и Y20 = Y20d + j·Y20q :
или преобразовав к нормальной форме Коши:
(15)
Уравнение для вращающего момента обобщенной электрической машины, согласно [1], имеет вид:
,
или перейдя к проекциям на оси d и q:
(16).
Все вышеприведенные рассуждения справедливы для обобщенной двухполюсной машины. В случае реальной многополюснолй машины ее необходимо привести к эквивалентной двухполюсной. С этой целью запишем уравнение движения:
,
где w - угловая скорость реальной машины, M' - вращающий момент реальной машины, Mс - механический вращающий момент нагрузки. Перепишем уравнение движения, учитывая, что M’ = p·M и w = W/p, где p - число пар полюсов реальной многополюсной машины:
. (17)
Объединив (15), (16) и (17), получим систему уравнений асинхронного двигателя во вращающейся с частотой поля системе координат:
(18)
Система уравнений (18) удобна тем, что может быть решена численными методами. Так, задавшись напряжением, статическим моментом и параметрами схемы замещения, можно найти потокосцепления статора и ротора Y10 и Y20 , момент М и скорость вращения ротора асинхронной машины w.
3.4 Проектирование робота
3.4.1 Постановка задачи
По заданной кинематической схеме манипулятора и заданному положению выходного звена рассчитать переменные параметры манипулятора, т. е. решить обратную задачу кинематики с использованием матричного метода. Проверку выполнить графическим методом. Размеры звеньев подобрать самостоятельно, шаг изменения размеров 50 мм.
3.4.2 Исходные данные
Положение выходного звена:
X=-250 ;Y=140 ;Z=480
Кинематическая схема манипулятора:
10P11
3.4.3 Основные понятия и определения
Манипулятором называется техническое устройство, предназначенное для воспроизведения некоторых рабочих функций рук человека. Манипулятором называют также исполнительный механизм промышленного робота, оснащенный приводами и рабочим органом, с помощью которого осуществляется выполнение рабочих функций. Способность воспроизводить движения, подобные движениям рук человека, достигается приданием манипулятору нескольких степеней свободы, по которым осуществляется управляемое движение с целью получения заданного движения рабочего органа - схвата.
Числом степеней свободы механической системы называется число возможных перемещений системы.
Твердые тела, входящие в механическую систему манипулятора, называются звеньями. В механике различают входные и выходные звенья. Входным называется звено, которому сообщается движение, преобразуемое механизмом. Выходным называется звено, совершающее рабочее движение.
Таким образом, в манипуляторе число входных звеньев равно числу приводов, а выходное звено, как правило, одно - схват, или рабочий орган.
Подвижное соединение двух соприкасающихся звеньев называется кинематической парой.
3.4.4 Метод матриц в кинематике манипуляторов
Метод матриц можно применять к расчету любого манипулятора с поступательными и вращательными кинематическими парами. Универсальность метода покупается ценой некоторой избыточности вычислений. Этот метод развивался параллельно с развитием вычислительной техники, и он больше приспособлен к расчетам на ЭВМ, нежели к расчетам вручную. Его использование требует свободного обращения с матричным аппаратом.
3.4.5 Выбор систем координат
Осью вращательной пары (i, i+1), составленной из звеньев i и i+1, является ось цилиндрического шарнира, жестко связанная со звеном i, вокруг которой вращается звено i+1. Для поступательной пары (i, i+1) осью является любая прямая, параллельная вектору скорости поступательного движения звена i+1 относительно звена i.
Пронумеруем все звенья манипулятора от стойки (звено 0) до схвата (звена n) и свяжем с каждым из них свою систему декартовых координат, выбранную следующим специальным образом: ось Zi идет по оси кинематической пары (i, i+1); начало координат системы i, жестко связанной со звеном i, лежит на общем перпендикуляре к осям Zi-1 и Zi, либо в точке их пересечения, если таковая имеется, либо в любой точке оси кинематической пары, если ось Zi совпадает с осью Zi-1 или параллельна ей; ось Xi идет по общему перпендикуляру, проведенному к осям Zi-1 и Zi, и направлена от точки пересечения этого перпендикуляра с осью Zi-1 к точке его пересечения с осью Zi (или в любую сторону по нормали к плоскости, содержащей оси Zi-1 и Zi, если они пересекаются, или произвольным образом, если Zi-1 и Zi идут по одной прямой); ось Yi выбирается по правилу правой тройки векторов.
Начало координат системы 0, т.е. системы, жестко связанной со стойкой, может лежать в любой точке оси пары (0,1); ось Xо направляется произвольным образом.
Выбор системы n тоже выпадает из общего правила, так как звено n+1 отсутствует. Поэтому предлагается вообразить любого типа пару (n, n+1) и после этого выбрать систему по общему правилу. Начало выбранной таким образом системы называется центром схвата.
3.4.6 Расширенная матрица перехода для кинематической
пары. Определение положения и ориентации звеньев
Специальный выбор систем координат звеньев манипулятора позволяет с помощью лишь четырех параметров описать переход из одной системы в другую. Систему i-1 можно преобразовать в систему i с помощью поворота, двух сдвигов (переносов) и еще одного поворота, выполняемых в следующем порядке:
1) поворот системы i-1 вокруг оси Zi-1 на угол Qi до тех пор, пока ось Xi-1 не станет параллельной оси Xi;
2) сдвиг повернутой системы вдоль оси Zi на величину Si до тех пор, пока оси Xi-1 и Xi не окажутся на одной прямой;
3) сдвиг вдоль оси Xi на величину ai до тех пор, пока не совпадут начала координат;
4) поворот вокруг оси Xi на угол ai до совмещения оси Zi-1 c осью Zi.
Расширенная матрица имеет следующий вид:
В расширенную матрицу Di входят четыре параметра: Qi , ai , Si , ai . Для любой кинематической пары три из них должны быть константами и только один - переменной величиной. Для вращательной пары переменной величиной является угол Qi , а для поступательной пары - перемещение Si .
Для определения положения и ориентации звена i в системе 0, следует найти произведение расширенных матриц А1, А2,... , Аi:
Ti = D1·D2· ... ·Di
Столбцы матрицы Ti имеют следующее геометрическое толкование: первые три элемента первого, второго и третьего столбцов представляют собой направляющие косинусы соответственно осей Xi, Yi, Zi в системе 0; три элемента четвертого столбца - это координаты xi, yi, zi центра системы i в системе 0.
3.4.7 Решение прямой задачи кинематики
Специальные системы координат выбираем в соответствии с указаниями (см. выше). Ось Z0 идет по оси поступательной пары (0,1), вдоль которой тело 1 поступательно перемещается относительно тела 0; ось Z1 идет по оси вращательной пары (1,2), т.е. по оси вращения тела 2; ось Z2 идет по оси вращательной пары (2,3); ось Z3 по оси поступательной пары (3,4); ось Z4 параллельна оси Z3 и проходит через центр схвата. Направление осей X, Y и положения начал координат показаны на конструктивной схеме (см. ниже).
Cоставим матрицы для всех звеньев. Для этого пронумеруем и определим параметры кинематических пар, а результаты занесем в таблицу, приведенную ниже.
|
Тип пары |
№ звена i |
||||
Q | a | S | A | |||
0,1 | поступа-тельная | 1 | 0 | 0 | S1 | 0 |
1,2 | враща-тельная | 2 | -Q2 | p/2 | S2 | 0 |
2,3 | потупа-тельная | 3 | 0 | 0 | S3 | 0 |
3,4 | поступа-тельная | 4 | 0 | 0 | S4 | 0 |
Для решения прямой задачи кинематики необходимо составить матрицы. В нашем случае матрицы A1 ,A3 и A4 - матрицы сдвига, а A2 - матрица вращения. Эти матрицы получаются из результирующей матрицы перехода, связывающей системы (i-1) и i.
Рассчитаем результирующие матрицы перехода для заданной кинематической системы манипулятора.
; ; ;
Задача решается при помощи формулы:
Решение прямой задачи кинематики сводится к тому, что имея значения обобщенных координат определяются элементы матрицы T, которая однозначно устанавливает положение и ориентацию схвата в системе координат стойки.
Координаты центра схвата в системе, связанной со стойкой манипулятора:
3.4.8 Решение обратной задачи кинематики
Обратную задачу кинематики можно сформулировать так : задана кинематическая схема манипулятора и известны положение и ориентация схвата в системе координат стойки. Требуется определить значения обобщенных координат, которые обеспечат заданное положение схвата.
Задать положение схвата, как и любого твердого тела, можно с помощью шести
29-04-2015, 01:59