dev_current_sensor.c

Go to the documentation of this file.

 
 
#include <stdbool.h>
#include "config/macros.h"
#include "adc/adc1.h"
 
#define SENSOR_OFFSET_NUM_MEASUREMENTS      (1000) 
 
 
struct SENSOR_OFFSET_CAL_s
{  
  uint32_t  Accumulator; 
  uint16_t  MeasurementCounter; 
  uint16_t  Offset; 
  bool      CalibrationComplete; 
  uint16_t  LimitHigh;  
  uint16_t  LimitLow; 
};
typedef struct SENSOR_OFFSET_CAL_s SENSOR_OFFSET_CAL_t;
 
 
SENSOR_OFFSET_CAL_t isecAvgCurrentSensor = {.CalibrationComplete = false,
                                               .Accumulator = 0,
                                               .MeasurementCounter = 0,
                                               .LimitHigh = ISEC_AVG_SENSOR_OFFSET_LIMIT_HIGH,
                                               .LimitLow = ISEC_AVG_SENSOR_OFFSET_LIMIT_LOW};
 
 
static void __inline__ Dev_SensorOffsetCal(SENSOR_OFFSET_CAL_t* sensor, uint16_t adcReading)
{
    // current sensor offset is not measured
    sensor->Accumulator += adcReading;
    if (++sensor->MeasurementCounter >= SENSOR_OFFSET_NUM_MEASUREMENTS)
    {
        // average to determine the offset      
        uint16_t offset = (uint16_t) (__builtin_divud(sensor->Accumulator, sensor->MeasurementCounter));
 
        sensor->Accumulator = 0;
        sensor->MeasurementCounter = 0;
 
        // check if result is within acceptable limits
        if ((offset < sensor->LimitHigh) && (offset > sensor->LimitLow))
        {
            // measured offset is reasonable. Update stored value and exit
            sensor->Offset = offset;
            sensor->CalibrationComplete = true;
        }
    }    
}
 
 
void Dev_CurrentSensorOffsetCal(void)
{
    if (!isecAvgCurrentSensor.CalibrationComplete)
    {
        Dev_SensorOffsetCal(&isecAvgCurrentSensor, ADC1_ConversionResultGet(ISEC_AVG));
    }
}
 
 
uint16_t Dev_CurrentSensor_Get_CalibrationStatus(void)
{
    return(isecAvgCurrentSensor.CalibrationComplete);
}
 
 
uint16_t Dev_CurrentSensor_Get_Offset(void)
{
    return(isecAvgCurrentSensor.Offset); 
}
 
 
void Dev_CurrentSensor_Clr_Offset(void)
{
    isecAvgCurrentSensor.CalibrationComplete=false; 
}