Changeset 81 for pmsm/pmsm.h

Show
Ignore:
Timestamp:
04/18/08 14:10:47 (16 years ago)
Author:
smidl
Message:

opravy + pridani simulace kovarianci

Files:
1 modified

Legend:

Unmodified
Added
Removed
  • pmsm/pmsm.h

    r72 r81  
    33 
    44#include <stat/libFN.h> 
     5#include <userinfo.h> 
    56 
    67 
     
    910RV ru ( "5 6", "{ua, ub}", ones_i ( 2 ) ,zeros_i ( 2 )); 
    1011RV ry ( "7 8", "{oia, oib}", ones_i ( 2 ) ,zeros_i ( 2 )); 
     12 
     13class uipmsm : public uicompound{ 
     14        double Rs, Ls, dt, Ypm, kp, p,  J, Mz; 
     15}; 
    1116 
    1217//! State evolution model for a PMSM drive and its derivative with respect to \$x\$ 
     
    3742                xk ( 2 ) = omm + kp*p*p * Ypm/J*dt* ( ibm * cos ( thm )-iam * sin ( thm ) ) - p/J*dt*Mz; 
    3843                //th 
    39                 xk ( 3 ) = rem(thm + omm*dt,2*pi); // <0..2pi> 
     44                xk ( 3 ) = thm + omm*dt; // <0..2pi> 
     45                if ( xk ( 3 ) >pi ) xk ( 3 )-=2*pi; 
     46                if ( xk ( 3 ) <-pi ) xk ( 3 ) +=2*pi; 
    4047                return xk; 
    4148        }