- Timestamp:
- 12/02/13 13:54:59 (10 years ago)
- Files:
-
- 1 modified
Legend:
- Unmodified
- Added
- Removed
-
applications/pmsm/simulator_zdenek/ekf_example/mpf_double.h
r1468 r1469 1 1 // Bayesian Filtering for PMSM using Marginalized Particle Filter 2 2 3 #include "parametry_motoru.h" 4 #define Fpm 0.1989 5 //#define pi 3.141596 3 //#define Fpm 0.1989 4 #ifndef M_PI 5 #define M_PI 3.141596 6 #endif 6 7 7 8 #define N 4 8 9 9 #define Lsd Ls*0.9 10 #define Lsq Ls 11 #define _dt 0.000125 12 #define _ad (1.-Rs*_dt/(Lsd)) 13 #define _aq (1.-Rs*_dt/(Lsq)) 14 #define _b Fpm/Lsq*_dt 15 #define _cd _dt/(Lsd) 16 #define _cq _dt/(Lsq) 10 //#define Lsd Ls*0.9 11 //#define Lsq Ls 17 12 13 #define VYBER_MODELU 0 // 0 = plny model s respektovanim Lsd/Lsq ... implicitne 14 // 1 = parametry modelu z identifikace 15 #define _dt 0.000125 18 16 19 # 17 #define floatx float 20 18 21 19 floatx qrandn(); … … 28 26 void mpf_th(floatx th1[N]); 29 27 void mpf_om(floatx om1[N]); 28 void mpf_best( floatx *Ecosth, floatx *Esinth, floatx *Eome); 30 29 31 30 floatx kalman_om ( const floatx isa, const floatx isb , const floatx usa, const floatx usb, const floatx th );