Show
Ignore:
Timestamp:
03/14/12 23:39:30 (12 years ago)
Author:
smidl
Message:

Kalman for om

Files:
1 modified

Legend:

Unmodified
Added
Removed

  • applications/pmsm/simulator_zdenek/ekf_example/mpf_double.h

    r1381 r1438  
    55#define N 20 
    66 
    7 #define Lsd Ls*1.1 
     7#define Lsd Ls*0.9 
    88#define Lsq Ls 
    99#define _dt 0.000125 
    10 #define _ad Rs*_dt/Lsd 
    11 #define _aq Rs*_dt/Lsq 
     10#define _ad (1.-Rs*_dt/Lsd) 
     11#define _aq (1.-Rs*_dt/Lsq) 
    1212#define _b  Fmag/Lsq*_dt 
    1313#define _cd  _dt/Lsd 
    … …  
    2121void mpf_mean(double *Ecosth, double *Esinth, double *Eome); 
    2222void mpf_th(double th1[N]); 
     23 
     24double kalman_om ( const double &isa, const double &isb , const double &usa, const double &usb, const double &th );