Материал: 2426

Внимание! Если размещение файла нарушает Ваши авторские права, то обязательно сообщите нам

Вывод коэффициентов полинома четвертой степени для системы уравнений (4.15)–(4.18).

В уравнении тора (4.18), согласно выражению (4.16), в принятой системе координат x2+z2=ρ2. В то же время, согласно (4.30), ρ2 может быть выражено через y. Подставив (4.30) в (4.18), получим уравнение с одним неизвестным:

(h12 + (y × к + y0 )2 + y2 + R2 - r2 )2 -

 

- 4 × R2 × (h12 + (y × к + y0 )2 )= 0.

 

(4.74)

Дальнейшие преобразования приводятся без пояснений:

(h 2 + y2

× к2 + 2 × y × к × y

0

+ y 2 + y2 + R2

- r2 )2 -

1

(h 2 + y2 × к2

 

0

 

+ y 2 )= 0;

 

- 4 × R2 ×

+ 2 × y × к × y

0

 

 

1

 

 

 

0

 

 

(y2 ×(к2 +1)+y×(2×к×y )+(h2

+y 2 +R2

-r2))2 -

 

 

 

0

1

 

0

 

 

 

 

-4×R2 ×h

2 -4×R2 ×y2 ×k2

-4×R2 ×y×2×k×y -4×R2 ×y 2

=0;

1

 

 

 

 

0

0

 

y4 ×(к2 +1)2 + y3 ×(2×(к2 +1)× 2×к × y0 )+

+ y2 ×(2×(h 2 + y 2 + R2 - r 2 ))+ y2 ×(2×к × y )2 +

+y ×(2× 2×к × y0 ×(h12 + y02 + R2 - r 2 ))+

+(h12 + y02 + R2 - r 2 )2 - 4× R2 × h12 - 4× R2 × y2 ×к2 -

- 4× R2 × y × 2× к × y0 - 4 × R2 × y02 = 0.1 0 0

Если обозначить

(к2 +1)2 = s1;

(2 × (к2 +1)× 2 × к × y0 )= s2 ;

2× (h12 + y02 + R2 - r2 )+ 22 × к2 × y02 - 4× R2 × к2 = s3;

4×к × y0 ×(h12 + y02 + R2 - r2 )- 4× R2 ×2×к × y0 = s4 ;

(h12 + y02 + R2 - r2 )2 - 4× R2 ×h12 - 4× R2 × y02 = s5 ,

то может быть получена классическая форма полинома четвертой степени:

y4·s1+y3·s2+y2·s3+y·s4+s5=0,

(4.75)

200

 

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

твердило ее адекватность реальному объекту и возможность использования методики для определения необходимых значений управляемых координат отдельно стоящего ГПК либо двух стреловых кранов, перемещающих общий груз.

Упрощенная методика определения управляемых координат ГПК по известным координатам груза при нулевых углах наклона шасси.

В случае обеспечения горизонтального положения опорной платформы при помощи систем автоматического горизонтирования

[58, 79, 84, 98, 118, 125, 126, 156, 158, 162] может быть использована упрощенная методика определения управляемых координат ГПК по известным координатам груза, которая заключается в описанной ниже последовательности шагов [103]. Предполагаются известными декартовы координаты точки подвеса груза [xгр; yгр; zгр], заданные в неподвижной системе координат O0Х0Y0Z0, а также координаты точки O1 начала системы координат O1Х1Y1Z1, связанной с базовым шасси ГПК:

[q1; q2; q3; 0; 0; q6].

1. Определяются координаты груза в полярной системе координат, связанной с базовым шасси (значение координаты угла поворота q7 и вылета ρ). Используются схема, приведенная на рис. 4.18, а, и зависимости для перевода декартовых координат в полярные на плоскости [31]:

ρ =

 

.

 

(xгр - q1 )2 + (zгр - q3 )2

(4.76)

ìarctg((zгр - q3 ) (xгр - q1)) ïïarctg((zгр - q3 ) (xгр - q1))+π

q6,7 = ïíarctg((zгр - q3 )(xгр - q1))-π

ïïπ2 ï-π 2

î

при (xгр - q1)> 0;

при (xгр - q1)< 0; (zгр - q3 )³ 0;

при (xгр - q1)< 0; (zгр - q3 )< 0; (4.77)

при (xгр - q1)= 0; (zгр - q3 )> 0; при (xгр - q1)= 0; (zгр - q3 )< 0.

Отсюда при известном значении q6

 

q7= q6,7 q6.

(4.78)

2. Определяются максимальные и минимальные значения диапазонов управляемых координат ГПК [q8В q8Н]; [q9В q9Н].

201

 

q1

 

xгр

X0

O0

 

 

X2, X3, X4

zгр

 

 

 

 

4

 

0, 5, 6, 7

3

 

 

Z4

 

 

 

 

 

 

q6,7=q6+q7

 

а)

 

q7

 

 

 

 

q3

1

X1

 

q6

 

 

X0ʹ

 

Z1

2

Z2

 

 

 

Z3

 

Z0

Y4

 

q9

X3, X4

4

y4,43

 

 

 

 

 

 

3

 

5

 

 

 

 

Y1,

Y2

x3,33

 

R2,5

 

 

q10 y5,7

 

 

 

 

 

 

 

 

 

 

б)

Y3

 

 

 

 

q8

 

 

 

 

 

 

 

 

q8,1

 

 

 

6

 

 

 

 

 

 

