kalman robsa


Overview

Dane+wyr(t1)
Wyr.łączne (t1 i t2)
Filtr Kalmana


Sheet 1: Dane+wyr(t1)

Wyznaczenie błędów prawdziwych obserwacji - czas t1




Wyznaczenie błędów prawdziwych obserwacji - czas t2




















obs Dystrybuanta ε N(0,1) Ilość stanowisk ε N(0,σ)









obs Dystrybuanta ε N(0,1) Ilość stanowisk ε N(0,σ)










h1 0,87 1,12 2 0,16









h1 0,93 1,50 2 0,21
h2 0,42 -0,20 3 -0,03









h2 0,55 0,13 3 0,02
h3 0,52 0,05 3 0,01









h3 0,64 0,37 3 0,06
h4 0,01 -2,20 2 -0,31









h4 0,73 0,61 5 0,14
h5 0,77 0,75 3 0,13









h5 0,37 -0,34 3 -0,06
h6 0,48 -0,05 3 -0,01









h6 0,07 -1,45 3 -0,25
h7 0,47 -0,07 4 -0,01









h7 0,97 1,86 4 0,37










































































0,98















Kryteria graniczne spełnione











1,10















Kryteria graniczne spełnione



























































Czas pomiaru
σ0












t1 0 [rok]
0,1 mm










0,8 1,2

t2 0,5 [rok]






































0,8 1,2







Pomiar aktualny - t2
Wartości prawdziwe






























Nr P K hi' (t2) [m] hi' (t2) + ε
Reper Hi (t1) [m] Hi' (t2) [m]























1 A 1 #N/A #N/A
A 102,668 102,6680
V1 4,7 [mm/rok]







2 1 2 -3,3713 -3,3713
B 101,794 101,7940
V2 5,3 [mm/rok]







3 2 3 -1,9408 -1,9407
1 104,638 104,6357
V3 4,9 [mm/rok]







4 2 B #N/A #N/A
2 101,267 101,2644











5 3 B #N/A #N/A
3 99,326 99,3236











6 B 1 #N/A #N/A















7 A 3 #N/A #N/A




















Pomiar wyjściowy - t1

































Nr P K hi (t1) [m] hi (t1) + ε





























1 A 1 #N/A #N/A














2 1 2 -3,3710 -3,3710














3 2 3 -1,9410 -1,9410














4 1 3 -5,3120 -5,3123














5 3 B #N/A #N/A














6 B 1 #N/A #N/A














7 A 3 #N/A #N/A























































ε V + ε


































V1 0,53 5,2 [mm/rok]















V2 0,64 5,9 [mm/rok]















V3 0,45 5,4 [mm/rok]









































































































































































































































































































































































































































































A B 1 2 3











a
l [mm] mi








obs p k dA dB dh1 dh2 dh3

hi obs. hi przyb.





1 A 1 -1 0 1 0 0
#N/A 0,14
[m] [m]





2 1 2 0 0 -1 1 0
-0,03 0,17
#N/A #N/A





3 2 3 0 0 0 -1 1
0,01 0,17
-3,3710 -3,3710





4 1 3 0 0 -1 0 1
-0,31 0,14
-1,9410 -1,9410





5 3 B 0 1 0 0 -1
#N/A 0,17
-5,3123 -5,3120





6 B 1 0 -1 1 0 0
#N/A 0,17
#N/A #N/A





7 A 3 -1 0 0 0 1
#N/A 0,20
#N/A #N/A

















#N/A #N/A

























A











Nr p k dA dB dh1 dh2 dh3
L









1 A 1 -7,0711 0 7,0711 0 0 0 #N/A









2 1 2 0 0 -5,7735 5,7735 0 0 -0,2010









3 2 3 0 0 0 -5,7735 5,7735 0 0,0502









4 1 3 0 0 -7,0711 0 7,0711 0 -2,2042









5 3 B 0 5,7735 0 0 -5,7735 0 #N/A









6 B 1 0 -5,7735 5,7735 0 0 0 #N/A









7 A 3 -5,0000 0 0 0 5,0000 0 #N/A

































































































































