关于controlsuit中PFC电路的BridgelessPFC-DPL-ISR.asm

shen feng

// PWM based ISR trigger
PieVectTable.EPWM1_INT = &DPL_ISR; // Map Interrupt
PieCtrlRegs.PIEIER3.bit.INTx1 = 1; // PIE level enable, Grp3 / Int1, ePWM1

EPwm1Regs.CMPB = 80;      // ISR trigger point
   EPwm1Regs.ETSEL.bit.INTSEL = ET_CTRU_CMPB; // INT on CompareB-Up event
   EPwm1Regs.ETSEL.bit.INTEN = 1;              // Enable INT
//   EPwm1Regs.ETPS.bit.INTPRD = ET_1ST;         // Generate INT on every event

主函数中划线部分应该就是要跳转到中断函数吧，

下面这个是个中断函数吧，这部分主要是什么作用？谢谢！

;----------------------------------------------------------------------------------
; FILE:   BridgelessPFC-DPL-ISR.asm
;
; Description: BridgelessPFC-DPL-ISR.asm contains the ISR for the system
;     It also contains the initailization routine for all the macros
;     being used in the system both for CLA and C28x macros
;
;   Revision/ Version: See BridgelessPFC-Main.c
;----------------------------------------------------------------------------------

;Gives peripheral addresses visibility in assembly
.cdecls C,LIST,"PeripheralHeaderIncludes.h"

;include C header file - sets INCR_BUILD etc.(used in conditional builds)
.cdecls C,NOLIST, "BridgelessPFC-Settings.h"

  ;Include files for the Power Library Maco's being used by the system
  .include "ADCDRV_1ch.asm"
  .include "PFC_BL_ICMD.asm"
  .include "PWMDRV_1ch_UpDwnCnt.asm"

  .include "CNTL_2P2Z.asm"
  .include "MATH_EMAVG.asm"
  .include "PFC_INVSQR.asm"
  .include "PFC_InvRmsSqr.asm"

;=============================================================================
; Digital Power library - Initailization Routine
;=============================================================================

; label to DP initialisation function
.def _DPL_Init

; dummy variable for pointer initialisation
ZeroNet .usect "ZeroNet_Section",2,1,1 ; output terminal 1
;_Vrect .usect "ISR_data",2,1,1
VloopCtr .usect "ISRVariables",2,1,1

; .def _Vrect

  .text
_DPL_Init:
  ZAPA
  MOVL XAR0, #ZeroNet
  MOVL *XAR0, ACC

; Initialize all the DP library macro used here
;---------------------------------------------------------
  .if(INCR_BUILD = 1)
   ADCDRV_1ch_INIT 1 ; Ipfc
   ADCDRV_1ch_INIT 2 ; Vpfc
   ADCDRV_1ch_INIT 3 ; VL_fb
   ADCDRV_1ch_INIT 4 ; VN_fb

   MATH_EMAVG_INIT 2

   PWMDRV_1ch_UpDwnCnt_INIT 1 ; PWM1A
   PWMDRV_1ch_UpDwnCnt_INIT 2 ; PWM2A
   PWMDRV_1ch_UpDwnCnt_INIT 4 ; PWM4A

  .endif
;---------------------------------------------------------------------
;---------------------------------------------------------
  .if(INCR_BUILD = 2)
   ADCDRV_1ch_INIT 1 ; Ipfc
   ADCDRV_1ch_INIT 2 ; Vpfc
   ADCDRV_1ch_INIT 3 ; VL_fb
   ADCDRV_1ch_INIT 4 ; VN_fb

   CNTL_2P2Z_INIT 1
   MATH_EMAVG_INIT 1
   MATH_EMAVG_INIT 2

   PFC_InvRmsSqr_INIT 1

   PFC_BL_ICMD_INIT 1 ;Bridgeless PFC current command init

   PWMDRV_1ch_UpDwnCnt_INIT 1 ; PWM1A
   PWMDRV_1ch_UpDwnCnt_INIT 2 ; PWM2A
   PWMDRV_1ch_UpDwnCnt_INIT 4 ; PWM4A

  .endif
