Модель наблюдателя с использованием алгоритма оптимального размещения полюсов и ее применение в задачах управления космическим аппаратом - page 10

Н.Е. Зубов, Е.А. Микрин, В.Н. Рябченко
10
ˆ
ˆ
ˆ
( ) ( ) ( ), ( )
( )
( ), ( ) ( ) ( ),
ˆ
ˆ
ˆ
( ) ( ) ( ), ( )
( )
( ), ( ) ( ) ( ).
x
y
z
x
y
z
n n n
n n n
n n n
n n n
n n n
n n n
ε = γ − γ
ε = ψ − ψ ε = θ − θ
ε = γ − γ
ε = ψ − ψ ε = θ − θ
Тогда при решении этой же задачи методом точного размещения
полюсов согласно [5] имеем
(
)
(
)
1
1
2
1
2
2
11 1
11 3
12 5
2 5
11
12
2
5
3
3
11
4
ˆ
ˆ
ˆ
( 1)
( )
( ) ( 1)( ( 1))
( 1),
ˆ
ˆ
ˆ
ˆ
ˆ
( 1)
( )
( )
( )
( )
(
2) ( 1)
( 1)
( 1),
1 1
ˆ
ˆ
( 1)
( )
( 1),
ˆ ( 1)
x
x
x
x
y
x
x n
x n hx n s
n
h n
x n
x n K hx n K hx n K hx n
s s
n
hK n
hK n
s
s
x n
x n
n
hK
x n
+ = +
+ − ε + − ε +
+ = +
+
+ + − ε + − ε + + ε +
− −
+ = +
ε +
+
(
)
(
)
4
5
3
5
5
22 4
21 2
22 6
4 6
22
21
4
6
6
6
22
7
7
ˆ
ˆ
( )
( ) ( 1) ( 1)
( 1),
ˆ
ˆ
ˆ
ˆ
ˆ
( 1)
( )
( )
( )
( )
(
2) ( 1)
( 1)
( 1),
1 1
ˆ
ˆ
( 1)
( )
( 1),
ˆ
ˆ
( 1)
( )
y
y
y
y
x
y
x n hx n s
n
h n
x n
x n K hx n K hx n K hx n
s s
n
hK n
hK n
s
s
x n
x n
n
hK
x n
x n hx
= +
+ − ε + − ε +
+ = +
+
+
+ − − ε + − ε + − ε +
− −
+ = +
ε +
+ = +
(
)
8
0
8
8
33 7
33 9
1
2
33
1
2
9
9
33
( ) ( 1) ( 1)
( 1),
ˆ
ˆ
ˆ
ˆ
( 1)
)
( )
( )
(
2) ( 1)
( 1),
(
1)
1
ˆ
ˆ
( 1)
( )
( 1),
z
z
z
z
z
n s
n
h n
x n
x n K hx n K hx n
ss ss
n
hK n
ss
ss
x n
x n
n
hK
+ − ε + − ε +
+ = +
+
+ + − ε + − ε +
+ = +
ε +
(
(22)
Для того чтобы также обеспечить максимально быструю сходи-
мость с использованием решения, полученного в (22) [5], необходимо
поставить значения корней
s
1
=
s
2
=
s
3
=
s
4
=
s
5
=
s
6
=
s
0
=
ss
1
=
ss
2
= 0,
и тогда система (21) запишется так:
1
1
2
2
2
11 1
11 3
12 5
11
12
3
3
11
4
ˆ
ˆ
ˆ
( 1)
( )
( )
( 1)
( 1),
ˆ
ˆ
ˆ
ˆ
ˆ
( 1)
( )
( )
( )
( ) 2 ( 1)
( 1)
( 1),
5
ˆ
ˆ
( 1)
( )
( 1),
ˆ ( 1)
x
x
x
x
y
x
x n
x n hx n
n
h n
x n
x n K hx n K hx n K hx n
n
hK n
hK n
x n
x n
n
K
x n
+ = +
+ ε + − ε +
+ = +
+ ε + −
− ε + + ε +
+ = + ε +
+ =
4
5
5
5
22 4
21 2
22 6
22
21
ˆ
ˆ
( )
( )
( 1)
( 1),
ˆ
ˆ
ˆ
ˆ
ˆ
( 1)
( )
( )
( )
( ) 2 ( 1)
( 1)
( 1),
y
y
y
y
x
x n hx n
n
h n
x n
x n K hx n K hx n K hx n
n
hK n
hK n
+
+ ε + − ε +
+ = +
+
+ ε + −
− ε + − ε +
(23)
1,2,3,4,5,6,7,8,9 11,12
Powered by FlippingBook