ATA











Nr dA dB dh1 dh2 dh3 ST

ATL








1 75,0000 0 -50,0000 0 -25,0000 1 0

#N/A








2 0 66,6667 -33,3333 0 -33,3333 0 1

#N/A








3 -50,0000 -33,3333 166,6667 -33,3333 -50,0000 0 0

#N/A








4 0 0 -33,3333 66,6667 -33,3333 0 0

#N/A








5 -25,0000 -33,3333 -50,0000 -33,3333 141,6667 0 0

#N/A








S 1 0 0 0 0 0 0











0 1 0 0 0 0 0



















































(ATA) -1











Nr dA dB dh1 dh2 dh3 ST











1 2,96059473233375E-18 0 0 1,48029736616688E-18 0 1 9,47390314346801E-17











2 -1,4008674017375E-18 0 0 0 0 0 1











3 4,31924491549732E-19 0 0,0087 0,0067 0,0047 0,5534 0,4466











4 1,63973473418546E-18 0 0,0067 0,0221 0,0076 0,5243 0,4757











5 4,04207411878091E-19 0 0,0047 0,0076 0,0105 0,4951 0,5049











S 1 0 0,5534 0,5243 0,4951 -34,9515 34,9515











1,21262223563427E-16 1 0,4466 0,4757 0,5049 34,9515 -34,9515
























































































































































X σdh
V v
VTV #N/A
VTA
VTV VTL





dhA #N/A #N/A
#N/A #N/A
VTL #N/A
#N/A
#N/A #N/A





dhB #N/A #N/A
#N/A #N/A



#N/A








dh1 #N/A #N/A
#N/A #N/A
u kryt

#N/A








dh2 #N/A #N/A
#N/A #N/A
2

#N/A








dh3 #N/A #N/A
#N/A #N/A



#N/A












#N/A #N/A














Hi wyr [m]

#N/A #N/A













A #N/A

















B #N/A



Test lokalny








1 #N/A
Warunek
Obs V σ |u| |u|<ukryt.








2 #N/A
(σ0) ≤ (σ0) kryt
1 #N/A 0,75 #N/A #N/A








3 #N/A
#N/A
2 #N/A 0,65 #N/A #N/A














3 #N/A 0,65 #N/A #N/A








Test globalny



4 #N/A 0,71 #N/A #N/A









Nr. hi wyr. (t1) [m]
5 #N/A 0,81 #N/A #N/A








σ0^ #N/A

6 #N/A 0,84 #N/A #N/A








σ0 kryt 1,54
1 #N/A
7 #N/A 0,86 #N/A #N/A











2 #N/A

















3 #N/A

















4 #N/A
Wyniki - T1












5 #N/A













6 #N/A

















7 #N/A






















































































































































































































1 0 0 0 0 0 0 0,563106796116505 0,083235088347001 0,083235088347001 0,203883495145631 0,190251630507431 -0,356721807201434 -0,164762745130846





0 1 0 0 0 0 0 0,083235088347001 0,41747572815534 0,41747572815534 -0,202142357414146 0,097087378640777 0,067961165048544 -0,084080136289751





0 0 1 0 0 0 0 0,083235088347001 0,41747572815534 0,41747572815534 -0,202142357414146 0,097087378640777 0,067961165048544 -0,084080136289751





0 0 0 1 0 0 0 0,203883495145631 -0,202142357414146 -0,202142357414146 0,504854368932039 0,237814538134289 0,166470176694003 -0,205953431413557





0 0 0 0 1 0 0 0,190251630507431 0,097087378640777 0,097087378640777 0,237814538134289 0,650485436893204 0,155339805825243 0,302688490643105





0 0 0 0 0 1 0 -0,356721807201434 0,067961165048544 0,067961165048544 0,166470176694002 0,155339805825243 0,70873786407767 -0,134528218063602





0 0 0 0 0 0 1 -0,164762745130846 -0,084080136289751 -0,084080136289751 -0,205953431413558 0,302688490643105 -0,134528218063602 0,737864077669903






Sheet 2: Wyr.łączne (t1 i t2)

a










