mirror of
https://github.com/RobTillaart/Arduino.git
synced 2024-09-19 16:46:11 -04:00
89 lines
1.4 KiB
C++
89 lines
1.4 KiB
C++
//
|
|
// FILE: AnalogPin.cpp
|
|
// AUTHOR: Rob Tillaart
|
|
// VERSION: 0.2.9
|
|
// DATE: 2013-09-09
|
|
// PURPOSE: wrapper for analogRead with smoothing and noise filtering
|
|
|
|
|
|
#include "AnalogPin.h"
|
|
|
|
|
|
AnalogPin::AnalogPin(const uint8_t pin)
|
|
{
|
|
_pin = pin;
|
|
_prescaler = 7;
|
|
_alpha = 0;
|
|
_noise = 0;
|
|
_rawRead();
|
|
_prevValue = _value;
|
|
}
|
|
|
|
|
|
void AnalogPin::setPrescaler(const uint8_t prescaler)
|
|
{
|
|
_prescaler = prescaler;
|
|
if (_prescaler < 2) _prescaler = 2;
|
|
else if (_prescaler > 7) _prescaler = 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 | _prescaler);
|
|
#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 --
|
|
|