cur_mod.c

伺服控制数学模型

/*=====================================================================================
 File name:        CUR_MOD.C  (IQ version)                  
                    
 Originator:	Digital Control Systems Group
			Texas Instruments

 Description:  Current Model for Indirect Field Oriented Control of Induction Motor                   

=====================================================================================
 History:
-------------------------------------------------------------------------------------
 04-15-2005	Version 3.20
-------------------------------------------------------------------------------------*/

#include "IQmathLib.h"         // Include header for IQmath library 
// Don't forget to set a proper GLOBAL_Q in "IQmathLib.h" file 
#include "dmctype.h"
#include "cur_mod.h"

void cur_mod_calc(CURMOD *v)
{	

	_iq Wslip, We;
	
	v->IMDs = v->IMDs + _IQmpy(v->Kr,(v->IDs - v->IMDs));
	Wslip = _IQdiv(_IQmpy(v->Kt,v->IQs),v->IMDs);
	We = v->Wr + Wslip;
	v->Theta = v->Theta + _IQmpy(v->K,We);								

    if (v->Theta > _IQ(1))
       v->Theta = v->Theta - _IQ(1);
    else if (v->Theta < _IQ(0))
       v->Theta = _IQ(1) + v->Theta; 

}