Nr p k dA (t1) dB (t1) dh1 (t1) dh2 (t1) dh3 (t1) dA (t2) dB (t2) dh1 (t2) dh2 (t2) dh3 (t2)
l [mm] mi
hi obs. hi przyb.




1 A 1 -1 0 1 0 0 0 0 0 0 0
#N/A 0,14
#N/A #N/A




2 1 2 0 0 -1 1 0 0 0 0 0 0
-0,03 0,17
-3,3710 -3,3710




3 2 3 0 0 0 -1 1 0 0 0 0 0
0,01 0,17
-1,9410 -1,9410




4 1 3 0 0 -1 0 1 0 0 0 0 0
-0,31 0,14
-5,3123 -5,3120




5 3 B 0 1 0 0 -1 0 0 0 0 0
#N/A 0,17
#N/A #N/A




6 B 1 0 -1 1 0 0 0 0 0 0 0
#N/A 0,17
#N/A #N/A




7 A 3 -1 0 0 0 1 0 0 0 0 0
#N/A 0,20
#N/A #N/A




8 A 1 0 0 0 0 0 -1 0 1 0 0
#N/A 0,14
#N/A #N/A




9 1 2 0 0 0 0 0 0 0 -1 1 0
0,02 0,17
-3,3713 -3,3713




10 2 3 0 0 0 0 0 0 0 0 -1 1
0,06 0,17
-1,9407 -1,9408




11 2 B 0 0 0 0 0 0 1 0 -1 0
#N/A 0,22
#N/A #N/A




12 3 B 0 0 0 0 0 0 1 0 0 -1
#N/A 0,17
#N/A #N/A




13 B 1 0 0 0 0 0 0 -1 1 0 0
#N/A 0,17
#N/A #N/A




14 A 3 0 0 0 0 0 -1 0 0 0 1
#N/A 0,20
#N/A #N/A




15 - - 0 0 1 0 0 0 0 -1 0 0
0,26 0,53
[m] [m]




16 - - 0 0 0 1 0 0 0 0 -1 0
0,32 0,64







17 - - 0 0 0 0 1 0 0 0 0 -1
0,23 0,45































A










Nr p k dA (t1) dB (t1) dh1 (t1) dh2 (t1) dh3 (t1) dA (t2) dB (t2) dh1 (t2) dh2 (t2) dh3 (t2)
L








1 A 1 -7,0711 0 7,0711 0 0 0 0 0 0 0
#N/A








2 1 2 0 0 -5,7735 5,7735 0 0 0 0 0 0
-0,2010








3 2 3 0 0 0 -5,7735 5,7735 0 0 0 0 0
0,0502








4 1 3 0 0 -7,0711 0 7,0711 0 0 0 0 0
-2,2042








5 3 B 0 5,7735 0 0 -5,7735 0 0 0 0 0
#N/A








6 B 1 0 -5,7735 5,7735 0 0 0 0 0 0 0
#N/A








7 A 3 -5,0000 0 0 0 5,0000 0 0 0 0 0
#N/A








8 A 1 0 0 0 0 0 -7,0711 0 7,0711 0 0
#N/A








9 1 2 0 0 0 0 0 0 0 -5,7735 5,7735 0
0,1257








10 2 3 0 0 0 0 0 0 0 0 -5,7735 5,7735
0,3662








11 2 B 0 0 0 0 0 0 4,4721 0 -4,4721 0
#N/A








12 3 B 0 0 0 0 0 0 5,7735 0 0 -5,7735
#N/A








13 B 1 0 0 0 0 0 0 -5,7735 5,7735 0 0
#N/A








14 A 3 0 0 0 0 0 -5,0000 0 0 0 5,0000
#N/A








15 - - 0 0 1,8868 0 0 0 0 -1,8868 0 0
0,5000








16 - - 0 0 0 1,5625 0 0 0 0 -1,5625 0
0,5000








17 - - 0 0 0 0 2,2222 0 0 0 0 -2,2222
0,5000
















































































ATA








Nr dA (t1) dB (t1) dh1 (t1) dh2 (t1) dh3 (t1) dA (t2) dB (t2) dh1 (t2) dh2 (t2) dh3 (t2) ST
ATL






