fault_common.c

 
#include "fault_common.h"
#include "system/pins.h"
#include <stdbool.h>
#include <stddef.h>
 
 
void FAULT_Init(FAULT_OBJ_T *faultInput,
                int16_t  threshold, int16_t  hysLimit,
                uint16_t thresholdCnt, uint32_t hysCnt)
{
  faultInput->Val1_Threshold = threshold;
  faultInput->Val1_Hysteresis = hysLimit;
  faultInput->CounterSet = thresholdCnt;
  faultInput->CounterReset = hysCnt;
  faultInput->FaultCode = 0U;
  faultInput->FaultActive = 0;
}
 
 
void FAULT_InitRange(FAULT_OBJ_T *faultInput,
                int16_t  thresholdMin, int16_t  hysLimitMin,
                int16_t  thresholdMax, int16_t  hysLimitMax,
                uint16_t thresholdCnt, uint32_t hysCnt)
{
  faultInput->Val1_Threshold = thresholdMin;
  faultInput->Val1_Hysteresis = hysLimitMin;
  faultInput->Val2_Threshold = thresholdMax;
  faultInput->Val2_Hysteresis = hysLimitMax;
  faultInput->CounterSet = thresholdCnt;
  faultInput->CounterReset = hysCnt;
  faultInput->FaultCode = 0U;
  faultInput->FaultActive = 0;
  faultInput->FaultLatch = 0;
}
 
 
void FAULT_SetCounters(FAULT_OBJ_T *faultInput, uint16_t fltThresholdCnt, uint32_t fltHysCnt)
{
   faultInput->CounterSet = fltThresholdCnt;
   faultInput->CounterReset = fltHysCnt;
}
 
 
void FAULT_SetThresholds(FAULT_OBJ_T *faultInput, int16_t fltThreshold, int16_t fltHysLimit)
{
   faultInput->Val1_Threshold = fltThreshold;
   faultInput->Val1_Hysteresis = fltHysLimit;
}
 
 
bool FAULT_CheckMax(FAULT_OBJ_T *faultInput, int16_t faultSource, FAULT_CALLBACK callback)
{
 
  if ((faultSource >= faultInput->Val1_Threshold) && (faultInput->FaultActive == false))
  {
    faultInput->FaultCounter++;
 
    if (faultInput->FaultCounter > faultInput->CounterSet)
    {
      faultInput->FaultLatch = true;
      
      if (callback != NULL)
      {
        callback(); // Call Back function used to quickly shutdown system if needed when fault detected
      }
 
      faultInput->FaultActive = true;
      faultInput->FaultCounter = 0U;
    }
  } 
  else if ((faultSource < (faultInput->Val1_Hysteresis)) && (faultInput->FaultActive == true))
  {
    faultInput->FaultCounter++;
    if (faultInput->FaultCounter > faultInput->CounterReset)
    {
      faultInput->FaultCounter = 0U;
      faultInput->FaultActive = false;
    }
  }
  else
  {
    faultInput->FaultCounter = 0U;
  }
 
  return (faultInput->FaultActive);
 
}
 
 
bool FAULT_CheckMin(FAULT_OBJ_T *faultInput, int16_t faultSource, FAULT_CALLBACK callback)
{
 
  if ((faultSource <= faultInput->Val1_Threshold) && (faultInput->FaultActive == false))
  {
    faultInput->FaultCounter++;
    if (faultInput->FaultCounter > faultInput->CounterSet)
    {
       faultInput->FaultLatch = true;
        
      if (callback != NULL)
      {
        callback(); // Call Back function used to quickly shutdown system if needed when fault detected
      }
 
      faultInput->FaultActive = true;
      faultInput->FaultCounter = 0U;
    }
  }
  else if ((faultSource > (faultInput->Val1_Hysteresis)) && (faultInput->FaultActive == true))
  {
    faultInput->FaultCounter++;
    if (faultInput->FaultCounter > faultInput->CounterReset)
    {
      faultInput->FaultCounter = 0U;
      faultInput->FaultActive = false;
    }
  }
  else
  {
    faultInput->FaultCounter = 0U;
  }
 
  return (faultInput->FaultActive);
 
}
 
 
bool FAULT_CheckBit(FAULT_OBJ_T *faultInput, bool faultBit, FAULT_CALLBACK callback)
{
  if ((faultBit) && (faultInput->FaultActive == false))
  {
    faultInput->FaultCounter++;
 
    if (faultInput->FaultCounter > faultInput->CounterSet)
    {
      faultInput->FaultLatch = true;
      
      if (callback != NULL)
      {
        callback(); // Call Back function used to quickly shutdown system if needed when fault detected
      }
 
      faultInput->FaultActive = true;
      faultInput->FaultCounter = 0U;
    }
  }
  else if ((!faultBit) && (faultInput->FaultActive == true))
  {
    faultInput->FaultCounter++;
    if (faultInput->FaultCounter > faultInput->CounterReset)
    {
      faultInput->FaultCounter = 0U;
      faultInput->FaultActive = false;
    }
  } else
  {
    faultInput->FaultCounter = 0U;
  }
 
  return (faultInput->FaultActive);
}
 
 
bool FAULT_CheckRange(FAULT_OBJ_T *faultInput, int16_t inputValue, FAULT_CALLBACK callback)
{
    if (faultInput->FaultActive == false)
    {
        if ((inputValue <= faultInput->Val1_Threshold) ||
            (inputValue >= faultInput->Val2_Threshold))
        {
            if (++faultInput->FaultCounter >= faultInput->CounterSet)
            {
                faultInput->FaultLatch = true;
                
                if (callback != NULL)
                {
                    callback(); // Call Back function used to quickly shutdown system if needed when fault detected
                }
                faultInput->FaultActive = true;
                faultInput->FaultCounter = 0U;
            }
        }
        else
        {    
            faultInput->FaultCounter = 0U;
        }    
    }
    else
    {
        if ((inputValue > faultInput->Val1_Hysteresis) &&
            (inputValue < faultInput->Val2_Hysteresis))
        {
            if (++faultInput->FaultCounter > faultInput->CounterReset)
            {
                faultInput->FaultCounter = 0U;
                faultInput->FaultActive = false;
            }
        }
        else
        {   
            faultInput->FaultCounter = 0U;
        }    
    }
    return (faultInput->FaultActive);
}