Maloletov-diss
.pdf161
дождевальной машины «Кубань», а также для лабораторных макетов шагающих роботов [49, 106, 137, 145, 185].
Теоретико-механическая модель шагающей машины с ортогональноповоротными движителями легла в основу программного обеспечения системы управления шагающей машины «Ортоног».
В качестве примера на рисунке 2.6 приведены расчётный и экспериментальный графики изменения мощности от времени для шагающей машины «Восьминог».
Рисунок 2.6 — Зависимости мощности от времени при движении шагающей машины «Восьминог»: расчётная (сплошная линия), экспериментальная (точки).
На рисунке 2.7 показаны примеры экспериментальных (рисунок 2.7.а, б) и расчётных (рисунок 2.7.в, г) зависимостей горизонтальной и вертикальной скоростей центра масс машины «Восьминог».
На рисунке 2.8 показан внешний вид программы просмотра и анализа экспериментальных значений параметров движения шагающей машины «Ортоног».
162
а) Vz, м/с
б) Vx, м/с
t, с
в) Vz, м/с
t, с
г) Vx, м/с
t, с Рисунок 2.7 — Примеры экспериментальных и расчётных зависимостей
163
Рисунок 2.8 — Программа просмотра и анализа экспериментальных значений параметров движения шагающей машины «Ортоног»
164
3.Оптимизация алгоритмов и законов управления движением шагающих машин
3.1.Применение уравнения Эйлера-Лагранжа при многокритериальной оптимизации шагающих машин
Рассматривается механическая система имеющая N степеней свободы и характеризующаяся вектором независимых обобщённых координат q = [qi]T, i = 1,...,N.
Из всего множества частных критериев качества ограничиваемся рассмотрением тех критериев Hj, которые могут быть представлены в виде интегралов по времени от функций механического состояния, зависящих в общем случае от времени, обобщённых координат и их производных. Для механических
систем это как правило производные первого q˙ =[q˙i ]T и второго q¨ =[q¨i ]T порядков, однако в некоторых случаях могут быть востребованы и производные более высоких порядков q(n)=[dn qi /d tn ]T (здесь и далее верхний индекс в круглых скобках обозначает производную по времени соответствующего порядка, в частности q=q(0) , q˙ =q(1) и так далее; через n обозначен максимальный порядок производных):
τ |
|
H j=∫ f j (t , q(0) , q(1) ,... , q(n))d t |
(3.1) |
0 |
|
где fj — произвольная функция, t — время, τ — рассматриваемый период времени, для шагающих машин это обычно период одного шага или период одного цикла, состоящего из двух шагов.
Примеры таких показателей: среднеквадратичное ускорение какой-либо точки; механическая работа сил, развиваемых каким-либо двигателем, и другие.
165
В этом случае подынтегральная функция качества (1.15) имеет вид
Φ=∑ k j f j (t , q(0) , q(1) , ... , q(n)) , |
(3.2) |
j |
|
а критерий оптимальности (1.14) может быть записан в виде
τ |
|
I =∫Φ(t , q(0) , q(1) ,... , q(n))d t →min |
(3.3) |
0 |
|
Тогда, задача определения законов движения системы
qi=qi (t ,k1, k 2, ... ,k j , ...) , |
(3.4) |
обеспечивающих оптимальность по критерию (3.3) сводится к решению системы N уравнений Эйлера-Лагранжа:
∂Φ |
n |
|
|
|
∂Φ |
|
|
l dl |
|
|
|
|
|||
∂ q |
+∑(−1) |
|
|
|
|
=0 |
(3.5) |
d t |
l |
|
(l ) |
||||
i |
l=1 |
|
|
∂ q |
|
|
|
|
|
|
|
|
i |
|
|
при соответствующих начальных или граничных условиях.
В результате решения системы уравнений (3.5) получается N зависимостей (3.4) которые представляют собой программные движения рассматриваемой механической системы, обеспечивающие оптимальность по критерию (3.3) и зависящие от выбора весовых коэффициентов kj.
166
Полученное решение обеспечивает экстремум функции (3.3), а не максимум или минимум. Поэтому в ряде случаев может потребоваться дополнительное исследование на значение второй вариации.
В частном случае при n = 2, подынтегральная функция качества (3.2) и уравнение Эйлера-Лагранжа (3.5) принимают вид:
Φ=∑ k j f j (t , q , q˙ , q¨ ) ,
j
d2 |
∂ Φ |
− |
d ∂ Φ |
+ |
∂Φ |
=0 |
||
d t |
2 |
∂q |
d t |
∂q |
∂ q |
|||
|
¨i |
|
|
˙i |
|
i |
|
что, в свою очередь, можно переписать в виде
∂2 Φ q(4)=− |
|
|
∂3 Φ |
|
|
−∂3Φ q2− |
|
|
∂3Φ |
|
q2− |
|
∂3 Φ |
|
q2− |
||||||||||||||||||||||||||
∂ t2 ∂ q |
|
|
|
|
|
|
|
|
|
|
|
|
|||||||||||||||||||||||||||||
∂ q2 |
i |
|
|
|
|
|
|
|
∂q3 i |
|
∂ q2 |
∂q |
˙ i |
|
∂ q2 |
∂ q |
¨i |
||||||||||||||||||||||||
¨i |
|
|
|
|
|
|
|
|
|
|
|
¨i |
|
|
¨ i |
|
|
|
|
i |
|
¨ i |
|
|
|
|
|
˙i |
|
¨ i |
|
||||||||||
−2 |
|
|
|
∂3 Φ |
|
|
|
q |
−2 |
|
|
|
∂3 Φ |
|
|
|
q |
−2 |
∂3Φ |
|
q |
− |
|||||||||||||||||||
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|||||||||||||||||||||||||
|
|
|
|
∂t ∂q |
∂q |
|
|
˙ i |
|
|
∂t ∂ q |
∂ q |
¨ i |
|
|
|
∂t |
∂q |
2 |
i |
|
|
|||||||||||||||||||
|
|
|
|
|
|
|
|
|
|
i |
|
¨ i |
|
|
|
|
|
|
|
|
˙ i |
|
|
¨i |
|
|
|
|
|
|
|
|
|
||||||||
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
¨ i |
|
|
|
|
||
−2 |
|
|
|
∂3 Φ |
|
|
|
q q |
−2 |
|
∂3 Φ |
|
|
q q |
−2 |
∂3 Φ |
|
q q − |
|||||||||||||||||||||||
|
|
|
|
|
|
|
|
|
|
|
|
|
|||||||||||||||||||||||||||||
|
∂q |
∂q |
∂ q |
˙i |
|
¨i |
|
|
|
∂q |
∂q |
2 ˙ i |
i |
|
|
|
∂q |
∂q |
2 ¨ i |
i |
|||||||||||||||||||||
|
|
|
|
i |
|
˙ i |
|
|
|
¨ i |
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|||||||||||||
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
i |
¨ i |
|
|
|
|
|
|
|
|
˙ i |
|
¨ i |
|
|
||||||
− |
|
∂2 Φ |
|
|
q + |
|
|
|
∂2 Φ |
|
+ |
|
∂2 Φ |
|
q |
+∂2 Φ q |
−∂ Φ |
||||||||||||||||||||||||
|
|
|
|
|
∂t ∂ q |
|
|
|
|||||||||||||||||||||||||||||||||
|
|
∂q |
∂q |
|
|
¨i |
|
|
|
|
∂q |
∂ q |
˙i |
|
∂q |
2 |
|
¨i |
|
|
∂q |
i |
|||||||||||||||||||
|
|
|
|
|
i |
|
¨ i |
|
|
|
|
|
|
˙i |
|
|
|
i |
|
|
˙ i |
|
|
|
|
|
|
|
|
|
|
||||||||||
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
˙ i |
|
|
|
|
|
|
|
|
(3.6)
(3.7)
(3.8)
или, используя обозначения частных производных с помощью нижних индексов в круглых скобках и опуская индекс i для краткости записи:
|
|
|
|
|
|
|
|
|
|
|
|
|
167 |
|
|
|
|
|
|
|
|
|
q(4)= |
|
1 |
|
|
( |
−Φ −Φ q2−Φ q2−Φ q2 |
) |
+ |
|
|||||||||||||
Φ(q¨ q¨ ) |
|
|||||||||||||||||||||
|
|
|
(t t q¨ ) |
|
|
(q¨ q¨ q¨ ) |
|
|
(qq q¨ ) ˙ |
|
|
(q˙ q˙ |
q¨ ) ¨ |
|
|
|||||||
+ |
1 |
|
|
|
−2 Φ |
|
q−2Φ |
|
|
q−2 Φ |
|
q + |
|
|
|
|||||||
Φ |
|
|
¨ |
˙ |
¨ |
¨ ¨ |
|
|
|
|||||||||||||
|
|
|
|
( |
|
|
|
¨ |
|
|
) |
|
|
|
||||||||
|
|
|
(q¨ |
q¨ ) |
(t q q) ˙ |
(t q q) |
(t q q ) |
|
|
. |
(3.9) |
|||||||||||
|
1 |
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
||||
+ |
(−2Φ(q q˙ q¨ )q˙ q¨ −2 Φ(q q¨ q¨ ) q˙ q−2 Φ(q˙ q¨ q¨ ) q¨ q)+ |
|
||||||||||||||||||||
Φ |
|
|||||||||||||||||||||
|
|
(q¨ q¨ ) |
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|||
+ |
|
1 |
|
|
−Φ q+Φ |
+Φ |
|
q+Φ |
q−Φ |
|
|
|
||||||||||
Φ |
|
|
|
|
||||||||||||||||||
|
|
( |
|
(q q¨ ) |
¨ |
|
(t q˙ ) |
|
(q q˙ ) ˙ |
(q˙ |
q˙ ) ¨ |
|
(q)) |
|
|
|||||||
|
|
|
(q¨ q¨ ) |
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
Дифференциальное уравнение четвёртого порядка (3.9) записывается в виде системы четырёх уравнений первого порядка:
r˙= Φ1 (−Φ(t t q¨ )−Φ(q¨ q¨ q¨ ) r2−Φ(qq q¨ ) v2−Φ(q˙ q˙ q¨ ) a2)+ (q¨ q¨ )
+ Φ1(q¨ q¨ ) (−2Φ(t q q¨) v−2Φ(t q˙ q¨ ) a−2 Φ(t q¨ q¨ ) r)+
+ |
1 |
(−2 Φ(q q˙ q¨ ) v a−2 Φ(q q¨ q¨ ) v r−2 Φ(q˙ q¨ q¨ ) a r)+ . |
(3.10) |
||
Φ(q¨ q¨ ) |
|||||
+ |
1 |
|
(−Φ(q q¨ ) a+Φ(t q˙ )+Φ(q q˙ ) v+Φ(q˙ q˙ ) a−Φ(q)) |
|
|
Φ |
|
|
|||
|
|
(q¨ q¨ ) |
|
a˙ =r v˙ =a q˙ =v
Системы уравлений (3.10), составленные для каждой из обобщённых координат механической системы, представляют собой системы обыкновенных дифференциальных уравнений с граничными условиями и могут быть решены одним из известных численных методов, например методом пристрелки [238].
При явном задании функции Φ частные производные могут найдены в явном виде, при численном решении частные производные определяются по конечноразностным формулам (2.117)-(2.127).
В таблице 3.1. приведены некоторые частные случаи зависимостей функции управления качеством для механической системы с одной степенью свободы,
168
которой соответствует обобщённая координата q. Далее рассмотрены получающиеся для этих случаев уравнения Эйлера-Лагранжа и некоторые их решения. Часть этих случаев с точностью до весовых коэффициентов kj рассмотрена, например, в [297].
Таблица 3.1 — Частные случаи подынтегральной функции качества
№ п/п |
Зависимость от |
|
|
|
|
|
|
|
|
|
времени t |
обобщённой |
обобщённой |
обобщённого |
|
|
координаты q |
скорости q˙ |
ускорения q¨ |
1 |
- |
- |
произвольная |
- |
|
|
|
|
|
2 |
- |
произвольная |
произвольная |
- |
|
|
|
|
|
3 |
- |
произвольная |
- |
линейная |
|
|
|
|
|
4 |
- |
- |
- |
произвольная |
|
|
|
|
|
5 |
- |
произвольная |
- |
произвольная |
|
|
|
|
|
6 |
- |
- |
произвольная |
произвольная |
|
|
|
|
|
7 |
- |
произвольная |
произвольная |
произвольная |
8 |
произвольная |
произвольная |
- |
- |
|
|
|
|
|
9 |
произвольная |
произвольная |
линейная |
- |
|
|
|
|
|
10 |
произвольная |
- |
произвольная |
- |
|
|
|
|
|
11 |
произвольная |
произвольная |
произвольная |
- |
|
|
|
|
|
12 |
произвольная |
произвольная |
- |
линейная |
|
|
|
|
|
13 |
произвольная |
- |
- |
произвольная |
|
|
|
|
|
14 |
произвольная |
произвольная |
- |
произвольная |
|
|
|
|
|
15 |
произвольная |
- |
произвольная |
произвольная |
|
|
|
|
|
1. Функция качества зависит только от обобщённой скорости.
Φ= |
∑ |
k |
j |
f |
(q) |
(3.11) |
|
|
|
j ˙ |
|||
|
j |
|
|
|
|
|
169
Уравнение Эйлера-Лагранжа
(∑j k j f j ,(q˙ q˙ ))q¨ =0
соответствует уравнениям
q¨ =0
или
∑ k j f j ,(q˙ q˙ )=0 . j
Выражение (3.13) даёт решение
q=C1t+C 2 ,
(3.12)
(3.13)
(3.14)
(3.15)
с варьируемыми постоянными C1 и C2. А выражение (3.14) либо имеет решение (3.15), где C1 равно одному из корней (3.14), либо решения не имеет.
2. Подынтегральная функция качества зависит от обобщённой координаты и обобщённой скорости.
Φ= |
∑ |
k |
j |
f |
j |
(q , q) |
(3.16) |
|
|
|
˙ |
||||
|
j |
|
|
|
|
|
|
Уравнение Эйлера-Лагранжа:
170
∑ k j ( f j ,(q)− f j ,(q q˙ ) q˙ − f j ,(q˙ q˙ ) q¨ )=0 j
С учётом:
( f j ,(q)− f j ,(q q˙ ) q˙ − f j ,(q˙ q˙ ) q¨ )q˙ =ddt ( f j− f j ,(q˙ ) q˙ )
уравнение (3.17) можно преобразовать к виду
dt ∑j k j ( f j− f j ,(q˙ ) q˙ )=0
d
откуда следует
∑ k j ( f j− f j ,(q˙ ) q˙ )=С1
j
(3.17)
(3.18)
(3.19)
(3.20)
3. Подынтегральная функция качества зависит от обобщённого ускорения линейно и не зависит от обобщённой скорости.
∑ |
|
|
|
|
|
∑ |
|
|
|
∑ |
|
|
) |
|
(3.21) |
j |
k |
j ( |
a |
(q)+b |
(q)q = |
j |
k |
a |
( j |
k |
b |
q |
|
||
Φ= |
|
(q)+ |
|
(q) |
|
||||||||||
|
|
j |
j |
¨ ) |
|
j |
j |
|
|
j |
j |
|
¨ |
|
Уравнение Эйлера-Лагранжа в этом случае имеет вид:
∑ |
|
|
|
∑ |
|
|
|
) |
|
∑ |
|
|
|
) |
|
(3.22) |
j |
k |
a |
|
( j |
k |
b |
|
q2+2 |
( j |
k |
b |
|
q=0 |
|
||
|
j |
|
j ,(q) |
|
j |
|
j ,(qq) |
|
˙ |
|
j |
|
j ,(q) |
|
¨ |
|