1 75,00 0,00 -50,00 0,00 -25,00 0,00 0,00 0,00 0,00 0,00 1 0 0 0
#N/A






2 0,00 66,67 -33,33 0,00 -33,33 0,00 0,00 0,00 0,00 0,00 0 1 0 0
#N/A






3 -50,00 -33,33 170,23 -33,33 -50,00 0,00 0,00 -3,56 0,00 0,00 0 0 0 0
#N/A






4 0,00 0,00 -33,33 69,11 -33,33 0,00 0,00 0,00 -2,44 0,00 0 0 0 0
#N/A






5 -25,00 -33,33 -50,00 -33,33 146,60 0,00 0,00 0,00 0,00 -4,94 0 0 0 0
#N/A






6 0,00 0,00 0,00 0,00 0,00 75,00 0,00 -50,00 0,00 -25,00 0 0 1 0
#N/A






7 0,00 0,00 0,00 0,00 0,00 0,00 86,67 -33,33 -20,00 -33,33 0 0 0 1
#N/A






8 0,00 0,00 -3,56 0,00 0,00 -50,00 -33,33 120,23 -33,33 0,00 0 0 0 0
#N/A






9 0,00 0,00 0,00 -2,44 0,00 0,00 -20,00 -33,33 89,11 -33,33 0 0 0 0
#N/A






10 0,00 0,00 0,00 0,00 -4,94 -25,00 -33,33 0,00 -33,33 96,60 0 0 0 0
#N/A






S 1 0 0 0 0 0 0 0 0 0 0 0 0 0
0






0 1 0 0 0 0 0 0 0 0 0 0 0 0
0






0 0 0 0 0 1 0 0 0 0 0 0 0 0
0






0 0 0 0 0 0 1 0 0 0 0 0 0 0
0






























( ATA ) -1








Nr dA (t1) dB (t1) dh1 (t1) dh2 (t1) dh3 (t1) dA (t2) dB (t2) dh1 (t2) dh2 (t2) dh3 (t2) ST








1 0 0 0,000 0,000 0,000 0,000 0,000 0,000 0,000 0,000 1,000 0,000 0,000 0,000








2 0 0 0,000 0,000 0,000 0,000 0,000 0,000 0,000 0,000 0,000 1,000 0,000 0,000








3 0 0 0,008 0,006 0,004 0,000 0,000 0,000 0,000 0,000 0,521 0,418 0,028 0,033








4 0 0 0,006 0,021 0,007 0,000 0,000 0,000 0,001 0,001 0,473 0,429 0,040 0,058








5 0 0 0,004 0,007 0,010 0,000 0,000 0,000 0,001 0,001 0,457 0,469 0,031 0,043








6 0 0 0,000 0,000 0,000 0,000 0,000 0,000 0,000 0,000 0,000 0,000 1,000 0,000








7 0 0 0,000 0,000 0,000 0,000 0,000 0,000 0,000 0,000 0,000 0,000 0,000 1,000








8 0 0 0,000 0,000 0,000 0,000 0,000 0,009 0,004 0,001 0,025 0,022 0,509 0,444








9 0 0 0,000 0,001 0,001 0,000 0,000 0,004 0,015 0,005 0,036 0,033 0,332 0,600








10 0 0 0,000 0,001 0,001 0,000 0,000 0,001 0,005 0,012 0,036 0,035 0,375 0,554








S 1 0 0,521 0,473 0,457 0,000 0,000 0,025 0,036 0,036 -37,518 32,605 2,161 2,752








0 1 0,418 0,429 0,469 0,000 0,000 0,022 0,033 0,035 32,605 -37,121 1,960 2,556








0 0 0,028 0,040 0,031 1,000 0,000 0,509 0,332 0,375 2,161 1,960 -40,199 36,078








0 0 0,033 0,058 0,043 0,000 1,000 0,444 0,600 0,554 2,752 2,556 36,078 -41,386







































Obs.wyr [m]

















X σdh
V v

VTV #N/A
VTA