O

q8,2

 

 

 

 

y6,7

 

X2

 

 

 

 

 

 

 

 

 

 

2

3

 

 

 

 

 

 

 

 

 

 

y1,2

O1,O2

Y0

X2

y0,6=yгр

7

 

 

y0,7=

 

 

 

 

 

 

 

 

 

 

 

 

 

 

1

q2

 

 

q7

 

0

=q2+y1,2

 

 

Z1

 

X1

 

 

 

 

 

 

 

 

Z0 O0

 

 

 

 

 

 

 

 

 

x1,2

X0

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

ρ

 

 

 

 

 

Рис. 4.18. Схема для определения управляемых координат ГПК при нулевых углах наклона шасси

2.1. Для этого определяются значения вылета ρ, соответствующие четырем возможным сочетаниям максимальных и минимальных допустимых конструкцией ГПК значений координат q8 и q9 (точки 1, 2, 3, 4 положения оголовка стрелы):

202

Точка 1 (ρ=ρ1):

q8=q8max; q9=q9min;

(4.79)

Точка 2 (ρ=ρ2):

q8=q8max; q9=q9max;

(4.80)

Точка 3 (ρ=ρ3):

q8=q8min; q9=q9min;

(4.81)

Точка 4 (ρ=ρ4):

q8=q8min; q9=q9max.

(4.82)

Для каждого сочетания зна- Y1 2 чений q8 и q9 используется после-

довательность вычислений:

 

 

 

 

q8,1=arctg(y4,43/(x3,33+q9));

 

1

 

 

R2,5 = (x3,33 + q9 )2 + y4,432 ;

 

 

 

 

 

 

q8,2=q8q8,1;

(4.83)

 

 

 

4

ρ=R2,5∙cos q8,2 – x1,2.

(4.84)

 

 

 

По (4.83)–(4.84) определяют-

 

 

3

ρ

 

 

ся последовательно 4 постоянных

ρ1

ρ2

ρ3

ρ4

значения: ρ1, ρ2, ρ3, ρ4.

 

 

Рис. 4.19. К определению диапазонов

2.2. По заданному текущему

значению

ρ

определяются

гра-

 

 

вылета ρ

 

ничные

значения

диапазонов

 

 

 

 

 

 

 

 

управляемых координат [q8В

q8Н];

При ρ1ρ<ρ2

 

[q9В q9Н].

 

 

 

 

 

 

 

 

 

 

q8В=q8max;

q8Н=arctg(y4,43/(x3,33+q9min))+arccos((x1,2+ρ)/ y4,432 +(x3,33 + q9min )2 ); (4.85)

q9В=(x1,2+ρ–y4,43∙sin q8max)/cos q8max x3,33;

q9Н=q9min.

При ρ2ρ<ρ3

q8В=arctg(y4,43/(x3,33+q9max))+arccos((x1,2+ρ)/ y4,432 + (x3,33 + q9max )2 );

q8Н=arctg(y4,43/(x3,33+q9min))+arccos((x1,2+ρ)/

 

 

);

 

 

y4,432 +(x3,33 +q9min )2

(4.86)

q9В=q9max; q9Н=q9min.

 

 

При ρ3ρρ4

 

 

q8В=arctg(y4,43/(x3,33+q9max))+arccos((x1,2+ρ)/

y4,432 + (x3,33 + q9max )2

);

q8Н=q8min; q9В=q9max;

(4.87)

q9Н=(x1,2+ρ–y4,43∙sin q8min)/cos q8min x3,33.

 

 

В случае, если значение вылета ρ находится вне интервала конструктивно допустимых значений

203

ρ [ρ1; ρ4 ],

(4.88)

делается вывод о невозможности обеспечить требуемые координаты груза при текущем положении базового шасси ГПК, алгоритм завершает свою работу.

2.3. По текущему значению ρ и граничным значениям координат [q8В q8Н]; [q9В q9Н] определяются граничные значения диапазона управляемой координаты [q10В q10Н].

ρ [ρ14 ], используя (4.83), получим

y5,7=tg(q8–arctg(y4,43/(x3,33+q9)))∙(ρ+x1,2).

(4.89)

Согласно схеме на рис. 4.18, б,

 

q10=y5,7 y6,7 = y5,7 – (yгрy0,7)= y5,7 – (yгр– (q2+y1,2))=

 

= tg(q8–arctg(y4,43/(x3,33+q9)))∙(ρ+x1,2) – (yгр– (q2+y1,2)),

(4.90)

где y4,43 x3,33 x1,2 y1,2 – постоянные конструктивные значения.

 

Соответственно значения [q10В q10Н] определятся как

 

q10Н = tg(q8Н –arctg(y4,43/(x3,33+q9Н)))∙(ρ+x1,2) – (yгр– (q2+y1,2));

 

q10В = tg(q8В –arctg(y4,43/(x3,33+q9В)))∙(ρ+x1,2) – (yгр– (q2+y1,2)).

(4.91)

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

q10В<q10min,

(4.92)

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

Если выполняется условие

q10Вq10min q10Н<q10min,

(4.93)

где – знак логического умножения (конъюнкции), т.е. точка подвеса груза расположена внутри пространства возможных положений оголовка стрелы (позиция 4 на рис. 4.7), q10Н корректируется:

q10Н=q10min. (4.94)

После этого также последовательно корректируются значения q9Н и q8Н по (4.97) и (4.96) с подстановкой значения q10Н.

204