GY-63_MS5611/libraries/Fletcher/Fletcher.cpp
2022-11-07 14:21:36 +01:00

83 lines
1.7 KiB
C++

//
// FILE: Fletcher.cpp
// AUTHOR: Rob Tillaart
// VERSION: 0.1.7
// DATE: 2022-01-25
// PURPOSE: Arduino Library for calculating Fletcher's checksum
// URL: https://github.com/RobTillaart/Fletcher
// https://en.wikipedia.org/wiki/Fletcher%27s_checksum
//
// HISTORY: see changelog.md
#include "Fletcher.h"
// straightforward implementation.
// max length buffer 65534.
// Wikipedia shows optimizations.
//
uint16_t fletcher16(uint8_t *data, uint16_t length)
{
uint32_t s1 = 0;
uint32_t s2 = 0;
for (uint16_t i = 0; i < length;)
{
// if S2 is halfway it is time to do modulo
while ((i < length) && (s2 < 2147483648ULL))
{
s1 += data[i++];
s2 += s1;
}
// this optimization does not work due to the above "32-bit" loop.
// for all three functions.
// s1 = (s1 & 255) + (s1 >> 8);
s1 %= FLETCHER_16;
s2 %= FLETCHER_16;
}
return (s2 << 8) | s1;
}
uint32_t fletcher32(uint16_t *data, uint16_t length)
{
uint32_t s1 = 0;
uint32_t s2 = 0;
for (uint16_t i = 0; i < length;)
{
// if S2 is halfway it is time to do modulo
while ((i < length) && (s2 < 2147483648ULL))
{
s1 += data[i++];
s2 += s1;
}
s1 %= FLETCHER_32;
s2 %= FLETCHER_32;
}
return (s2 << 16) | s1;
}
uint64_t fletcher64(uint32_t *data, uint16_t length)
{
uint64_t s1 = 0;
uint64_t s2 = 0;
for (uint16_t i = 0; i < length;)
{
// if S2 is halfway it is time to do modulo
while ((i < length) && (s2 < 9223372036854775808ULL))
{
s1 += data[i++];
s2 += s1;
}
s1 %= FLETCHER_64;
s2 %= FLETCHER_64;
}
return (s2 << 32) | s1;
}
// -- END OF FILE --