;---------------------------------------------------------------------
  .if(INCR_BUILD = 3)
   ADCDRV_1ch_INIT 1 ; Ipfc
   ADCDRV_1ch_INIT 2 ; Vpfc
   ADCDRV_1ch_INIT 3 ; VL_fb
   ADCDRV_1ch_INIT 4 ; VN_fb

   CNTL_2P2Z_INIT 2
   CNTL_2P2Z_INIT 1

   MATH_EMAVG_INIT 1
   MATH_EMAVG_INIT 2

PFC_InvRmsSqr_INIT 1

;-----------------------------------------------------------------------------------------

; Digital Power library - Interrupt Service Routine

  .sect "ramfuncs"
  ; label to DP ISR Run function
  .def _DPL_ISR

_DPL_ISR:
  ; full context save - push any unprotected registers onto stack
  PUSH AR1H:AR0H
  PUSH XAR2
  PUSH XAR3
  PUSH XAR4
  PUSH XAR5
  PUSH XAR6
  PUSH XAR7
  PUSH XT
  SPM   0              ; set C28 mode
  CLRC AMODE
  CLRC PAGE0,OVM
;  CLRC INTM     ; clear interrupt mask - comment if ISR non-nestable
;-----------------------------------------------------------------------------------------

; call DP library modules
;---------------------------------------------------------
  .if(INCR_BUILD = 1)
   ADCDRV_1ch 1 ; Ipfc
   ADCDRV_1ch 2 ; Vpfc
   ADCDRV_1ch 3 ; VL_fb
   ADCDRV_1ch 4 ; VN_fb

   PWMDRV_1ch_UpDwnCnt 1  ; PWM1A
   PWMDRV_1ch_UpDwnCnt 2  ; PWM2A

   MATH_EMAVG  2

   PWMDRV_1ch_UpDwnCnt 4  ; PWM4A
  .endif
;----------------------------------------------
;---------------------------------------------------------
  .if(INCR_BUILD = 2)
   ADCDRV_1ch 1 ; Ipfc
   ADCDRV_1ch 2 ; Vpfc
   ADCDRV_1ch 3 ; VL_fb
   ADCDRV_1ch 4 ; VN_fb

   PFC_BL_ICMD 1 ;Bridgeless PFC current command

   CNTL_2P2Z  1

   PWMDRV_1ch_UpDwnCnt 1  ; PWM1A
   PWMDRV_1ch_UpDwnCnt 2  ; PWM2A

   MATH_EMAVG  1
      PFC_InvRmsSqr 1
   MATH_EMAVG  2

   PWMDRV_1ch_UpDwnCnt 4  ; PWM4A
  .endif
;----------------------------------------------
  .if(INCR_BUILD = 3)
   ADCDRV_1ch 1 ; Ipfc
   ADCDRV_1ch 2 ; Vpfc
   ADCDRV_1ch 3 ; VL_fb
   ADCDRV_1ch 4 ; VN_fb

   PFC_BL_ICMD 1 ;Bridgeless PFC current command

   CNTL_2P2Z  1

   PWMDRV_1ch_UpDwnCnt 1  ; PWM1A
   PWMDRV_1ch_UpDwnCnt 2  ; PWM2A

      PFC_InvRmsSqr 1
   MATH_EMAVG  2

   ;PWMDRV_1ch_UpDwnCnt 4  ; PWM4A

;Execute Vloop every VoltCurrLoopExecRatio times, defined in BridgelessPFC-Settings.h file
  MOVW DP,#(VloopCtr)
  INC  @VloopCtr
  CMP  @VloopCtr,#VoltCurrLoopExecRatio
  B  SKIP_VLOOP_CALC,LT

  MOV  @VloopCtr,#0
  CNTL_2P2Z  2   ;Volt loop controller

SKIP_VLOOP_CALC:

  .endif
;----------------------------------------------------

;Calculate Vrect
         MOVW DP, #_AdcResult                     ; load Data Page to read ADC results
        MOV  ACC, @_AdcResult.ADCRESULT3<<12  ; ACC = Line
        SUB  ACC, @_AdcResult.ADCRESULT4<<12  ; ACC = Line - Neutral
        B  NegativeCycle, LEQ     ; Branch to Negative Half Cycle
PositiveCycle:
; Save Vrect
   .ref _Vrect
        MOVW DP, #_Vrect
   MOVL @_Vrect, ACC
; ePWM1 & ADC configuration
         MOVW DP, #_AdcRegs.ADCSOC1CTL            ; load Data Page to read ADC results
