mirror of https://github.com/rusefi/wideband.git
52 lines
1.1 KiB
C++
52 lines
1.1 KiB
C++
|
#include "ch.h"
|
||
|
|
#include "hal.h"
|
||
|
|
|
||
|
|
#include "io_pins.h"
|
||
|
|
#include "livedata.h"
|
||
|
|
|
||
|
|
#include "sampling.h"
|
||
|
|
#include "port.h"
|
||
|
|
|
||
|
|
static Sampler samplers[AFR_CHANNELS];
|
||
|
|
|
||
|
|
const ISampler& GetSampler(int ch)
|
||
|
|
{
|
||
|
|
return samplers[ch];
|
||
|
|
}
|
||
|
|
|
||
|
|
static THD_WORKING_AREA(waSamplingThread, 256);
|
||
|
|
|
||
|
|
static void SamplingThread(void*)
|
||
|
|
{
|
||
|
|
chRegSetThreadName("Sampling");
|
||
|
|
|
||
|
|
SetupESRDriver(GetSensorType());
|
||
|
|
|
||
|
|
/* GD32: Insert 20us delay after ADC enable */
|
||
|
|
chThdSleepMilliseconds(1);
|
||
|
|
|
||
|
|
while(true)
|
||
|
|
{
|
||
|
|
auto result = AnalogSample();
|
||
|
|
|
||
|
|
// Toggle the pin after sampling so that any switching noise occurs while we're doing our math instead of when sampling
|
||
|
|
ToggleESRDriver(GetSensorType());
|
||
|
|
|
||
|
|
for (int ch = 0; ch < AFR_CHANNELS; ch++)
|
||
|
|
{
|
||
|
|
samplers[ch].ApplySample(result.ch[ch], result.VirtualGroundVoltageInt);
|
||
|
|
}
|
||
|
|
|
||
|
|
#if defined(TS_ENABLED)
|
||
|
|
/* tunerstudio */
|
||
|
|
SamplingUpdateLiveData();
|
||
|
|
#endif
|
||
|
|
}
|
||
|
|
}
|
||
|
|
|
||
|
|
void StartSampling()
|
||
|
|
{
|
||
|
|
adcStart(&ADCD1, nullptr);
|
||
|
|
chThdCreateStatic(waSamplingThread, sizeof(waSamplingThread), NORMALPRIO + 5, SamplingThread, nullptr);
|
||
|
|
}
|