Автоматические устройства
Уравнение (10) проецируется на ось Y, так как VDx=0, VDy=0 и VCy=0, то
3zr3cos(3
-
)+
2zr2cos(2
-) +
1zr1cos(1+)=0
(18)
Из составленных уравнений связей выбираем 4, позволяющих наиболее простым путем произвести преобразования и выразить одни неизвестные через другие. В данном случае это уравнения (11), (12), (16), (18), которые с учетом формул приведения запишутся в следующем виде:
![]()
23zr3sin3 - 3zr3cos3+0,54zr3=0 (19)
0,54zr3+3zr3cos3+2zr2sin2+1zr1sin1=0
3zr3sin3 - 2zr2cos2 - 1zr1cos1=0
Система уравнений (19) может быть разрешена относительно iz:
![]()


Дополним (20) уравнениями:
;
(21)
Уравнения (20) и (21) образуют систему дифференциальных уравнений, интегрирование которой при заданных начальных значениях 1(0), 2(0), 3(0) решает задачу о движении механизма при заданном движении точки М.
3. Решение задачи и обработка результатов. Вычисления могут проводиться с использованием конечно-разностной схемы Эйлера, позволяющей связать значения углов и угловых скоростей в начале и конце k-го шага интегрирования :
1(k+1)=1(k)+1z(k)t;
2(k+1)=2(k)+2z(k)t; (22)
3(k+1)=3(k)+3z(k)t.
Программа счета составляется на любом языке программирования, результаты оформляются с помощью программы в виде таблицы. По результатам решения строятся графики 1z(t), 2z(t), 3z(t), 4z(t), которые не должны иметь разрыва и иметь явно выраженный синусоидальный характер.
4. Графическая проверка. Извлекаются из таблицы счета значения углов поворота звеньев из строки под номером (N+2). Механизм строится в масштабе 1:10, определяется положение мгновенных центров скоростей (рис. 3). Строятся векторы скоростей точек A, B, C, M и указываются дужками направления вращения звеньев. По известным значениям скоростей и расстояниям до мгновенных центров скоростей определяются значения угловых скоростей звеньев.


