dev_iso_voltage_sense.c

/*
 * File:   dev_iso_voltage_sense.c
 * Author: M70027
 *
 * Created on Jan 17, 2024, 13:30 PM
 */
 
#include "dev_iso_voltage_sense.h"
#include "../sources/fault/fault_common.h"
 
 
dev_iso_voltage_data_t  dev_iso_voltage_data;
dev_iso_voltage_data_t* dev_iso_voltage_data_ptr = &dev_iso_voltage_data;
 
 
static uint16_t interrupt_counter = 0;
 
 
FAULT_OBJ_T Vin_Fault_Min;
 
 
FAULT_OBJ_T Vin_Fault_Max;
 
 
void Dev_Iso_Voltage_Sens_Callback(void);   
void Dev_Iso_Voltage_Sens_Calculate_Average(void);
uint16_t Iso_Calculate_Average(uint16_t * buffer, uint16_t length);
void default_faultcallback_max(FAULT_OBJ_T* faultInput); 
void default_faultcallback_min(FAULT_OBJ_T* faultInput);
 
 
 
void Dev_Iso_Voltage_Sens_Init(){
    dev_iso_voltage_data.over_voltage_flag = 0;          
    dev_iso_voltage_data.under_voltage_flag = 0;         
    dev_iso_voltage_data.no_signal_flag = 0;             
    dev_iso_voltage_data.buffer_full = 0;                
    dev_iso_voltage_data.voltage_buffer_idx = 0;         
    
    FAULT_Init(
            &Vin_Fault_Min,                             
            UV_THRESHOLD_RAW,                           
            UV_LOWER_THRESHOLD_WITH_HYST,               
            FAULT_PERSISTENCE_COUNT,                    
            FAULT_PERSISTENCE_COUNT                     
            ) ; 
    
    FAULT_Init(
            &Vin_Fault_Max, 
            OV_THRESHOLD_RAW,               
            OV_UPPER_THRESHOLD_WITH_HYST,
            FAULT_PERSISTENCE_COUNT,
            FAULT_PERSISTENCE_COUNT ) ;
            
    InputCapture_CallbackRegister(Dev_Iso_Voltage_Sens_Callback);
}
 
void Dev_Iso_Voltage_Task_1ms(void) {
    
    if (interrupt_counter < INTERRUPT_COUNTS_MIN || interrupt_counter > INTERRUPT_COUNTS_MAX)
        dev_iso_voltage_data.no_signal_flag = 1;
    else 
        dev_iso_voltage_data.no_signal_flag = 0;
    
    interrupt_counter = 0;
    //GPIO_1_Toggle();
}
 
 
void Dev_Reset_Average_Buffer() {
    dev_iso_voltage_data.voltage_buffer_idx  = 0;
    dev_iso_voltage_data.buffer_full = 0;
}
 
 
uint16_t Dev_Get_Iso_Voltage_avg(void) 
{
    if (dev_iso_voltage_data.buffer_full)
        return Iso_Calculate_Average(dev_iso_voltage_data.voltage_buffer, MAX_NUM_SAMPLES_ISO_BUFFER);
    else 
        return 0;
}
 
 
uint16_t Dev_Get_Iso_Voltage(void) 
{
        return dev_iso_voltage_data.voltage_raw; 
}
 
 
 
uint8_t Dev_Iso_Voltage_Is_OV(void) 
{
        return dev_iso_voltage_data.over_voltage_flag; 
}
 
 
uint8_t Dev_Iso_Voltage_Is_UV(void) 
{
    return dev_iso_voltage_data.under_voltage_flag; 
}
 
 
 
void Dev_Iso_Voltage_Sens_Callback() {
    uint8_t i = 0;
    static uint16_t vdd_sens_buff[CCP_INPUT_CAPTURE_BUFFER];
    
    if (InputCapture_bufferoverflow)
    {
        i = 0;
        while ((!InputCapture_BufferEmpty) || (i < CCP_INPUT_CAPTURE_BUFFER)) 
        {
            vdd_sens_buff[i++] = CCP_BUF_L;
        }
        dev_iso_voltage_data.voltage_raw = vdd_sens_buff[2] - vdd_sens_buff[1];
        dev_iso_voltage_data.voltage_buffer[dev_iso_voltage_data.voltage_buffer_idx++] = dev_iso_voltage_data.voltage_raw ;
        
        CCP_TIMER_HIGH_REG = 0;
        CCP_TIMER_LOW_REG = 0;
    }
    CCP_INTERRUPT_FLAG = 0;
 
    interrupt_counter++ ;
    
    if (dev_iso_voltage_data.voltage_buffer_idx >= (MAX_NUM_SAMPLES_ISO_BUFFER - 1))  {      
        dev_iso_voltage_data.voltage_buffer_idx = 0;
       dev_iso_voltage_data.buffer_full = 1;    
    }
    
    if(FAULT_CheckMax(&Vin_Fault_Max, dev_iso_voltage_data.voltage_raw, NULL ))
    {
        dev_iso_voltage_data.over_voltage_flag = 1; //for overvoltage
    }
    else
    {
        dev_iso_voltage_data.over_voltage_flag = 0; //for overvoltage
    }
 
    if(FAULT_CheckMin(&Vin_Fault_Min, dev_iso_voltage_data.voltage_raw, NULL ))
    {
        dev_iso_voltage_data.under_voltage_flag = 1; //for overvoltage
    } 
    else
    {
        dev_iso_voltage_data.under_voltage_flag = 0; //for overvoltage
    }
}
 
 
uint16_t Iso_Calculate_Average(uint16_t * buffer, uint16_t length) {
    uint16_t index = 0;
    uint32_t sum = 0;
    for (index = 0; index <length; index++)
        sum +=buffer[index];
    return (sum >> MAX_NUM_SAMPLES_ISO_BUFFER_AS_EXP_OF_TWO);
}