;   MOV  @_AdcRegs.ADCSOC1CTL.bit.CHSEL, #2 ; Switch ADC to IpfcA current
   EALLOW
   MOV  @_AdcRegs.ADCSOC1CTL, #10374  ; Switch ADC to IpfcA current
   EDIS
         MOVW DP, #_EPwm1Regs.AQCTLA                     ; load Data Page to read ePWM registers
;   MOV  @_EPwm1Regs.AQCTLA.bit.CAU, #1  ; CLEAR ePWM1 on CompA-Up (enable switching)
;   MOV  @_EPwm1Regs.AQCTLA.bit.CAD, #2  ; SET ePWM1 on CompA-Down (enable switching)
   MOV  @_EPwm1Regs.AQCTLA, #144   ; SET ePWM1 on CompA-Down, CLEAR CompA-Up (enable switching)
         MOVW DP, #_EPwm2Regs.AQCTLA                     ; load Data Page to read ePWM registers
;   MOV  @_EPwm2Regs.AQCTLA.bit.CAU, #1  ; CLEAR ePWM2 on CompA-Up
;   MOV  @_EPwm2Regs.AQCTLA.bit.CAD, #1  ; CLEAR ePWM2 on CompA-Down (force low)
   MOV  @_EPwm2Regs.AQCTLA, #80    ; CLEAR ePWM2 on CompA-Up/Down (force low)
; Check if near Zero crossing before forcing ePWM2 High
   ;SUB  ACC, #100<<12
   SUB  ACC, #50<<12
   B  SkipPWM2Force, LT
;   MOV  @_EPwm2Regs.AQCTLA.bit.CAU, #2  ; SET ePWM2 on CompA-Up (force high)
;   MOV  @_EPwm2Regs.AQCTLA.bit.CAD, #2  ; SET ePWM2 on CompA-Down
   MOV  @_EPwm2Regs.AQCTLA, #160   ; SET ePWM2 on CompA-Up/Down (force high)
SkipPWM2Force:
;         MOVW DP, #_GpioDataRegs.GPADAT                 ; load Data Page to read GPIO registers
;   MOV @_GpioDataRegs.GPASET, #128 ; Set GPIO7, Used for debug purposes
        B  ControlLoopEnd, UNC
NegativeCycle:
; Save Vrect
        MOV  ACC, @_AdcResult.ADCRESULT4<<12  ; ACC = Neutral
        SUB  ACC, @_AdcResult.ADCRESULT3<<12  ; ACC = Neutral - Line
        MOVW DP, #_Vrect
   MOVL @_Vrect, ACC

; ePWM2 & ADC configuration
         MOVW DP, #_AdcRegs.ADCSOC1CTL            ; load Data Page to read ADC results
;   MOV  @_AdcRegs.ADCSOC1CTL.bit.CHSEL, #4 ; Switch ADC to IpfcB current
   EALLOW
   MOV  @_AdcRegs.ADCSOC1CTL, #10502  ; Switch ADC to IpfcB current
         EDIS
         MOVW DP, #_EPwm2Regs.AQCTLA                   ; load Data Page to read ePWM registers
;   MOV  @_EPwm2Regs.AQCTLA.bit.CAU, #1  ; CLEAR ePWM2 on CompA-Up (enable switching)
;   MOV  @_EPwm2Regs.AQCTLA.bit.CAD, #2  ; SET ePWM2 on CompA-Down (enable switching)
   MOV  @_EPwm2Regs.AQCTLA, #144   ; SET ePWM2 on CompA-Down, CLEAR CompA-Up (enable switching)
         MOVW DP, #_EPwm1Regs.AQCTLA                     ; load Data Page to read ePWM registers
;   MOV  @_EPwm1Regs.AQCTLA.bit.CAU, #1  ; CLEAR ePWM1 on CompA-Up
;   MOV  @_EPwm1Regs.AQCTLA.bit.CAD, #1  ; CLEAR ePWM1 on CompA-Down (force low)
   MOV  @_EPwm1Regs.AQCTLA, #80    ; CLEAR ePWM1 on CompA-Up/Down (force low)
; Check if near Zero crossing before forcing ePWM1 High
   ;SUB  ACC, #100<<12
   SUB  ACC, #50<<12
   B  SkipPWM1Force, LT
