motor control

#ifndef __SVGEN_MF_H__
#define __SVGEN_MF_H__

typedef struct  { _iq  Gain;     // Input: reference gain voltage (pu)      _iq  Offset;    // Input: reference offset voltage (pu)
      _iq  Freq;    // Input: reference frequency (pu)
                  _iq  FreqMax;     // Parameter: Maximum step angle = 6*base_freq*T (pu)
                  _iq  Alpha;        // History: Sector angle (pu)
                  _iq  NewEntry;      // History: Sine (angular) look-up pointer (pu)
                  Uint32  SectorPointer;    // History: Sector number (Q0) – independently with global Q
      _iq  Ta;     // Output: reference phase-a switching function (pu)       _iq  Tb;     // Output: reference phase-b switching function (pu)
      _iq  Tc;     // Output: reference phase-c switching function (pu)
         } SVGENMF;
                                                                                                                                                                                                                                                                                                                                                                                                                                                                                                                   typedef SVGENMF *SVGENMF_handle;
/*—————————————————————————–
Default initalizer for the SVGENMF object.
—————————————————————————–*/                    #define SVGENMF_DEFAULTS { 0,0,0,0,0,0,0,0,0,0, \
                         }

/*——————————————————————————
  SVGENMF Macro Definitions
——————————————————————————*/

_iq StepAngle,EntryOld,dx,dy;     _iq TP = _IQ(1.0);     #define PI_THIRD _IQ(1.04719755119660)    /* This is 60 degree */

#define SVGENMF_MACRO(v)                   \
 /* Normalise the freq input to appropriate step angle */          \
     /* Here, 1 pu. = 60 degree   */              \
     StepAngle = _IQmpy(v.Freq,v.FreqMax);              \
 /* Calculate new angle alpha   */              \
     EntryOld = v.NewEntry;                  \
     v.Alpha = v.Alpha + StepAngle;                \
 if (v.Alpha >= _IQ(1.0))                  \
  v.Alpha = v.Alpha-_IQ(1.0);                 \
 v.NewEntry = v.Alpha;                   \
        dy = _IQsin(_IQmpy(v.NewEntry,PI_THIRD));              /* dy = sin(NewEntry) */   \
     dx = _IQsin(PI_THIRD-_IQmpy(v.NewEntry,PI_THIRD));     /* dx = sin(60-NewEntry) */   \
   /* Determine which sector   */               \
     if (v.NewEntry-EntryOld<0)                 \
     {                       \
        if (v.SectorPointer==5)                 \
           v.SectorPointer = 0;                \
        else                     \
           v.SectorPointer = v.SectorPointer + 1;             \
     }                       \

////////////////////////////

反向了怎么办？

而且没有零矢量，

望解

////////////////////////////
  if (v.SectorPointer==0)  /* Sector 1 calculations – a,b,c -. a,b,c*/       \
     {                       \
  v.Ta = (TP-dx-dy)>>1;                  \
  v.Tb = v.Ta + dx;                   \
  v.Tc = TP – v.Ta;                    \
     }                       \
     else if (v.SectorPointer==1)  /* Sector 2 calculations – a,b,c -. b,a,c  &  dx <-. dy */ \
     {                       \
  v.Tb = (TP-dx-dy)>>1;                  \
  v.Ta = v.Tb + dy;                   \
  v.Tc = TP – v.Tb;                    \
     }                       \
     else if (v.SectorPointer==2)  /* Sector 3 calculations – a,b,c -. b,c,a  */    \
     {                       \
  v.Tb = (TP-dx-dy)>>1;                  \
  v.Tc = v.Tb + dx;                   \
      v.Ta = TP – v.Tb;                   \
     }                       \
     else if (v.SectorPointer==3)  /* Sector 4 calculations – a,b,c -. c,b,a  &  dx <-. dy */ \
     {                       \
  v.Tc = (TP-dx-dy)>>1;                  \
  v.Tb = v.Tc + dy;                   \
  v.Ta = TP – v.Tc;                    \
     }                       \
     else if (v.SectorPointer==4)  /* Sector 5 calculations – a,b,c -. c,a,b  */    \
     {                       \
  v.Tc = (TP-dx-dy)>>1;                  \
  v.Ta = v.Tc + dx;                   \
  v.Tb = TP – v.Tc;                    \
     }                       \
     else if (v.SectorPointer==5)  /* Sector 6 calculations – a,b,c -. a,c,b  &  dx <-. dy */ \
     {                       \
  v.Ta = (TP-dx-dy)>>1;                  \
  v.Tc = v.Ta + dy;                   \
  v.Tb = TP – v.Ta;                    \
     }                       \
/* Convert the unsigned GLOBAL_Q format (ranged (0,1)) . signed GLOBAL_Q format (ranged (-1,1)) */ \
/* Then, multiply with a gain and add an offset.      */       \
     v.Ta = (v.Ta-_IQ(0.5))<<1;                 \
     v.Ta = _IQmpy(v.Gain,v.Ta) + v.Offset;              \
                         \
  v.Tb = (v.Tb-_IQ(0.5))<<1;                  \
     v.Tb = _IQmpy(v.Gain,v.Tb) + v.Offset;              \
                         \
     v.Tc = (v.Tc-_IQ(0.5))<<1;                 \
     v.Tc = _IQmpy(v.Gain,v.Tc) + v.Offset;              \

#endif // __SVGEN_MF_H__