mirror of https://github.com/rusefi/wideband.git
49 lines
1.1 KiB
C++
49 lines
1.1 KiB
C++
#include "analog_input.h"
|
|
|
|
#include "wideband_config.h"
|
|
|
|
#include "hal.h"
|
|
|
|
#define ADC_CHANNEL_COUNT 3
|
|
|
|
static adcsample_t adcBuffer[ADC_CHANNEL_COUNT * ADC_OVERSAMPLE];
|
|
|
|
ADCConversionGroup convGroup =
|
|
{
|
|
false,
|
|
ADC_CHANNEL_COUNT,
|
|
nullptr,
|
|
nullptr,
|
|
ADC_CFGR1_CONT | ADC_CFGR1_RES_12BIT, // CFGR1
|
|
ADC_TR(0, 0), // TR
|
|
ADC_SMPR_SMP_28P5, // SMPR
|
|
ADC_CHSELR_CHSEL0 | ADC_CHSELR_CHSEL1 | ADC_CHSELR_CHSEL2
|
|
};
|
|
|
|
static float AverageSamples(adcsample_t* buffer, size_t idx)
|
|
{
|
|
uint32_t sum = 0;
|
|
|
|
for (size_t i = 0; i < ADC_OVERSAMPLE; i++)
|
|
{
|
|
sum += buffer[idx];
|
|
idx += ADC_CHANNEL_COUNT;
|
|
}
|
|
|
|
constexpr float scale = VCC_VOLTS / (ADC_MAX_COUNT * ADC_OVERSAMPLE);
|
|
|
|
return (float)sum * scale;
|
|
}
|
|
|
|
AnalogResult AnalogSample()
|
|
{
|
|
adcConvert(&ADCD1, &convGroup, adcBuffer, ADC_OVERSAMPLE);
|
|
|
|
return
|
|
{
|
|
.NernstVoltage = AverageSamples(adcBuffer, 0) * NERNST_INPUT_GAIN,
|
|
.VirtualGroundVoltage = AverageSamples(adcBuffer, 1),
|
|
.PumpCurrentVoltage = AverageSamples(adcBuffer, 2),
|
|
};
|
|
}
|