pwrctrl_isr_extension.c

Go to the documentation of this file.

 
#include <xc.h>
#include <math.h>
#include <stdbool.h>
#include <stdlib.h>
 
// MCC header files
#include "adc/adc_types.h"
#include "adc/adc1.h"
#include "system/pins.h"
 
// PSFB header files
//#include "config/macros.h"
//#include "config/config.h"
#include "pwrctrl.h"
#include "fault/fault.h"
#include "dcdt/pwrctrl_dcdt.h"
 
 
 
 
void PwrCtrl_UpdateADConverterData (void)
{        
    // Enable the ADC sampling
    // ADC1_SoftwareTriggerEnable();
    
/*     if(ADC1_IsConversionComplete(I_SEC_AVG_FILT))
        psfb_ptr->Data.ISenseSecondary = ADC1_ConversionResultGet(I_SEC_AVG_FILT);  */
    
/*     if(ADC1_IsConversionComplete(IPRI_CT))
        psfb_ptr->Data.ISensePrimary = ADC1_ConversionResultGet(IPRI_CT);    */
    
    if(ADC1_IsConversionComplete(FB_5V)){
        psfb_ptr->Data.VRail_5V = ADC1_ConversionResultGet(FB_5V); 
    }
    
    if(ADC1_IsConversionComplete(FB_TEMP))
        psfb_ptr->Data.Temperature = ADC1_ConversionResultGet(FB_TEMP);
 
    if(ADC1_IsConversionComplete(FB_VCAP))
        psfb_ptr->Data.VCapVoltage = ADC1_ConversionResultGet(FB_VCAP);
    
    if(ADC1_IsConversionComplete(VIN_INT_AN)){
        psfb_ptr->Data.VInVoltage = ADC1_ConversionResultGet(VIN_INT_AN);
        // vPrimAveraging.Accumulator += psfb_ptr->Data.VInVoltage;
        // vPrimAveraging.Counter = vPrimAveraging.Counter + 1;   
    }
    
    if(ADC1_IsConversionComplete(FB_VOUT)){
        psfb_ptr->Data.VOutVoltage = ADC1_ConversionResultGet(FB_VOUT);
        // vOutAveraging.Accumulator += psfb_ptr->Data.VOutVoltage;
        // vOutAveraging.Counter = vOutAveraging.Counter + 1; 
    }
    
//    if(ADC1_IsConversionComplete(I_SEC_AVG_FILT)){
//        psfb_ptr->Data.ISenseSecondary = ADC1_ConversionResultGet(I_SEC_AVG_FILT); 
//        psfb_ptr->Data.ISecAverageRectified = abs(psfb_ptr->Data.ISenseSecondary - psfb_ptr->Data.ISecSensorOffset);
//        iSecAveraging.Accumulator += psfb_ptr->Data.ISecAverageRectified;
//        iSecAveraging.Counter = iSecAveraging.Counter + 1;
//    }
}
 
 
 
void PwrCtrl_ControlLoopExecute(void)
{   
    // control loop execute 
    uint16_t IloopReference = 0;
    
    if (psfb_ptr->VLoop.Enable == 1) {
        // psfb_ptr->VLoop.Feedback = psfb_ptr->Data.VCapVoltage;  
        psfb_ptr->VLoop.Feedback = psfb_ptr->Data.VOutVoltage;
        
            SMPS_Controller2P2ZUpdate(
                &VMC_2p2z,                      // SPMPS_2P2Z_T pointer type structure
                &(psfb_ptr->VLoop.Feedback),    // pointer to the input source register or variable being tracked by 2P2Z
                psfb_ptr->VLoop.Reference,      // VLoopReference from Vramp
                &(psfb_ptr->VLoop.Output)       // pointer to the control loop target register of the calculated result 
            );
    }     
    // Vloop output 
    IloopReference = psfb_ptr->VLoop.Output; 
    
    if (psfb_ptr->ILoop.Enable == 1) {
//        psfb_ptr->ILoop.Feedback = psfb_ptr->Data.ISenseSecondary;
        psfb_ptr->ILoop.Feedback = psfb_ptr->Secondary_Rolling_val;
 
        SMPS_Controller3P3ZUpdate(
            &IMC_3p3z,                      // SPMPS_2P2Z_T pointer type structure
            &(psfb_ptr->ILoop.Feedback),    // pointer to the input source register or variable being tracked by 2P2Z
            //psfb_ptr->ILoop.Reference,      // ILoopReference from Iramp
            psfb_ptr->VLoop.Output,                 // IloopReference from Vloop
            &(psfb_ptr->ILoop.Output)          // pointer to the control loop target register of the calculated result 
        );   
 
        // temporary
        // psfb_ptr->iloop_output =    psfb_ptr->ILoop.Output;
        // psfb_ptr->vloop_output =    psfb_ptr->VLoop.Output;
        
        
        PwrCtrl_SetPhaseTarget(psfb_ptr->ILoop.Output);
        PwrCtrl_PWM_Update();
    }
}
 
 
void PwrCtrl_DroopAverage(void) {
    // average of last 100 values
    if(psfb_ptr->ISecAveraging.Counter >= 99) {
        psfb_ptr->ISecAveraging.AverageValue = (uint16_t)(__builtin_divud(psfb_ptr->ISecAveraging.Accumulator, psfb_ptr->ISecAveraging.Counter));
        psfb_ptr->ISecAveraging.Accumulator = 0;
        psfb_ptr->ISecAveraging.Counter = 0;
    }
}