rmp2cntl.c

来自「TI公司的DSP(LF2407A)编写的有霍尔位置传感器的无刷直流电机控制程序,」· C语言 代码 · 共 40 行

/*=====================================================================================
 File name:        RMP2CNTL.C  (IQ version)                  

 Description:  The ramp2 output control                   
=====================================================================================
-------------------------------------------------------------------------------------
 05-15-2007	Version 3.20
-------------------------------------------------------------------------------------*/
#include <rmp2cntl.h>

void rmp2_cntl_calc(RMP2 *v)
{	

   if (v->Out != v->DesiredInput)
   {

      v->Ramp2DelayCount++;
      
      if (v->Ramp2DelayCount >= v->Ramp2Delay)   
      {
        v->Ramp2DelayCount = 0; 
       
       if (v->Out < v->DesiredInput) 
        {  
         v->Out++;
         if (v->Out > v->Ramp2Max) 
            v->Out = v->Ramp2Max;
        }
        else
        { 
         v->Out--;
         if (v->Out < v->Ramp2Min) 
            v->Out = v->Ramp2Min;
        }
      }                          
    } 
}