speed_pr.c

TI公司的DSP(LF2407A)编写的有霍尔位置传感器的无刷直流电机控制程序,内含子程序说明

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

 Description:  Speed measurement computation based capture input                  

=====================================================================================
 History:
-------------------------------------------------------------------------------------
 04-15-2005	Version 3.20
-------------------------------------------------------------------------------------*/
#include <speed_pr.h>

void speed_prd_calc(SPEED_MEAS_CAP *v)
{
   long Temp1;
   long Temp2;
   float SpeedTemp;
/*   if (v->InputSelect == 0)  
   {
	     v->OldTimeStamp = v->NewTimeStamp;
	     v->NewTimeStamp = v->TimeStamp; 
	     v->EventPeriod = v->NewTimeStamp - v->OldTimeStamp; 
   
 	    if (v->EventPeriod < 0)
 	      v->EventPeriod += 32767;   // 0x7FFF = 32767
 	   }
*/
	  	 Temp1 = (long)(v->SpeedScaler)*(long)(v->BaseRpm);
	  	 Temp2 = (long)(v->EventPeriod)*(long)(v->motorpairs);
		 SpeedTemp = (float)Temp1/((float)Temp2);
 	 	 v->SpeedRpm =(int)SpeedTemp; 
		 v->Speed = ((long)v->SpeedRpm*32768)/((long)v->BaseRpm);
   
}