Рекуррентный алгоритм вычисления коэффициентов уравнений динамики в замкнутой форме космического манипулятора - page 7

Рекуррентный алгоритм вычисления коэффициентов уравнений динамики…
7
Продолжение табл.
Вектор, матрица
Число
умножений
сложений
( )
j
j
j
j
=
c τ c
т
9
N
6
N
( )
j
j
j
j j
=
I τ I τ
т
54
N
36
N
Всего для общих соотношений
147
N
99
N
Всего операций для общих соотношений
246
N
Матричная запись уравнений Кейна
1
rel
j
j
j
= +
R R R
0
3
N
2
1
1
1,
j
j
j
j
j
= +
T T r R
т
9
N
2
9
N
2
{
}
1
( )
[
]
N
j
j
j
j
j
j
j
j
j
j
j
j
j
m
=
=
+
+
+
+
A q
T T T c R
T c R R I R
т
т т
т т
т
т
9
N
3
+21
N
2
7
N
3
+13
N
2
Всего для уравнений Кейна
9
N
3
+30
N
2
7
N
3
+25
N
2
Всего операций для уравнений Кейна
16
N
3
+55
N
2
+246
N
Рекуррентный алгоритм
,
, 1
1,
,
1,
1;
,
1
i j
i i
i
j
i
N j N i
+
+
= +
= − = +
r r
r
0
1,5
N
2
–1,5
N
*
,
,
,
1,
1;
,
1
j
i j
i j
j
m
i
N j N i
=
+ = − = +
c
r c
1,5N
2
–1,5N
1,5
N
2
–1,5
N
1
,
1, 1
j
j
j
m m m j N
+
= +
= −
0
N
–1
, 1
, 1
, 1
1
,
1, 1
j
j
j
j N
∑ ∑
+
= +
= −
I
I
I
,
0
9
N
–9
, 2
,
,
,
*
(
),
1, 1
N i N
i N
i N
m
i N
=
= −
I
r r
 
т
21
N
–21
6
N
–6
, 2
,2
,
,
,
, 1
(
)
,
2, 1,
* 1,
1
j
i j
i j
i j
i j
m
i N
j N i
+
=
+
= −
= − +
I
r r
I
 
т
10,5
N
2
–31,5
N
+21
7,5
N
2
–22,5
N
+15
, 3
*
, ,
,
,
,
2, 1,
*
1,
1,
i j N i N j N
i N
j N i
k N
=
= −
= − + =
I
c r
 
т
6
N
2
–8
N
+12
3
N
2
–9
N
+6
1,2,3,4,5,6 8,9,10
Powered by FlippingBook