Revision 1263, 1.0 kB
(checked in by peroutka, 14 years ago)
|
|
Rev | Line | |
---|
[1263] | 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 | |
---|
| 13 | #define qAU 14 |
---|
| 14 | #define qD 14 |
---|
| 15 | #define qCh 14 |
---|
| 16 | |
---|
| 17 | #define int16 int // short int |
---|
| 18 | #define int32 long // int |
---|
| 19 | |
---|
| 20 | /* Matrix multiply Full matrix by upper diagonal matrix; */ |
---|
| 21 | extern void mmultACh(int16 *m1, int16 *up, int16 *result, unsigned int16 rows, unsigned int16 columns); |
---|
| 22 | |
---|
| 23 | /* perform Householder update of Ch matrix using PSI*Ch , Q, */ |
---|
| 24 | extern void householder(int16 *Ch /*= int16 *PSICh*/, int16 *Q, unsigned int16 dimx); |
---|
| 25 | |
---|
| 26 | /* perform Givens update of Ch matrix using PSI*Ch , Q, */ |
---|
| 27 | extern void givens(int16 *Ch /*= int16 *PSICh*/, int16 *Q, unsigned int16 dimx); |
---|
| 28 | |
---|
| 29 | /* perform Carlson update of Ch matrix using difz, R and xp, for size dimx*/ |
---|
| 30 | extern void carlson(int16 *difz, int16 *xp, int16 *Ch, int16 *R, unsigned int16 dimy, unsigned int16 dimx ); |
---|