基于TMS320F2812的電機(jī)控制程序

使用TMS320F2812做控制器使用霍爾傳感器實(shí)現(xiàn)PSMS電機(jī)的運(yùn)行。

1. #include "IQmathLib.h"         // Include header for IQmath library
   
2. // Don't forget to set a proper GLOBAL_Q in "IQmathLib.h" file
   
3. #include "dmctype.h"
   
4. #include "rmp_cntl.h"
   
5. 
   
6. 
   
7. void rmp_cntl_calc(RMPCNTL *v)
   
8. {       
   
9.      _iq tmp;
   
10.       
    
11.      tmp = v->TargetValue - v->SetpointValue;
    
12.      
    
13.       if (_IQabs(tmp) > _IQ(0.0000305))
    
14.       {
    
15.          v->RampDelayCount += 1;
    
16.          if (v->RampDelayCount >= v->RampDelayMax)
    
17.          {
    
18.            if (v->TargetValue >= v->SetpointValue)
    
19.            {
    
20.             v->SetpointValue += _IQ(0.0000305);        // 0.0000305 is resolution of Q15
    
21.             if (v->SetpointValue > v->RampHighLimit)
    
22.               v->SetpointValue = v->RampHighLimit;           
    
23.             v->RampDelayCount = 0;
    
24.            }
    
25.            else
    
26.            {
    
27.             v->SetpointValue -= _IQ(0.0000305);        // 0.0000305 is resolution of Q15
    
28.             if (v->SetpointValue < v->RampLowLimit)
    
29.               v->SetpointValue = v->RampLowLimit;           
    
30.             v->RampDelayCount = 0;
    
31.            }
    
32.          }        
    
33.       }
    
34.       else  v->EqualFlag = 0x7FFFFFFF;
    
35. }
    
36. 
    

復(fù)制代碼