V v
VTA
VTV VTL
Czas t1 dhA #N/A Err:502
#N/A #N/A #N/A Obs. 1
VTL #N/A
#N/A


-0,2090 -0,0296
3,066
9,71 9,71
dhB #N/A Err:502
#N/A #N/A #N/A Obs. 2



#N/A


-0,4568 -0,0791
-6,385


dh1 #N/A #N/A
#N/A #N/A #N/A Obs. 3



#N/A


-0,5827 -0,1009
0,000


dh2 #N/A #N/A
#N/A #N/A #N/A Obs. 4
u kryt

#N/A


0,7463 0,1055
0,000


dh3 #N/A #N/A
#N/A #N/A #N/A Obs. 5
2,5

#N/A


-0,3049 -0,0528
0,000


Czas t2 dhA #N/A #N/A
#N/A #N/A #N/A Obs. 6



#N/A


0,8010 0,1387
16,567


dhB #N/A Err:502
#N/A #N/A #N/A Obs. 7



#N/A


-0,3175 -0,0635
-13,248


dh1 #N/A #N/A
#N/A #N/A #N/A Obs. 8



#N/A


-1,4561 -0,2059
0,000


dh2 #N/A #N/A
#N/A #N/A #N/A Obs. 9



#N/A


-0,2035 -0,0352
0,000


dh3 #N/A #N/A
#N/A #N/A #N/A Obs. 10



#N/A


0,3688 0,0639
0,000







#N/A #N/A #N/A Obs. 11
Test lokalny

-0,5762 -0,1289









#N/A #N/A #N/A Obs. 12
Obs V σ |u| |u|<ukryt.

-0,3562 -0,0617




Test globalny
Warunek #N/A #N/A #N/A Obs. 13
1 #N/A 0,76 #N/A #N/A

1,4921 0,2584





(σ0) ≤ (σ0) kryt #N/A #N/A #N/A Obs. 14
2 #N/A 0,66 #N/A #N/A

-1,2542 -0,2508




σ0^ #N/A
#N/A #N/A #N/A


3 #N/A 0,66 #N/A #N/A

-0,2685 -0,1423




σ0 kryt 1,34


#N/A #N/A


4 #N/A 0,72 #N/A #N/A

-0,4653 -0,2978









#N/A #N/A


5 #N/A 0,82 #N/A #N/A

-0,9385 -0,4223














6 #N/A 0,85 #N/A #N/A


















7 #N/A 0,87 #N/A #N/A









Hi wyr (t1) [m]

Hi wyr (t2) [m]


8 #N/A 0,73 #N/A #N/A








A #N/A
A #N/A
V wyr. [mm/rok]
9 #N/A 0,68 #N/A #N/A








B #N/A
B #N/A

10 #N/A 0,67 #N/A #N/A








1 #N/A
1 #N/A
#N/A
11 #N/A 0,84 #N/A #N/A








2 #N/A
2 #N/A
#N/A
12 #N/A 0,77 #N/A #N/A








3 #N/A
3 #N/A
#N/A
13 #N/A 0,83 #N/A #N/A


















14 #N/A 0,83 #N/A #N/A












Wyr. łączne - T1-T2

15 #N/A 0,97 #N/A #N/A














16 #N/A 0,96 #N/A #N/A


















17 #N/A 0,95 #N/A #N/A







































#N/A






















#N/A






















#N/A








































































































































































































































1,0000 0,0000 0,0000 0,0000 0,0000 0,0000 0,0000 0,0000 0,0000 0,0000 0,0000 0,0000 0,0000 0,0000 0,0000 0,0000 0,0000






0,0000 1,0000 0,0000 0,0000 0,0000 0,0000 0,0000 0,0000 0,0000 0,0000 0,0000 0,0000 0,0000 0,0000 0,0000 0,0000 0,0000






0,0000 0,0000 1,0000 0,0000 0,0000 0,0000 0,0000 0,0000 0,0000 0,0000 0,0000 0,0000 0,0000 0,0000 0,0000 0,0000 0,0000






