Professional Documents
Culture Documents
Określenie Współrzędnych Pozycji Z Niejednoczesnych Pomiarów Parametrów Nawigacyjnych
Określenie Współrzędnych Pozycji Z Niejednoczesnych Pomiarów Parametrów Nawigacyjnych
ANDRZEJ BANACHOWICZ
Katedra Nawigacji
WSTĘP
5
pozycyjna”. Oczywiście, w przypadku przestrzeni dwuwymiarowej (płaszczyzna,
sfera lub powierzchnia elipsoidy) zredukuje się ona do izolinii pozycyjnej,
zaś w przypadku przestrzeni trójwymiarowej (np. X, Y, Z lub ϕ, λ, h) do
powierzchni pozycyjnej.
Praktycznie zawsze mamy do czynienia z niejednoczesnymi pomiarami
parametrów nawigacyjnych. Wywołane jest to następującymi przyczynami:
• ruchem statku (sensora, odbiornika),
• ruchem znaku nawigacyjnego (np. satelity),
• uwarunkowaniami technicznymi (praca stacji systemu radionawigacyjnego
w łańcuchu, jednokanałowy tor pomiarowy odbiornika, sekwencyjny cykl
pomiarowy, pomiary asynchroniczne z poszczególnych urządzeń nawi-
gacyjnych).
W klasycznej nawigacji problem niejednoczesności pomiarów parametrów
nawigacyjnych jest zazwyczaj pomijany. Przyjmuje się bowiem, że błędy
powstające w ten sposób są pomijalnie małe. Wyjątkiem jest określanie pozycji
z niejednoczesnych linii pozycyjnych w nawigacji terrestrycznej i astro-
nawigacji, gdy różnica momentów czasu jest duża. W przypadku bowiem
nawigacji zautomatyzowanej lub zintegrowanej, przy jej dużej precyzji, nawet
niewielkie różnice czasu przekładają się na dość istotne błędy współrzędnych
pozycji lub niestabilność estymatora [6]. Dlatego też w algorytmach obróbki
danych nawigacyjnych należy uwzględniać niejednoczesność wykonywania
pomiarów.
f : R m ⊃ N → U ⊂ R n , n ≥ m, (1)
gdzie:
R – przestrzeń rzeczywista,
N – przestrzeń nawigacyjna,
U – przestrzeń pomiarów,
m – wymiar przestrzeni nawigacyjnej,
6
n – wymiar przestrzeni pomiarów.
Odwzorowanie to ma postać poniższego układu równań:
f1 ( x1 , x2 ,, xm ) − u1 = 0,
f 2 ( x1 , x2 ,, xm ) − u2 = 0,
.......................................... , (2)
f n ( x1 , x2 ,, xm ) − un = 0,
gdzie:
xi – i-ta współrzędna pozycji,
ui – zmierzony parametr nawigacyjny (namiar, różnica odległości, pseudoodległość).
gdzie:
x = [x1, x2, ... , xm]T – uogólniony wektor współrzędnych pozycji (wektor stanu), w
zależności od przyjętego układu współrzędnych (X, Y, Z, ∆t lub
ϕ, λ, h, ∆t), x ∈ N,
u = [u1, u2, ... , un]T – wektor zmierzonych parametrów nawigacyjnych, u ∈ U.
x ( k +1) = x ( k ) + G −1 (x ( k ) )z ( k ) , (4)
z ( k ) = u − f (x ( k ) ) , (5)
[ ]−1
x ( k +1) = x ( k ) + G T (x ( k ) )Pu-1G (x ( k ) ) G T (x ( k ) )Pu−1z ( k ) , (6)
7
gdzie Pu – macierz kowariancji wektora zmierzonych parametrów pozycyjnych u.
Wektor z jest określony wzorem (5). Formalnie rzecz biorąc, macierz Pu
to macierz kowariancji wektora z. Ponieważ wektor ten jest różnicą wektorów,
zgodnie z zależnością (5), a wektor f(x), będący wynikiem obliczeń, został
określony z dowolną dokładnością (bowiem jest to wektor nielosowy),
to możemy przyjąć, że macierz kowariancji wektora u jest równa macierzy
kowariancji wektora z.
Dalsze obliczenia prowadzimy drogą kolejnych iteracji, aż do osiągnięcia
założonej dokładności obliczeń współrzędnych. Jeżeli proces iteracyjny (4) lub
(6) jest zbieżny do rzeczywistego rozwiązania x, to oszacowanie dokładności
obliczania współrzędnych pozycji jest w przybliżeniu równe obliczonej w
ostatnim kroku wartości drugiego składnika (4) lub (6). Fakt ten często
wykorzystuje się do oceny zakończenia (stopu) procesu iteracji. Za pierwsze
przybliżenie przyjmujemy zazwyczaj pozycję zliczoną lub poprzednią pozycję
obserwowaną. W obu przypadkach, tj. metody Newtona lub metody naj-
mniejszych kwadratów, macierz kowariancji wektora stanu (współrzędnych
pozycji) obliczamy z poniższego wzoru [3, 4]:
(
Px = G T (x ( k ) )Pu−1G (x ( k ) ) )
−1
. (7)
u p = u + ∆u, (8)
8
gdzie wektor prognozy przyrostów wartości nawigacyjnych parametrów
pozycyjnych:
n
∆u = ∑ ∆u i , (9)
i =1
∆u i = e iT ⋅ gradf i ⋅ ∆x (i ) , (10)
ei = 0,0,...,0,1,0,...,0
i , (11)
∂f ∂f ∂f
gradf i = i , i ,..., i , (12)
∂x1 ∂x2 ∂xm
[
∆x = ∆x1i , ∆x2i ,..., ∆xmi T. ] (13)
[
x(k +1) = x(k) + G −1(x(k)) u + ∆u − f (x(k)) ] (14)
[ ]
−1
[ ]
x ( k +1) = x ( k ) + G T (x ( k ) )Pp-1G (x ( k ) ) G T (x ( k ) )Pp−1 u + ∆u − f (x ( k ) ) . (15)
9
Z twierdzenia o wartości średniej i macierzy kowariancji iloczynu
macierzy stałych przez wektor losowy otrzymamy następujące wzory na
wartość średnią wektora przyrostu współrzędnych pozycji (przybliżenie
początkowe w iteracjach przyjęte jest z dowolnie małymi błędami):
(
Px = G T (x ( k ) )Pp−1G (x ( k ) ) , )
−1
(17)
z (pk ) = u p − f (x ( k ) ) , (18)
n n n n
Pp = Pu + ∑ P∆u i + ∑ (Pu∆u i + PuT∆u i ) + ∑∑ P∆u i ∆u j , (19)
i =1 i =1 i =1 j =1
i≠ j
n n
∑ P∆u = ∑ eiT ⋅ gradf i ⋅ P∆x (gradf i )T ⋅ ei ,
i i
(20)
i =1 i =1
10
(
P∆ui ∆u j = e iT ⋅ gradf i ⋅ P∆xi ∆x j gradf j )
T
⋅ej , (21)
n n n
Pp = Pu + ∑ P∆u i + ∑∑ P∆u i ∆u j . (22)
i =1 i =1 j =1
i≠ j
x = [ϕ, λ, h, ∆t] T ,
gdzie:
ϕ – szerokość geodezyjna,
λ − długość geodezyjna,
h – wysokość geodezyjna (wysokość elipsoidalna),
11
∆t – błąd zegara odbiornika GPS,
∂d ∂d ∂d
d1 + 1 ∆ϕ1 + 1 ∆λ1 + 1 ∆h1 − d z1
∂ϕ ∂λ ∂h
∂d ∂d ∂d
d 2 + 2 ∆ϕ 2 + 2 ∆λ2 + 2 ∆h2 − d z2
∂ϕ ∂λ ∂h
∂d k ∂d k ∂d k
dk + ∆ϕ k + ∆λ k + ∆hk − d zk
zp = ∂ϕ ∂λ ∂h ,
∂∆d1 ∂∆d1 ∂∆d1
∆d1 + ∂ϕ ∆ϕ k +1 + ∂λ ∆λk +1 + ∂h ∆hk +1 − ∆d z1
∆d + ∂∆d 2 ∆ϕ + ∂∆d 2 ∆λ + ∂∆d 2 ∆h − ∆d
k +2 k +2 k +2
2 ∂ϕ ∂λ ∂h
z2
∆d m − ∆d zl
gdzie:
di − zmierzona i-ta pseudoodległość,
d zi − obliczona i-ta pseudoodległość,
∆ϕ i , ∆λi , ∆hi − przyrosty współrzędnych geodezyjnych pomiędzy i-tym momen-
tem a n-tym (moment, do którego sprowadzamy wszystkie
pomiary), otrzymane ze zliczenia,
∂d i , ∂d i , ∂d i − pochodne cząstkowe i-tej pseudoodległości (funkcji nawigacyj-
∂ϕ ∂λ ∂h
nej) względem współrzędnych geograficznych,
∆d i − zmierzona i-ta różnica odległości (hiperbola),
∆d zi − obliczona i-ta różnica odległości (hiperbola),
∂∆d i , ∂∆d i , ∂∆d i − pochodne cząstkowe i-tej hiperboli (funkcji nawigacyjnej)
∂ϕ ∂λ ∂h
względem współrzędnych geograficznych,
12
∂d 1 ∂d 1 ∂d 1 ∂d 1
∂ϕ ∂λ ∂h ∂∆t
∂d k ∂d k ∂d k ∂d k
∂ϕ ∂λ ∂h ∂∆t ,
G=
∂∆d 1 ∂∆d 1
0 0
∂ϕ ∂λ
∂∆d l ∂∆d l
0 0
∂ϕ ∂λ
σ d2 σ d1d k 0 0
1
σ σ 2
0 0
Pu = d1d k dk
,
0 0 0 σ 2
∆d 1 σ ∆d1∆d l
0 0 0 σ ∆d1∆d l σ ∆2d l
gdzie:
σ d2 − wariancja pseudoodległości di,
i
σ 2
∆d i
− wariancja różnicy odległości ∆di,
σ ∆d ∆d − kowariancja pomiędzy różnicami odległości ∆di i ∆dj,
i j
σ ∆2ϕi σ ∆ϕ ∆λ σ ∆ϕ ∆h σ ∆ϕ ∆t
i i i i i i
σ ∆ϕ ∆λ σ ∆2λ σ ∆λ ∆h σ ∆λ ∆t
i i
P∆x i = i i i i i
,
σ ∆ϕ ∆h σ ∆λ ∆h σ ∆2h σ ∆h ∆t
i i i i i i i
σ ∆ϕi ∆ti σ ∆λ ∆t i i
σ ∆h ∆ti i
σ ∆2t i
13
σ ∆ϕi ∆ϕ j σ ∆ϕ ∆λ σ ∆ϕ ∆h σ ∆ϕ ∆t
σ
i j i j i j
σ ∆λ ∆λ σ ∆λ ∆h σ ∆λ ∆t j
= i j
∆λ ∆ϕ i j i j i
P∆x i ∆x j .
σ ∆hi ∆ϕ j σ ∆h ∆λ σ ∆h ∆h σ ∆h ∆t
i j i j i j
σ ∆ti ∆ϕ j σ ∆t ∆λ
i j
σ ∆t ∆h
i j
σ ∆t ∆t
i j
d k + 2 + ∂d k + 2 ∆ϕ k + 2 + ∂d k + 2 ∆λk + 2 − d z
∂ϕ ∂λ k +2
d k + l − d z k +l
14
∂d1 ∂d1 ∂d1 ∂d1
∂ϕ ∂λ ∂h ∂∆t
∂d k ∂d k ∂d k ∂d k
∂ϕ ∂λ ∂h ∂∆t .
G=
∂d ∂d k +1 ∂d k +1
k +1 0
∂ϕ ∂λ ∂∆t
∂d k + l ∂d k + l
0
∂d k + l
∂ϕ ∂λ ∂∆t
4. WNIOSKI
LITARATURA
15
2. BANACHOWICZ A., Metody integracji nawigacyjnego stadiometrycznego systemu satelitar-
nego z nawigacją zliczeniową, Zeszyty Naukowe Akademii Marynarki Wojennej, nr 1, 1990.
3. BANACHOWICZ A., Sekwencyjna metoda obliczania pozycji z niejednoczesnych pomiarów
parametrów nawigacyjnych, Zeszyty Naukowe Akademii Marynarki Wojennej, nr 4, 1990.
4. BANACHOWICZ A., Błąd systematyczny współrzędnych pozycji w przypadku wykorzystania
minimalnej liczby pomiarów nawigacyjnych, Geodezja i Kartografia, nr 2, 1994.
5. DEMIDOVICh B.P., MARON I.A., Computational Mathematics, Mir Publisher, Moscow 1987.
6. KAMIŃSKI R., Wiarygodność zintegrowanego systemu nawigacyjnego, Rozprawa doktorska,
Wyższa Szkoła Morska, Szczecin 2002.
7. LAST D., Is Loran-C the Answer to GPS Vulnerability?, European Journal of Navigation, Vol. 1,
No 3, December 2003.
8. VANIČEK P., KRAKIWSKY E.J, Geodesy: the concepts, 2nd Ed. North Holland, Amsterdam
1986.
16