1 | /************************************ |
---|
2 | Extended Kalman Filter |
---|
3 | Matrix operations |
---|
4 | |
---|
5 | V. Smidl |
---|
6 | |
---|
7 | Rev. 30.8.2010 |
---|
8 | |
---|
9 | 30.8.2010 Prvni verze |
---|
10 | |
---|
11 | *************************************/ |
---|
12 | /* Matrix multiply Full matrix by upper diagonal matrix; */ |
---|
13 | extern void mmultAU(int *m1, int *up, int *result, unsigned int rows, unsigned int columns); |
---|
14 | |
---|
15 | /* perform Thorton update of UD matrix using PSI*U, Q, and temporaries G, Dold, for size dimx*/ |
---|
16 | extern void thorton(int *U, int *D, int *PSIU, int *Q, int *G, int *Dold, unsigned int dimx); |
---|
17 | |
---|
18 | /* perform Bierman update of UD matrix using difz, R and xp, for size dimx*/ |
---|
19 | extern void bierman(int *difz, int *xp, int *U, int *D, int *R, unsigned int dimy, unsigned int dimx ); |
---|
20 | |
---|
21 | /* perform Thorton update of UD matrix using PSI*U, Q, and temporaries G, Dold, for size dimx*/ |
---|
22 | extern void thorton_fast(int *U, int *D, int *PSIU, int *Q, int *G, int *Dold, unsigned int dimx); |
---|
23 | |
---|
24 | /* perform Bierman update of UD matrix using difz, R and xp, for size dimx*/ |
---|
25 | extern void bierman_fast(int *difz, int *xp, int *U, int *D, int *R, unsigned int dimy, unsigned int dimx ); |
---|