0,0000 0,0000 0,0000 1,0000 0,0000 0,0000 0,0000 0,0000 0,0000 0,0000 0,0000 0,0000 0,0000 0,0000 0,0000 0,0000 0,0000






0,0000 0,0000 0,0000 0,0000 1,0000 0,0000 0,0000 0,0000 0,0000 0,0000 0,0000 0,0000 0,0000 0,0000 0,0000 0,0000 0,0000






0,0000 0,0000 0,0000 0,0000 0,0000 1,0000 0,0000 0,0000 0,0000 0,0000 0,0000 0,0000 0,0000 0,0000 0,0000 0,0000 0,0000






0,0000 0,0000 0,0000 0,0000 0,0000 0,0000 1,0000 0,0000 0,0000 0,0000 0,0000 0,0000 0,0000 0,0000 0,0000 0,0000 0,0000






0,0000 0,0000 0,0000 0,0000 0,0000 0,0000 0,0000 1,0000 0,0000 0,0000 0,0000 0,0000 0,0000 0,0000 0,0000 0,0000 0,0000






0,0000 0,0000 0,0000 0,0000 0,0000 0,0000 0,0000 0,0000 1,0000 0,0000 0,0000 0,0000 0,0000 0,0000 0,0000 0,0000 0,0000






0,0000 0,0000 0,0000 0,0000 0,0000 0,0000 0,0000 0,0000 0,0000 1,0000 0,0000 0,0000 0,0000 0,0000 0,0000 0,0000 0,0000






0,0000 0,0000 0,0000 0,0000 0,0000 0,0000 0,0000 0,0000 0,0000 0,0000 1,0000 0,0000 0,0000 0,0000 0,0000 0,0000 0,0000






0,0000 0,0000 0,0000 0,0000 0,0000 0,0000 0,0000 0,0000 0,0000 0,0000 0,0000 1,0000 0,0000 0,0000 0,0000 0,0000 0,0000






0,0000 0,0000 0,0000 0,0000 0,0000 0,0000 0,0000 0,0000 0,0000 0,0000 0,0000 0,0000 1,0000 0,0000 0,0000 0,0000 0,0000






0,0000 0,0000 0,0000 0,0000 0,0000 0,0000 0,0000 0,0000 0,0000 0,0000 0,0000 0,0000 0,0000 1,0000 0,0000 0,0000 0,0000






0,0000 0,0000 0,0000 0,0000 0,0000 0,0000 0,0000 0,0000 0,0000 0,0000 0,0000 0,0000 0,0000 0,0000 1,0000 0,0000 0,0000






0,0000 0,0000 0,0000 0,0000 0,0000 0,0000 0,0000 0,0000 0,0000 0,0000 0,0000 0,0000 0,0000 0,0000 0,0000 1,0000 0,0000






0,0000 0,0000 0,0000 0,0000 0,0000 0,0000 0,0000 0,0000 0,0000 0,0000 0,0000 0,0000 0,0000 0,0000 0,0000 0,0000 1,0000






















































0,584491874754292 0,091793181063849 0,074988983304657 0,204265600449916 0,172478799242306 -0,339260963610811 -0,149371021758072 -0,018427337732417 -0,002988610887342 0,002994905386973 0,013969439728514 0,015039563754488 -0,015045858254119 -0,013024644273222 -0,105954157558318 -0,062092211838625 -0,060598389993267






0,091793181063849 0,436823449634573 0,402418976754852 -0,196887013816907 0,085808755119462 0,074948818491112 -0,074312561800572 -0,003561191536986 -0,015584294775877 0,007724980809932 0,01432383811407 0,010767014679922 -0,002907700713978 -0,009324508235733 0,02544366923843 -0,127125962741979 -0,028883579362151






0,074988983304657 0,402418976754852 0,435284558553011 -0,198771762776681 0,101068216216638 0,061228248475499 -0,087527642758787 0,007287630997581 0,008972155953569 -0,014939936796896 -0,01155890465739 1,74550507389082E-05 0,005950325792588 -1,5116517364243E-05 0,018064937853522 0,12143969598874 -0,038894456107299






