app_power_control.c

/*
 * File:   app_power_control.c
 * Author: M91406
 *
 * Created on March 12, 2020, 11:55 AM
 */
 
#include <stdbool.h>
 
#include "drivers/v_loop.h"
#include "devices/dev_buck_typedef.h"
#include "devices/dev_buck_converter.h"
#include "config/hal.h"
 
#include "fault_handler/app_fault_monitor.h"
 
 
volatile struct BUCK_CONVERTER_s buck;
 
/* PRIVATE EXTERNAL FUNCTION PROTOTYPES */
extern volatile uint16_t appPowerSupply_ConverterObjectInitialize(void);
extern volatile uint16_t appPowerSupply_ControllerInitialize(void);
extern volatile uint16_t appPowerSupply_PeripheralsInitialize(void);
 
/* PRIVATE INTERNAL FUNCTION PROTOTYPES */
volatile uint16_t __attribute__((always_inline)) appPowerSupply_DataCapture(void);
 
/* *************************************************************************************************
 * PRIVATE VARIABLE DECLARATIONS
 * ************************************************************************************************/
#define ISNS_AVG_BITMASK    (uint16_t)0x0007
volatile uint16_t _isns_sample_count = 0;
volatile uint16_t isns_samples;
 
/* *************************************************************************************************
 * PUBLIC FUNCTIONS
 * ************************************************************************************************/
 
 
 
volatile uint16_t appPowerSupply_Execute(void)
{ 
    volatile uint16_t retval=1;
 
    // Capture data values, which are not captured by the controller automatically
    retval = appPowerSupply_DataCapture();
    
    // Execute buck converter state machine
    retval &= drv_BuckConverter_Execute(&buck);
 
    // Buck regulation error is only active while controller is running
    // and while being tied to a valid reference
    if(((buck.state_id.bits.opstate_id  >= BUCK_OPSTATE_RAMPUP) &&
        (buck.state_id.bits.substate_id >= BUCK_OPSTATE_V_RAMP_UP)) ||
       ((buck.state_id.bits.opstate_id  == BUCK_OPSTATE_ONLINE)))
    {
        fltobj_BuckRegErr.ReferenceObject.ptrObject = buck.v_loop.controller->Ports.ptrControlReference;
        #if (PLANT_MEASUREMENT == false)
        fltobj_BuckRegErr.Status.bits.Enabled = buck.v_loop.controller->status.bits.enabled;
        fltobj_BuckOCP.Status.bits.Enabled = buck.v_loop.controller->status.bits.enabled;
        #endif
    }
    else {
        fltobj_BuckRegErr.Status.bits.Enabled = false;
        fltobj_BuckOCP.Status.bits.Enabled = false;
    }
    
    return(retval); 
}
 
 
volatile uint16_t appPowerSupply_Initialize(void)
{ 
    volatile uint16_t retval=1;
 
    // Run initialization sequence
    retval &= appPowerSupply_ConverterObjectInitialize();
    retval &= appPowerSupply_ControllerInitialize();
    retval &= appPowerSupply_PeripheralsInitialize();
 
    // Initialize Control Interrupt
    _BUCK_VLOOP_ISR_IP = BUCK_VOUT_ISR_PRIORITY;
    _BUCK_VLOOP_ISR_IF = 0;
    _BUCK_VLOOP_ISR_IE = true;
    
    // Enable Buck Converter
    retval &= drv_BuckConverter_Start(&buck);
    
    return(retval); 
}
 
 
volatile uint16_t appPowerSupply_Start(void)
{
    volatile uint16_t retval=1;
 
    retval &= drv_BuckConverter_Start(&buck); // Start PWM with outputs disabled to start ADC triggering
 
    return(retval); 
}
 
 
volatile uint16_t appPowerSupply_Stop(void)
{
    volatile uint16_t retval=1;
 
    retval &= drv_BuckConverter_Stop(&buck); // Shut down all power supply peripherals and data objects
 
    return(retval); 
}
 
volatile uint16_t appPowerSupply_Suspend(void)
{ 
    volatile uint16_t retval=1;
 
    retval &= drv_BuckConverter_Suspend(&buck); // Shut down PWM immediately
 
    return(retval); 
}
 
 
volatile uint16_t appPowerSupply_Resume(void)
{ 
    volatile uint16_t retval=0;
 
    retval &= drv_BuckConverter_Resume(&buck); // Shut down PWM immediately
    
    return(retval); 
}
 
/* *************************************************************************************************
 * PRIVATE FUNCTIONS
 * ************************************************************************************************/
 
 
volatile uint16_t appPowerSupply_DataCapture(void) 
{
    volatile uint16_t retval=0;
 
    buck.data.v_in = (BUCK_VIN_ADCBUF - BUCK_VIN_OFFSET);
    buck.data.temp = TEMP_ADCBUF;
    buck.data.i_sns[0] = BUCK_ISNS_ADCBUF;
    if (buck.data.control_output < 210)
        buck.data.i_sns[0] = buck.data.control_output;
    else
        buck.data.i_sns[0] = (buck.data.control_output - 210);
 
    // Average inductor current value
    isns_samples += buck.data.i_sns[0];
    if(!(++_isns_sample_count & ISNS_AVG_BITMASK))
    {
        isns_samples = (isns_samples >> 3);
        isns_samples -= buck.i_loop[0].feedback_offset;
        if((int16_t)isns_samples < 0) isns_samples = 0;
 
        buck.data.i_out = isns_samples;
        
        isns_samples = 0; // Reset data buffer
    }
    
    return(retval); 
}
 
// end of file