88 lines
2.4 KiB
C++
88 lines
2.4 KiB
C++
#include "potis.h"
|
|
|
|
// 3rdparty lib includes
|
|
#include <Arduino.h>
|
|
#include <cpputils.h>
|
|
|
|
// local includes
|
|
#include "globals.h"
|
|
#ifdef FEATURE_CAN
|
|
#include "can.h"
|
|
#endif
|
|
#include "newsettings.h"
|
|
|
|
using namespace std::chrono_literals;
|
|
|
|
void initPotis()
|
|
{
|
|
raw_gas = std::nullopt;
|
|
raw_brems = std::nullopt;
|
|
gas = std::nullopt;
|
|
brems = std::nullopt;
|
|
|
|
readPotis();
|
|
}
|
|
|
|
void readPotis()
|
|
{
|
|
[[maybe_unused]]
|
|
constexpr auto sampleMultipleTimes = [](uint8_t pin){
|
|
analogRead(pin);
|
|
double sum{};
|
|
const auto sampleCount = configs.sampleCount.value;
|
|
for (int i = 0; i < sampleCount; i++)
|
|
sum += analogRead(pin);
|
|
return sum / sampleCount;
|
|
};
|
|
|
|
raw_gas = std::nullopt;
|
|
raw_brems = std::nullopt;
|
|
|
|
#ifdef FEATURE_CAN
|
|
const auto now = espchrono::millis_clock::now();
|
|
|
|
if (can::can_gas)
|
|
{
|
|
if (now - can::last_can_gas < 100ms)
|
|
raw_gas = *can::can_gas;
|
|
else
|
|
can::can_gas = std::nullopt;
|
|
}
|
|
|
|
if (can::can_brems)
|
|
{
|
|
if (now - can::last_can_brems < 100ms)
|
|
raw_brems = *can::can_brems;
|
|
else
|
|
can::can_brems = std::nullopt;
|
|
}
|
|
#endif
|
|
|
|
#ifdef FEATURE_ADC_IN
|
|
if (!raw_gas)
|
|
raw_gas = sampleMultipleTimes(PINS_GAS);
|
|
if (!raw_brems)
|
|
raw_brems = sampleMultipleTimes(PINS_BREMS);
|
|
#endif
|
|
|
|
if (raw_gas)
|
|
gas = cpputils::mapValueClamped<float>(*raw_gas, configs.gasMin.value, configs.gasMax.value, 0., 1000.);
|
|
else
|
|
gas = std::nullopt;
|
|
if (raw_brems)
|
|
brems = cpputils::mapValueClamped<float>(*raw_brems, configs.bremsMin.value, configs.bremsMax.value, 0., 1000.);
|
|
else
|
|
brems = std::nullopt;
|
|
|
|
#ifdef FEATURE_GAMETRAK
|
|
raw_gametrakX = sampleMultipleTimes(PINS_GAMETRAKX);
|
|
gametrakX = cpputils::mapValueClamped<float>(raw_gametrakX, settings.boardcomputerHardware.gametrakXMin, settings.boardcomputerHardware.gametrakXMax, 0., 1000.);
|
|
|
|
raw_gametrakY = sampleMultipleTimes(PINS_GAMETRAKY);
|
|
gametrakY = cpputils::mapValueClamped<float>(raw_gametrakY, settings.boardcomputerHardware.gametrakYMin, settings.boardcomputerHardware.gametrakYMax, 0., 1000.);
|
|
|
|
raw_gametrakDist = sampleMultipleTimes(PINS_GAMETRAKDIST);
|
|
gametrakDist = cpputils::mapValueClamped<float>(raw_gametrakDist, settings.boardcomputerHardware.gametrakDistMin, settings.boardcomputerHardware.gametrakDistMax, 0., 1000.);
|
|
#endif
|
|
}
|