Лекции по моделированию Котов Назарова
.pdf
Стр. 11. Моделирование и исследование робототехнических систем. Авторы: Котов Е.А., Назарова А.В.
Структурно-функциональная модель - модель, включающая как
структурные, так и функциональные элементы.
|
|
|
|
|
|
|
В связи с этим может быть |
|
|
|
|
P |
|
введен в рассмотрение обобщенный |
|||
|
|
|
|
|
|
|
структурно-функциональный элемент, |
|
U1 |
|
|
|
|
Y1 |
с помощью которого в наглядном виде |
||
c- ф |
||||||||
|
Um |
Yl |
могут быть представлены сложные |
|||||
|
элемент |
динамические системы. |
||||||
|
|
|
|
|
|
|||
В качестве примера структурно-
функциональной модели может быть рассмотрена ММ работа, состоящая из манипулятора (функциональная модель) и системы приводов (структурное представление).
Функциональная модель:
Основание
|
пр 1 |
1 зв |
|
2 зв |
пр 1 |
|
|
|
пр 1 |
3 зв |
|
Структурное представление: |
|
|
|
Основание |
зв. №1 |
зв. №2 |
зв. №3 |
|
пр. №1 |
пр. №2 |
пр. №3 |
Стр. 12. Моделирование и исследование робототехнических систем. Авторы: Котов Е.А., Назарова А.В.
Взаимосвязь различных форм представления математических моделей
При разработке математических моделей (ММ) часто возникает необходимость перехода от одной формы математического представления систем к другой, в частности, эту задачу приходится решать при завершающей стадии, когда модель ограничивается рамками используемого программного обеспечения. Эта операция имеет свои особенности и ее успешное завершение требует определенных навыков.
Ранее было отмечено, что ММ динамических систем (в том числе РТС и их элементов) могут быть представлены уравнениями состояния,
передаточными функциями и в графо-аналитическом виде (структурно-
функциональные схемы).
Рассмотрим возможные случаи перехода от одной формы к другой.
ММ задана в виде уравнений состояния.
X F u, x, t Y f u, x,t
Структурная схема в общем виде представляется следующим образом: |
|||
U |
X. |
X |
Y |
F(u,x,t) |
|
|
f(u,x,t) |
Для линейной системы:
X Ax Bu
Y Cx Du
Стр. 13. Моделирование и исследование робототехнических систем. Авторы: Котов Е.А., Назарова А.В.
|
|
+ X. |
D |
|
|
|
u |
B |
X |
C |
+ |
Y |
|
|
|
|
A |
|
|
|
Пример № 1.
F 
(u- x1)
x1 x2 J F u x1 x2 Jc F u x2
y x1
На основании приведенных выше уравнений может быть составлена следующая структурная схема:
|
|
|
|
c |
|
|
|
|
|
|
|
J |
x.1 |
|
|
u |
+ |
. |
c |
x2 |
1 |
x1 |
|
- |
+ |
|
|||||
|
z |
Jp |
|
|
p |
(y) |
|
|
|
|
|
|
|
Это ММ упругой механической передачи, учитывающей диссипативные потери и силовой люфт.
u - угол поворота входного вала
x1 - угол поворота выходного вала (выходная координата)
Стр. 14. Моделирование и исследование робототехнических систем. Авторы: Котов Е.А., Назарова А.В.
Z - угол закрутки (упругая деформация)
В результате простых структурных преобразований получим:
|
|
C |
|
1 |
(C p) |
|
J |
Jp |
Jp |
||||
|
|
|
u |
|
|
c+cp |
1 |
1 |
x1 |
|
- |
+ |
|
|||||
z |
Jp |
p |
(y) |
||||
|
|
||||||
|
|
|
|
|
что соответствует привычному представлению.
J - момент инерции
С - коэффициент упругости χ - коэффициент потерь на упругие деформации.
Пример № 2 (для линейных систем).
|
x a x a x b u b u |
|
|
|
|||||||||
|
|
1 |
11 |
1 |
12 |
2 |
11 |
1 |
12 |
|
2 |
|
|
|
x2 a21 x1 a22 x2 b21u1 b22u2 |
|
|
||||||||||
|
|
|
c1 x1 |
c2 x2 |
d1u1 d2u2 |
|
|
|
|
||||
|
y |
|
|
|
|
||||||||
|
d1 |
|
|
|
|
|
|
|
|
|
|
|
|
|
b11 |
|
|
|
|
a11 |
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
x1 |
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
u1 |
b21 |
|
+ |
+ |
|
I |
|
a21 |
|
c1 |
+ |
y |
|
|
|
|
|
|
|
|
|
|
|
|
|||
|
|
|
|
|
|
|
|
|
|
|
+ |
||
u2 |
|
|
|
|
|
|
|
a12 |
x2 |
|
|
|
|
b12 |
|
|
|
|
|
|
|
|
|
|
|||
|
|
+ |
+ |
|
I |
|
|
|
c2 |
+ |
|
||
|
|
|
|
|
|
|
|
||||||
|
b22 |
|
|
|
|
a22 |
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
d2 |
|
|
|
|
|
|
|
|
|
|
|
|
|
В приведенных примерах взаимосвязь X и X решается через операцию |
||||||||||||
интегрирования, возможно решение и через операцию дифференцирования:
Стр. 15. Моделирование и исследование робототехнических систем. Авторы: Котов Е.А., Назарова А.В.
|
|
x ax bu |
|
|
|
|
||
|
|
x 1 x b u |
1 |
x u |
|
|||
|
|
|
a |
a |
a |
|
|
|
u |
b |
- |
+ |
1 |
|
x |
d |
x. |
|
a |
|
|
dt |
y |
|||
|
|
|
|
|
||||
|
|
|
|
|
|
|
|
|
Но такой переход к структурной схеме не является желательным.
Операция “идеального” дифференцирования не может быть точно решена численными методами
/ f (t) f (t t) f (t) , t ? чтобы вычислить t неоходимо знать значение
t
f (t) в последующий момент времени./
/Точно так же не используется (и не реализуется) звено “чистого” дифференцирования в реальных САУ (пример с помехой)/.
Чтобы быстро и правильно перейти от уравнений состояния к структурной схеме, следует начинать с интеграторов, причем, их должно быть столько, каков порядок системы, и далее, в соответствии с уравнениями организовать необходимые связи. Элементы структурных схем следует выбирать такими, которые в используемом программном обеспечении реализуются более эффективными алгоритмами, например
- + |
1 |
1 |
p |
p+k |
k 
Рассмотрим переход от описания линейной системы во временной области к описанию в частотной.
Необходимо определить матричную передаточную функцию W(s),
связывающую вектор u с вектором выхода Y в соответствии с уравнениями.
Стр. 16. Моделирование и исследование робототехнических систем. Авторы: Котов Е.А., Назарова А.В.
Из первого уравнения выразим Х и подставим во второе:
X=(Es-A)-1ВU
Y=[C(Es-A)-1В+D]U, Е - единичная матрица.
Выражение W(s)=C(Es-A)-1B+D и определяет матричную передаточную функцию.
Основная проблема ее вычисления заключается в необходимости обращения матрицы (Es-A). Для этой операции существует ряд алгоритмов,
один из которых (алгоритм Леверье) приведен ниже:
Es A 1 1 s R s ,
где
s sn an 1sn 1 ... a1s a0 ,
где n - порядок системы,
R s sn 1E sn 2 R1 ... Rn 1 , Ri n n
Коэффициенты характеристического полинома ai и матрицы Ri
вычисляются следующим образом:
an k 1k tr ARk 1 Rk ARk 1 an k E,
R0 E, k 1, 2,..., n
/*Проверка правильности вычислений R0≡0./
В некоторых случаях эту задачу можно решить более простыми методами, например,
x a x a x b u |
|
|
||||||
|
1 |
11 |
1 |
12 |
2 |
1 |
|
|
x2 a21x1 a22 x2 b2u |
|
|
||||||
|
|
Определим W s |
X1 s |
|||||
|
|
U s |
, для этого из второго уравнения выразим x2 |
|||||
и подставим в первое, выполнив предварительно преобразование Лапласа для каждого из уравнений.
Стр. 17. Моделирование и исследование робототехнических систем. Авторы: Котов Е.А., Назарова А.В.
x2 s s 1a22 a21 (x1 s b2u s
s2 a22 a11 s a11a22 a12a22 x1 s s b1 a12b2 a22b1 u s
W (s) |
b1 a12b2 a22b1 |
|
|
|||
s2 (a a )s a a a a |
||||||
22 |
11 |
11 |
22 |
12 |
22 |
|
W(s) - скалярная величина, т.к. в системе один вход и один выход/
ММзадана в виде передаточной функции.
Вслучае, если рассматривается ММ с несколькими входами и несколькими выходами (многосвязная система), в основе перехода от описания системы в частотной области к ее описанию во временной лежит задача нахождения матриц А, В, С, D по известной матричной передаточной функции W(s). Но решение этой задачи не является однозначным.
Действительно, если рассмотреть матрицы A, B, C, D, определяемые следующим образом:
A QAQ 1;
BQB;
CCQ 1;
D D;
где Q(nxn) – произвольная невырожденная матрица;
то
C Es A 1 B D CQ 1 QQ 1s QAQ 1 1 QB D
CQ 1 Q Es A Q 1 1 QB D CQ 1QEs A 1Q 1QB D
C Es A 1 B D
(Здесь использовано правило обращения произведения матриц:
A1A2...Ak -1 A-k1A-k1-1...A1-1 )
Стр. 18. Моделирование и исследование робототехнических систем. Авторы: Котов Е.А., Назарова А.В.
Таким образом получено точно такое же выражение для W(s), но
матрицы определяют уже другую математическую модель.
Матрицы А, В, С, D должны определяться из условия реализации W(s)
наименьшего возможного порядка, что означает исключение одинаковых пулей и полюсов из элементов W(s).
На практике часто переход от передаточной функции к записи уравнений во временной области сводится к задаче с одним входом и одним выходом
U W s X
W s |
X s |
|
bm sm bm 1sm 1 |
...b0 |
, |
||
U s |
|
...a |
|||||
|
|
a sn a |
n 1 |
sn 1 |
|
||
|
|
|
n |
|
0 |
|
|
n m
Если имеются одинаковые корни числителя и знаменателя, то порядки
(n; m) понижаются.
Дифференциальное уравнение “n”-ой степени имеет вид:
|
|
a |
|
|
d n x |
a |
|
d n 1x |
... a x b |
|
d mu |
... b u |
||||||||
|
|
|
|
|
|
|
|
|
|
|||||||||||
|
|
|
n dtn |
|
n 1 dtn 1 |
|
0 |
m dtm |
|
0 |
|
|||||||||
|
|
Если ввести обозначения x x; x |
|
x;...; x |
|
d n 1x |
, получим систему: |
|||||||||||||
|
|
|
|
|||||||||||||||||
|
|
|
|
|
|
|
|
|
|
|
|
1 |
2 |
|
|
|
n |
|
dtn 1 |
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
||
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
x2 |
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|||
x1 |
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
||||
x |
x |
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
||
2 |
|
3 |
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
||
.......... |
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|||
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
x |
|
x |
|
|
|
|
|
|
|
|
|
|
|
|
|
|||||
n 1 |
|
|
|
n |
|
|
|
|
|
|
|
|
|
|
|
|
|
|||
|
|
|
|
|
|
|
m |
|
|
|
|
|
|
|
|
|
|
|||
xn |
|
1 |
|
bm |
d u |
|
... b0u an 1xn ... a0 x1 |
|
|
|
|
|||||||||
|
|
m |
|
|
|
|
||||||||||||||
|
|
|
a |
n |
|
|
dt |
|
|
|
|
|
|
|
|
|
|
|
||
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
||||
|
Стр. 19. Моделирование и исследование робототехнических систем. Авторы: Котов Е.А., Назарова А.В. |
|||||||||||||||||||
|
В процессе моделирования является нежелательным вычисление |
|||||||||||||||||||
|
производных от входного сигнала U(t), поскольку они не всегда могут |
|||||||||||||||||||
|
существовать, поэтому такой переход к уравнениям может быть использован |
|||||||||||||||||||
|
корректно при условии bi=0, i=1,...,m. |
|
|
|
|
|
|
|
|
|
|
|||||||||
|
Рассмотрим универсальный переход от передаточной функции к |
|||||||||||||||||||
|
структурной схеме и к уравнениям состояния. |
|
|
|
|
|
||||||||||||||
|
Если n m, дополним числитель многочленом b |
psm 1 ... b psn |
||||||||||||||||||
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
m 1 |
|
|
|
n |
|
с нулевыми коэффициентами |
|
|
|
|
|
|
|
|
|
|
|||||||||
|
a sn x a |
|
sn 1x ... a x b snu b |
|
sn 1u ... b u |
|
|
|
|
|||||||||||
|
n |
|
n 1 |
|
|
|
|
0 |
n |
|
n 1 |
|
|
0 |
|
|
|
|
||
|
x |
1 |
b u a x |
1 |
b u a x |
|
1 |
... b |
u a |
n 1 |
x 1 |
b u |
|
|||||||
|
|
an |
|
0 |
|
0 |
s |
n |
1 |
1 |
s |
n 1 |
|
|
n 1 |
s |
n |
|
||
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
||||
|
На основании последнего выражения представим структурную схему: |
|||||||||||||||||||
|
|
|
a0 |
|
|
an |
|
|
|
|
|
|
an- 1 |
|
|
|
|
|
||
u |
|
- |
|
|
1 |
- |
|
|
1 |
x2 ... |
|
|
1 |
- |
1 |
|
|
1 |
x |
|
|
b0 |
|
+ |
|
S |
x1 |
+ |
S |
|
|
S |
xn- 1 + |
S xn |
+ |
an |
(y) |
||||
|
b1 |
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
. |
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
. |
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
. |
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
bn- 1 |
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
bn |
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
В прямой цепи “n” |
|
интеграторов. |
|
|
|
|
|
|
|
|
|
||||||||
|
Естественно, полученная структурная схема не является единственной |
|||||||||||||||||||
|
реализацией передаточной функции, поскольку любые структурные |
|||||||||||||||||||
|
преобразования приводят к другим схемам. |
|
|
|
|
|
|
|||||||||||||
|
Чтобы перейти к уравнениям состояния, выход “i”-го интегратора на |
|||||||||||||||||||
|
схеме обозначим через хi, и запишем систему уравнений. |
|
|
|
|
|||||||||||||||
Стр. 20. Моделирование и исследование робототехнических систем. Авторы: Котов Е.А., Назарова А.В.
x |
a |
y b u |
|||||
1 |
0 |
0 |
|
||||
x2 x1 a1 y b1u |
|||||||
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
x |
x |
a |
y b u |
||||
n |
|
n 1 |
|
n 1 |
n 1 |
||
an y xn |
bnu |
|
|||||
/ y |
xn |
|
bn |
u / |
|||
|
|
||||||
|
|
an |
|
an |
|
||
x1 |
|
|
0 |
0 |
0 |
|
1 |
0 |
0 |
||
|
|
|
|||
x2 |
|
|
0 |
1 |
0 |
|
|
|
|
|
|
|
|
|
|
|
|
xn |
|
|
0 |
0 |
1 |
|
|
|
A
0, , 0,1 x an y bnu
0 |
|
|
|
|
|
|
|
0 |
|
|
a |
|
b |
|
|
|
|
|
0 |
y |
0 |
u |
|
0 x |
|
|
|||||
|
|
|
|
|
|
|
|
|
a |
|
b |
|
|||
|
|
||||||
|
|
n 1 |
|
|
n 1 |
|
|
0 |
|
|
|
|
|
B |
|
|
|
|
A |
|
|
|
|
|
|
C |
|
|
|
|
0 |
|
|
|
|
|
|
|
|
x1 |
|
|
1 |
|
|||
|
|
|
|
x2 |
|
|
|
|
|
0 |
|
|
|
|
|
xn |
|
|
|
|
|
|
|
|
|
|
0 |
|
|
|
|
|
|
|
|
0 |
0 |
|
a0 |
|
|
|||
an |
|
|||||||
|
|
|
|
|||||
|
|
|
|
|
||||
0 |
0 |
|
a1 |
|
|
|||
|
|
|||||||
an |
||||||||
|
|
|
|
|
||||
|
|
|
a |
2 |
|
x |
||
1 |
0 |
|
|
|
||||
an |
||||||||
|
|
|
|
|
||||
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
0 |
1 |
|
an 1 |
|
||||
|
|
|||||||
|
|
|
|
an |
||||
|
|
|
|
|
||||
|
|
|
A |
|
|
|
1 |
|
|
|
|
y 0, , 0, |
x |
bn |
u |
||
|
|
||||
|
an |
an |
|||
C |
|
|
|
D |
|
|
b0 |
a0 |
bn |
|
|
|||
|
|
|
|
|
||||
an |
||||||||
|
|
|
|
|
|
|||
|
b0 |
a0 |
bn |
|
|
|||
|
|
|
|
|
||||
an |
||||||||
|
|
|
|
|
u |
|||
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
b |
a |
|
|
bn |
|||
|
n 1 |
|
|
|
||||
n 1 |
|
|
|
|||||
|
|
|
|
|
an |
|||
B
x Ax Buy Cx Du
