SLIDE 7 7
A K a l ma n F i l t e r f
B M T F
I n i t i a l i z e P r
a g a t e U p d a t e P r
a g a t e U p d a t e P r
a g a t e U p d a t e P r
a g a t e U p d a t e V e r t e x U n c
s t r a i n e d M e a s u r e me n t V e r t e x C
s t r a i n e d M e a s u r e me n t
e q u e n t i a l a l g
i t h m: ( ma t h e ma t i c a l l y e q u i v a l e n t t
χ2 f i t )
r
a g a t e t r a c k i n w a r d s f r
s t a t i
t
t a t i
a n d ma t c h w i t h a s t u b
p d a t e t r a c k p a r a me t e r s a n d c
t i n u e
f t e r r e a c h i n g s t a t i
1 s a v e me a s u r e me n t w i t h
t v e r t e x c
s t r a i n t
r
a g a t e t
e r t e x a n d u p d a t e v e r t e x c
s t r a i n e d me a s u r e me n t
h a l l e n g e f
a n F P G A i mp l e me n t a t i
M a t r i x a l g e b r a