;   MOV  @_EPwm1Regs.AQCTLA.bit.CAU, #2  ; SET ePWM1 on CompA-Up (force high)
;   MOV  @_EPwm1Regs.AQCTLA.bit.CAD, #2  ; SET ePWM1 on CompA-Down
   MOV  @_EPwm1Regs.AQCTLA, #160   ; SET ePWM1 on CompA-Up/Down (force high)
SkipPWM1Force:
;         MOVW DP, #_GpioDataRegs.GPADAT                 ; load Data Page to read GPIO registers
;   MOV @_GpioDataRegs.GPACLEAR, #128   ; Clear GPIO7, Used for debug purposes

ControlLoopEnd:
   ;.endif
  ;----------------------------------------------------------
;   .ref _Duty4A
;   MOVW DP, #_Vrect
;   MOVL ACC, @_Vrect
;   MOVW DP, #_Duty4A
;   MOVL    @_Duty4A, ACC ;Write 9 bit value to Duty4A

;-----------------------------------------------------------------------------------------
; Interrupt management before exit

.if(EPWMn_DPL_ISR=1)

  .if(EPWM1)
   MOVW DP,#_EPwm1Regs.ETCLR
   MOV @_EPwm1Regs.ETCLR,#0x01   ; Clear EPWM1 Int flag
  .endif ; EPWM1

  .if(EPWM2)
   MOVW DP,#_EPwm2Regs.ETCLR
   MOV @_EPwm2Regs.ETCLR,#0x01   ; Clear EPWM2 Int flag
  .endif ; EPWM2

  MOVW DP,#_PieCtrlRegs.PIEACK   ; Acknowledge PIE interrupt Group 3
  MOV @_PieCtrlRegs.PIEACK, #0x4
.endif ; EPWMn_ISR

.if(ADC_DPL_ISR=1)
; Case where ISR is triggered by ADC
; MOVW DP,#_AdcRegs.ADCINTFLGCLR
; MOV @AdcRegs.ADCINTFLGCLR, #0x01 ; Clear ADCINT1 Flag

MOVW DP,#_PieCtrlRegs.PIEACK ; Acknowledge PIE interrupt Group 1
MOV @_PieCtrlRegs.PIEACK, #0x1
.endif

;-----------------------------------------------------------------------------------------
; full context restore
;  SETC INTM     ; set INTM to protect context restore
  POP   XT
  POP   XAR7
  POP   XAR6
  POP   XAR5
  POP   XAR4
  POP   XAR3
  POP   XAR2
  POP   AR1H:AR0H
  IRET       ; return from interrupt
  .end

; end of file

7 年多前

0 Igor An 7 年多前

TI__Expert 4736 points

您的这个问题比较大,这个中断是主算法中断,简单的讲,这个中断函数中做的内容是根据Build Level进行相应的控制环路计算.

也就是主算法的计算部分.

0 shen feng 7 年多前回复 Igor An

Intellectual 318 points

这个中断干嘛的？