0,204265600449916 -0,196887013816907 -0,198771762776681 0,515418942545933 0,228876612225082 0,166782164368505 -0,198212960519041 0,004563937617915 -0,00809818311155 -0,00883648034235 0,003386338070808 0,013208223993305 0,003726439460595 -0,011438657517077 0,053286943397259 -0,006964226043394 -0,083010801334206






0,172478799242306 0,085808755119462 0,101068216216638 0,228876612225082 0,672294678800038 0,140828349863862 0,283801133114507 0,011319418793524 0,009052329393546 0,004769625978298 -0,014170933232488 -0,023064222114845 0,009242266743001 0,019974202269983 0,043002600289493 0,056384345421717 0,117256413708677






-0,339260963610811 0,074948818491112 0,061228248475499 0,166782164368506 0,140828349863861 0,722994583169528 -0,121960928555148 -0,015045858254119 -0,002440190571238 0,002445330008666 0,011405999775808 0,012279752384184 -0,012284891821611 -0,010634577516886 -0,086511207381444 -0,050698078668478 -0,049478378239227






-0,149371021758072 -0,074312561800572 -0,087527642758787 -0,198212960519041 0,283801133114507 -0,121960928555148 0,754221009100028 -0,009802904231267 -0,007839547218235 -0,004130617263756 0,012272388174667 0,019974202269983 -0,008004037787991 -0,017298166586134 -0,037241344279489 -0,048830275510963 -0,101547033028373






-0,018427337732418 -0,003561191536986 0,007287630997581 0,004563937617915 0,011319418793524 -0,015045858254119 -0,009802904231267 0,526957550865456 0,219507902222304 0,108621295609898 0,12914822390832 0,058108344519832 -0,386237542352034 -0,050323302526032 0,121306199283895 0,040086851908626 0,018009065908785






-0,002988610887342 -0,015584294775876 0,008972155953569 -0,00809818311155 0,009052329393546 -0,002440190571238 -0,007839547218235 0,219507902222303 0,467470655709063 0,230933069395732 0,273666469275508 0,122368823244077 0,179227451651128 -0,105974509560578 -0,059369355928374 0,090737110009517 0,043615538818819






0,002994905386973 0,007724980809932 -0,014939936796896 -0,00883648034235 0,004769625978298 0,002445330008666 -0,004130617263756 0,108621295609898 0,230933069395732 0,445371178528852 -0,247578125676792 0,235006835593994 0,088688916481422 -0,203521889687392 -0,028184579924108 -0,083747816201362 0,088618343299394






0,013969439728514 0,01432383811407 -0,01155890465739 0,003386338070808 -0,014170933232488 0,011405999775808 0,012272388174667 0,12914822390832 0,273666469275508 -0,247578125676792 0,706338355752974 -0,131537426852748 0,105449083254031 0,113914753202917 -0,030733471449948 -0,095637814441396 -0,045174384457






0,015039563754488 0,010767014679922 1,74550507391381E-05 0,013208223993306 -0,023064222114845 0,012279752384184 0,019974202269983 0,058108344519831 0,122368823244077 0,235006835593994 -0,131537426852748 0,595179076538117 0,047445264623812 0,350585203701467 -0,011492161108155 -0,039720071331705 -0,146938222858438






-0,015045858254119 -0,002907700713978 0,005950325792588 0,003726439460595 0,009242266743002 -0,012284891821612 -0,008004037787991 -0,386237542352033 0,179227451651128 0,088688916481422 0,105449083254031 0,047445264623812 0,684638367243638 -0,041088804453497 0,099046096960638 0,03273077752355 0,014704340740225






-0,013024644273223 -0,009324508235732 -1,51165173641575E-05 -0,011438657517077 0,019974202269982 -0,010634577516886 -0,017298166586134 -0,050323302526032 -0,105974509560578 -0,203521889687392 0,113914753202917 0,350585203701468 -0,041088804453498 0,696384307403587 0,009952503464046 0,034398590813387 0,127252233782346






-0,105954157558318 0,02544366923843 0,018064937853522 0,053286943397259 0,043002600289493 -0,086511207381445 -0,037241344279489 0,121306199283895 -0,059369355928374 -0,028184579924108 -0,030733471449948 -0,011492161108155 0,099046096960638 0,009952503464046 0,939359494559244 -0,02726472032867 -0,020975043441571






