GY-63_MS5611/libraries/Fletcher/Fletcher32.cpp
2022-09-08 13:31:39 +02:00

58 lines
964 B
C++

//
// FILE: Fletcher32.cpp
// AUTHOR: Rob Tillaart
// PURPOSE: Arduino class for Fletcher32
// URL: https://github.com/RobTillaart/Fletcher
#include "Fletcher32.h"
#define FLETCHER_32 65535UL
Fletcher32::Fletcher32()
{
begin();
}
void Fletcher32::begin(uint16_t s1, uint16_t s2)
{
_s1 = s1;
_s2 = s2;
_count = 0;
}
void Fletcher32::add(uint16_t value)
{
_count++;
_s1 += value;
#if defined(ARDUINO_ARCH_SAMD) || defined(ESP32) || defined(ESP8266)
_s1 = (_s1 & 65535UL) + (_s1 >> 16);
#else
if (_s1 >= FLETCHER_32) _s1 -= FLETCHER_32;
#endif
_s2 += _s1;
#if defined(ARDUINO_ARCH_SAMD) || defined(ESP32) || defined(ESP8266)
_s2 = (_s2 & 65535UL) + (_s2 >> 16);
#else
if (_s2 >= FLETCHER_32) _s2 -= FLETCHER_32;
#endif
}
// NOTE: padding with zero's error
//
void Fletcher32::add(const uint16_t * array, uint16_t length)
{
while (length--)
{
add(*array++);
}
}
// -- END OF FILE --