interrupt void SECONDARY_ISR(void)
{
EINT;

  if (VbusAvg > VBUS_OVP_THRSHLD)//Check for Vbus OV Condition VBUS_OVP_THRSHLD= 440V
  {
   OV_flag = 1;
   EALLOW;
   EPwm1Regs.TZFRC.bit.OST = 1;//Turn off PWM for OV condition
   EPwm2Regs.TZFRC.bit.OST = 1;//Turn off PWM for OV condition
   EDIS;

   VbusTargetSlewed = 0;
   VbusTarget = 0;
   Gui_Vbus_set = 0;
  }

//Calculate RMS input voltage and input frequency

sine_mainsV.Vin = Vrect >> 9; // input in IQ15 format
    SineAnalyzer_MACRO (sine_mainsV);
VrectRMS = (sine_mainsV.Vrms)<< 9;//    Convert sine_mainsV.Vrms from Q15 to Q24 and save as VrectRMS
Freq_Vin = sine_mainsV.SigFreq;// Q15
//VrmsReal = _IQ15mpy (KvInv, sine_mainsV.Vrms);

//Start of Non-linear Volt loop control
  if (run_flag == 1 && flag_NL_Vloop == 1) //If soft-start is over, PFC running normally & NL Vloop flag is set
  {

   error_v = VbusTargetSlewed - Vbus;

   if (error_v > VBUS_ERROR_NL_CNTRL_THRSHLD || ((-1)*(error_v))> VBUS_ERROR_NL_CNTRL_THRSHLD)
    // (15V/519V)*4095*4095 = 484654.0
    //(12V/519V)*4095*4095 = 387912.0
   {
   CNTL_2P2Z_CoefStruct2.b1   =_IQ26(-4.495);//(-0.7495);//(Igain_V-Pgain_V-Dgain_V-Dgain_V); // 2.5, 0.005, B1
      CNTL_2P2Z_CoefStruct2.b0   =_IQ26(4.505);//(0.7505);//(Pgain_V + Igain_V + Dgain_V);      // B0      ;//Use NL v loop coefficients
   }
   else
   {
   CNTL_2P2Z_CoefStruct2.b1   =_IQ26(-0.2495);//Otherwise use normal v loop coefficients
   CNTL_2P2Z_CoefStruct2.b0   =_IQ26(0.2505);//KP=0.25, KI=0.0005
   }
  } //End of NL V loop Control

//Start of Adaptive Current control loop
  if (disable_auto_cloop_coeff_change == 0)
  {
   if (VrectRMS <= 7588716)
   {
   //(185/409)*2e24 = 7588716,
   //KP=73750
   CNTL_2P2Z_CoefStruct1.b1   =_IQ26(-0.9722);// B1
      CNTL_2P2Z_CoefStruct1.b0   =_IQ26(1.7097); // B0
   }

   if (VrectRMS > 7588716 && VrectRMS <= 9639721)
   {
   //(235/409)*2e24 = 9639721,
   //(185/409)*2e24 = 7588716,
   //(225/409)*2e24 = 9229520,Use this lower limit for modified RC filter in CS ckt

   //KP=53750
   //CNTL_2P2Z_CoefStruct1.b1   =_IQ26(-0.7085);// B1
      //CNTL_2P2Z_CoefStruct1.b0   =_IQ26(1.246); // B0

      //KP=63750
   CNTL_2P2Z_CoefStruct1.b1   =_IQ26(-0.8403);// B1
      CNTL_2P2Z_CoefStruct1.b0   =_IQ26(1.4778); // B0

   }

   if (VrectRMS > 9639721 && VrectRMS <= 10049922)
   {
   // (235/409)*2e24 = 9639721,
   //(245/409)*2e24 = 10049922,

    //KP=33750
   //CNTL_2P2Z_CoefStruct1.b1   =_IQ26(-0.4449);// B1
      //CNTL_2P2Z_CoefStruct1.b0   =_IQ26(0.7824); // B0

      //KP=13750
   CNTL_2P2Z_CoefStruct1.b1   =_IQ26(-0.1812);// B1
      CNTL_2P2Z_CoefStruct1.b0   =_IQ26(0.3187); // B0
   }

   if (VrectRMS > 10049922 && VrectRMS <= 10255022)
   {
   // (245/409)*2e24 = 10049922,
   //(250/409)*2e24 = 10255022,

    //KP=23750
   //CNTL_2P2Z_CoefStruct1.b1   =_IQ26(-0.3131);// B1
      //CNTL_2P2Z_CoefStruct1.b0   =_IQ26(0.5506); // B0

      //KP=13750
   CNTL_2P2Z_CoefStruct1.b1   =_IQ26(-0.1812);// B1
      CNTL_2P2Z_CoefStruct1.b0   =_IQ26(0.3187); // B0
   }

   if (VrectRMS > 10255022)
   {
   //(250/409)*2e24 = 10255022,
    //KP=13750
   CNTL_2P2Z_CoefStruct1.b1   =_IQ26(-0.1812);// B1
      CNTL_2P2Z_CoefStruct1.b0   =_IQ26(0.3187); // B0
   }
  }//End of Adaptive Current control loop

EPwm7Regs.ETCLR.bit.INT = 1; // Enable ePWM7 INTN pulse
PieCtrlRegs.PIEACK.all = PIEACK_GROUP3;
return;
}

0 Igor An 7 年多前回复 shen feng

TI__Expert 4736 points

您可以逐句读一下代码，应该可以和控制理论结构对得上，这个中断主要处理控制算法中相对较慢速的算法部分。

如输入电压单位正弦提取，一些补偿算法等。

C2000 微控制器

C2000™︎ 微控制器论坛

关于controlsuit中PFC电路的BridgelessPFC-DPL-ISR.asm