Результаты, полученные с помощью графических построений, должны быть близки к результатам рещения задачи на ЭВМ и не должны отличаться более чем на 5%.
II. Кинематика управляемого движения манипулятора.
Описание задания.
Манипулятор (рис.1), имеющий две системы свободы позволяет, при срабатывании приводов, захвату, точке М, осуществлять движение в плоскости по двум координатам и при определенных условиях совместить захват с двигающейся деталью,точкой К. Деталь К движется с постоянной скоростью Vк в указанном на рисунке направлении. Координаты точки К изменяются по закону:
XK=XK(0)+VKx t; YK=YK(0)+VKy t. (23)
Управление движением захвата М осуществляется по линейной комбинации рассогласований координат точек К и М, а также их производных. Рассогласование координат точек К и М в момент времени t=2 должно составлять величину от начальных рассогласований.
Исходные данные определяются формулами (24) и табл. 1
r1=r1T+0,001n, ri=riT+0,001N
1(0)=1T+0,001n, i(0)=iT+0,001N(i=2,3) (24)
VK=VKT - 0,003N, 2=1,2(1+0,02N)
t=
.
(24)
Требуется:
1. Выбрать управление, решающее поставленную задачу.
2. Исследовать движение манипулятора при выбранном управлении.
Конкретные пункты исследования приведены в примере.
Указания к составлению уравнений движения.
Предполагается, что координаты захвата М(XM,YM) в процессе движения известны, например, за счет прямых измерений;координаты детали К(XK,YK) заданы уравнениями (23). Тогда можно вычислить рассогласования:
X=XK- XM; Y=YK- YM (25)
Управление движением захвата осуществляется по сигналам управления ux, uy, образованным линейной комбинацией рассогласований и их производных:
ux=X+T*
X;
uy=Y+T*
Y,
(26)
где T* - множитьель размерности времени.
Сигналы (26) подаются на управление двигателями манипулятора с коэффициентом усиления k величина
kux, kuy (27)
В современных высокоточных механизмах коэффициэнты усиления k очень велики. Можно считать k, при этом величины (27) остаются конечными,обеспечивающими требуемое движение манипулятора,поэтому можно предположить ux, uy0.
Приближенные предельные уравнения
ux=0, uy=0 (28)
описывают движение манипулятора с погрешностью порядка 1/k.
Из (25), (26), (28) получим уравнения:
=VKx+
(XK
XM)
=VKy+
(YK
Y M)
(29)
Манипулятор является механической системой с двумя степенями свободы, движение по двум координатам XM, YM, найденные по (29) однозначно определяет движение всех его звеньев. Кинематические уравнения, описывающие изменения углов поворота и угловых скоростей звеньев могут быть заимствованы из предыдущей задачи.
Указания к выбору коэффициэнта управления.
Уравнения (26), (28) в рассогласованиях X и Y примут вид:
T*
X
+X=0; T*
Y
+Y=0
Решение этих дифференциальных уравнений однотипно:
x=x(0)
е
; y=y(0)
е
(30)
По условию задания, к концу интервала времени 2 рассогласования X, Y должны составлять величину от начальных рассогласований.
Из (30)
имеем :
,
откуда Т*=
.
Указания к выбору начальных условий. Если систему уравнений (29) и кинематических уравнений движения звеньев привести к форме Коши, то она будет иметь вид:
M=VMx(XM,t);
M=VMy(YM,t);
(31)
i=iz(i,
Vmx, Vmy, t) (i=1,2,3)
Эти уравнения манипулятора,являющегося системой с двумя степенями свободы, записаны в избыточном наборе пяти переменных XM, YM, 1, 2, 3. Отсюда следует, что из начальных значений этих переменных независимо могут задаваться только два. В таблице 1 независимыми задаются величины 1(0), 2(0), значения 3(0) указанные в таблице,вычислены по 1(0), 2(0) для рассматриеваемой конструктивной схемы манипулятора. Значения XM(0), YM(0) следует находить по заданным 1(0), 2(0), 3(0).
Указания к решению задачи. Дифференциальные уравнения движения манипулятора с заданными начальными условиями интегрируются на интервале времени 0 2 с шагом t. При решении задачи рекомендуется использовать конечноразностную схему Эйлера.
Контроль решения. Построенные по результатам счета графики не должны иметь разрывов. При t=2 рассогласование между точками М и К должно быть величиной порядка от начального. Результаты вычисления на ЭВМ для момента времени t=(N+1)t угловых скоростей звеньев и скорости точки С должны совпадать с результатами графоаналитического решения для этого момента времени. Расхождения не должны превышать 5%.
Пример выполнения задания .
(вариант 31, n=1, N=2)
1. Постановка задачи. Управление манипулятором (рис.4) должно обеспечить за время 2 сближение захвата М с движущейся деталью К. Деталь движется прямолинейно с постоянной скоростью Vк в указанном на рисунке направлении. Начальное положение манипулятора задано углами поворота звеньев 1(0), 2(0), 3(0). К моменту времени t=2 требуется относительная точность совмещения точек М и К. Управление манипулятором осуществляется по линейной комбинации рассогласований и их производных.
Дано: Vk=0,304м/c; =4,35рад; DA=r1=0,953м; BC=r3=0,457м; BM=2r3; AB=r2=0,847м; 1(0)=1.63рад; 2(0)=3,37рад; 3(0)=2,87рад; Xk(0)=-2,16м; Yk=1,18м; =0,01; 2=1,37c; t=0,057c.

Требуется: 1. Составить уравнения управляемого движения точки М, уравнения углового движения звеньев манипулятора и уравнения для скорости точки С. 2. Выбрать параметры управления, обеспечивающего сближение точек М и К с заданной точностью. 3. Проинтегрировать с помощью ЭВМ уравнения движения на интервале времени 0, 2 . 4. Построить траектории сближения точек М и К и графики 1(t), 1z(t), Vcx(t). 5. Для момента времени t=(N+1)t=0,456c провести графоаналитическое решение задачи и сравнить с результатами счета.
2. Составление уравнений движения. Уравнения движения детали К имеют вид:
Xk=Xk(0)+Vkxt; Vkx=Vkcos= - 0,108м/c; (32)
Yk=Yk(0)+Vkyt; Vky=Vksin= - 0,284м/c.
Предполагая,что координаты захвата М известны в процессе движения,можно вычислить рассогласования координат точек К и М.
X=Xk - XM; Y=Yk - YM (33)
Учитывая,что управление манипулятором осуществляется по линейной комбинации рассогласовании и их производных
ux=X
+ T*
X;
uy=Y +
T*
Y
(34)
При управлении с большими коэффициентами усиления k