-0,062092211838625 -0,127125962741979 0,12143969598874 -0,006964226043394 0,056384345421717 -0,050698078668478 -0,048830275510964 0,040086851908626 0,090737110009517 -0,083747816201362 -0,095637814441396 -0,039720071331705 0,03273077752355 0,034398590813387 -0,02726472032867 0,918460479868654 -0,036990607255267






-0,060598389993267 -0,028883579362151 -0,038894456107299 -0,083010801334206 0,117256413708678 -0,049478378239228 -0,101547033028373 0,018009065908785 0,043615538818819 0,088618343299394 -0,045174384457 -0,146938222858437 0,014704340740225 0,127252233782346 -0,020975043441571 -0,036990607255267 0,898311436973014






Sheet 3: Filtr Kalmana

NR H progn. [m] (X^2')
Macierz jednostkowa
CY
HA' #N/A
1 0 0 0 0
0 0 0 0 0
HA' #N/A
0 1 0 0 0
0 0 0 0 0
H1' #N/A
0 0 1 0 0
0 0 0,281 0 0
H2' #N/A
0 0 0 1 0
0 0 0 0,281 0
H3' #N/A
0 0 0 0 1
0 0 0 0 0,281

























Macierz współczynnikowa - A2


Predykcja macierzy kowariancji na moment t2 - K


-1 0 1 0 0


2,96059473233375E-18 0 0 0 0


0 0 -1 1 0


-1,4008674017375E-18 0 0 0 0


0 0 0 -1 1


4,31924491549732E-19 0 0,290 0,007 0,005


0 1 0 -1 0


1,63973473418546E-18 0 0,007 0,303 0,008


0 1 0 0 -1


4,04207411878091E-19 0 0,005 0,008 0,291


0 -1 1 0 0










-1 0 0 0 1















Cl2
"Macierz zysku" - G
0,020 0 0 0 0 0 0
0,000 0,000 0,000 0,000 0,000 0,000 0,000
0 0,030 0 0 0 0 0
0,000 0,000 0,000 0,000 0,000 0,000 0,000
0 0 0,030 0 0 0

0,472 -0,180 -0,087 -0,081 -0,047 0,315 0,036
0 0 0 0,050 0 0 0
0,202 0,349 -0,314 -0,290 -0,170 0,135 0,128
0 0 0 0 0,030 0 0
0,071 0,123 0,240 -0,102 -0,410 0,047 0,308
0 0 0 0 0 0,030 0







0 0 0 0 0 0 0,040




























Uściślony wektor stanu - (X^2) [m]

Uściślona macierz kowariancji - CX^2


Wektor korekt - x2'





H praw - H progn [mm]





#N/A
Autor: Powinno być 0 !!! #N/A HA' #N/A

0 0 0 0 0


#N/A
#N/A HB' #N/A

0 0 0 0 0


#N/A
#N/A H1' #N/A

0 0 0,009 0,004 0,001


#N/A
#N/A H2' #N/A

0 0 0,004 0,015 0,005


#N/A
#N/A H3' #N/A

0 0 0,001 0,005 0,012





























































































#N/A #N/A












#N/A #N/A












#N/A #N/A












#N/A #N/A












#N/A #N/A










Wyszukiwarka

Podobne podstrony:
kalman robsa duza sigma
kalman robsa mala sigma
Kalman
kalman filtr
kalman opis
Least squares estimation from Gauss to Kalman H W Sorenson
prefabrykat robsa Model (1)
Kalman
Kalman algorytm
kalman filter streszczenie
kalman filter prezentacja id 23 Nieznany
1 1 wyrys robsa
Filtr Kalmana, Filtr Kalmana
6 st2 ?zbledne robsa
5 st1 z pktlin bledy robsa
7 st2 z free bledy robsa
1990 Flux estimation by Kalman filter in inverter fed induction motors
2 okt linia robsa
3 st1 ?zbledne robsa

więcej podobnych podstron