Revision 50, 0.7 kB
(checked in by peroutka, 16 years ago)
|
|
Rev | Line | |
---|
[50] | 1 | /************************************ |
---|
| 2 | Extended Kalman Filter |
---|
| 3 | Kalman Observer |
---|
| 4 | |
---|
| 5 | Z. Peroutka |
---|
| 6 | |
---|
| 7 | Rev. 15.3.2008 |
---|
| 8 | |
---|
| 9 | EKF pocitan s daty ve formatu Q15, zatimco regulace pracuje v Q13 -> |
---|
| 10 | resenim je vynasobit referencni hodnoty v EKF 4-mi (tim je automaticky |
---|
| 11 | zajisten prechod mezi formaty Q13 a Q15). Realizovano konstantou K_PREVOD_FORM. |
---|
| 12 | |
---|
| 13 | 15.3.2008 Kontrola kodu + zamena datovych typu q15->int a q30->long. |
---|
| 14 | |
---|
| 15 | *************************************/ |
---|
| 16 | |
---|
| 17 | /* Declaration of global functions */ |
---|
| 18 | void init_ekf(double Tv, double *param); |
---|
| 19 | void ekf(double *x_estimation, double Umd, double beta, double Ucnd, double Ucd, double isxd, double isyd); |
---|
| 20 | |
---|
| 21 | // pouze pro ucely ladeni |
---|
| 22 | extern double ladeni_EKF[10]; |
---|