GY-63_MS5611/libraries/AnalogPin/AnalogPin.cpp
2022-10-28 21:33:10 +02:00

92 lines
1.4 KiB
C++

//
// FILE: AnalogPin.cpp
// AUTHOR: Rob Tillaart
// VERSION: 0.2.7
// DATE: 2013-09-09
// PURPOSE: wrapper for analogRead with smoothing and noise filtering
//
// HISTORY: see changelog
#include "AnalogPin.h"
AnalogPin::AnalogPin(const uint8_t pin)
{
_pin = pin;
_prescale = 7;
_alpha = 0;
_noise = 0;
_rawRead();
_prevValue = _value;
}
void AnalogPin::setPrescaler(const uint8_t prescale)
{
_prescale = prescale;
if (_prescale < 2) _prescale = 2;
else if (_prescale > 7) _prescale = 7;
};
void AnalogPin::setSmoothWeight(const uint8_t alpha)
{
_alpha = alpha;
if (_alpha > 31) _alpha = 31;
};
int AnalogPin::read(const bool twice)
{
if (twice) _rawRead();
_rawRead();
if ( (_noise == 0) || (((_value - _prevValue) & 0x7FFF) > _noise) )
{
_prevValue = _value;
}
return _prevValue;
}
int AnalogPin::readSmoothed()
{
_rawRead();
if (_alpha > 0)
{
_value = _value + (_alpha * (_prevValue - _value)) / 32;
}
_prevValue = _value;
return _value;
}
void AnalogPin::_rawRead()
{
#if defined(ARDUINO_ARCH_AVR)
// remember old register value
uint8_t ADCSRA_TMP = ADCSRA;
ADCSRA = (ADCSRA | 0x07) & (0xF8 | _prescale);
#elif defined(ARDUINO_ARCH_SAM)
#else
#endif
_value = analogRead(_pin);
#if defined(ARDUINO_ARCH_AVR)
// restore register
ADCSRA = ADCSRA_TMP;
#elif defined(ARDUINO_ARCH_SAM)
#else
#endif
}
// -- END OF FILE --