(7.12)
(7.13)
(7.14)
(7.15)
(7.16)
(7.17)
(7.18)
(7.19)
(7.20)
R
i
)
-1
ν
i
=
z
i
-
H
i
x
i/i-1
^
да
нет
x
i / i - 1
=
Ф
i
x
i-1 / i-1
^ ^
P
i
/i-1
= Ф
i
P
i-1/ i-1
Ф
T
i
+ Г
i
Q
i-1
Г
T
i
Прогноз:
Коррекция
x
i/i
=
x
i/i-1
+ K
i
ν
i
^ ^
P
i
/
i
=
(
K
i
H
i
-
E)P
i
/
i
-1
(K
i
H
i
-E)
Т
+K
i
R
i
K
i
Т
P
-1
i/i
=
H
T
i
R
-1
i
H
i
+ Φ
-T
i
P
-1
i-1/i-1
Ф
-1
i
Обработка данных в “обратном” времени
K
i/N
=
P
i/N
T
T
P
-1
i/i
ν
i/N
=
T x
(i/i+1)N
-
x
i/i
^ ^
x
(i / i+1)N
=
Ф
-1
i/N
x
(i+1 / i+1
)N
^ ^
P
-1
i
/N
=Ф
T
i/N
(P
i+1/N
+Г
i
Q
i-
1
Г
i
T
)
-1
Ф
i/N
+T
T
P
-1
i/i
T
Интерполяция
Коррекция:
x
(i/i)N
=
x
(i/i+1)N
- K
i/N
ν
i/N
^ ^
P
-1
i
=
U
-T
i
D
-1
i
U
-1
i
ν
i/N
=
U
-1
i
ν
i/N
~
Регистрация
J
j(i)
=
J
j-1(i)
+
ν
2
j(i/N)
/ D
j(i)
~ ~ ~
d
j
=
J
j(i)
-
γ
2
j
~
e
j
>
0
да
нет
j:
=
j
+ 1
j
>
n
yes
no
ν
i/N
;
~
γ
2
j
Отказ
Сбой
x
i/i
^
P
i/i
P
-1
i/i
Диагностирование
e
j
=
F
j(i)
-
η
2
j
η
2
j
P
-1
i
=
P
-1
i/i
- P
-1
i/i
T
P
i
/N
T
T
P
-1
i/i
D
i
;
j = 1
J
0(i)
=0
;
~
i
:
=i - 1
Ф
i
Ф
-1
i
F
j(i)
=
Δ
D
j(i)
/ D
j(i)
Регистрация
^
Декомпозиция:
- вектор ошибок ИНС
- матрица связи наблюдения с вектором ошибок ИНС
= H(t)x(t)+ ϑ(t) – наблюдение и его модель
t, s
t, s
t, s
Гироскоп wх, o/h
error
estimation error
(filtering)
estimation error
(smoothing)
t, s
t, s
t, s
×0.01
3
0
-3
Если не удалось найти и скачать презентацию, Вы можете заказать его на нашем сайте. Мы постараемся найти нужный Вам материал и отправим по электронной почте. Не стесняйтесь обращаться к нам, если у вас возникли вопросы или пожелания:
Email: Нажмите что бы посмотреть