cur_mod.c

伺服控制数学模型

/*=====================================================================================
 File name:       CUR_MOD.C                   
                    
 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 "dmctype.h"
#include "cur_mod.h"

void cur_mod_calc(CURMOD *v)
{	

	float32 Wslip, We;
	
	v->IMDs = v->IMDs + v->Kr*(v->IDs - v->IMDs);
	Wslip = v->Kt*v->IQs/v->IMDs;
	We = v->Wr + Wslip;
	v->Theta = v->Theta + v->K*We;								

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

}