João Brázio
37 lines
975 B
C++
37 lines
975 B
C++
#include "BridgeBase.h"
|
|
|
|
#include <Arduino.h>
|
|
|
|
const char *BridgeBase::getLogDateTime() {
|
|
static char tmp[32];
|
|
uint32_t now = _rtc->getCurrentTime();
|
|
DateTime dt = DateTime(now);
|
|
sprintf(tmp, "%02d:%02d:%02d - %d/%d/%d U", dt.hour(), dt.minute(), dt.second(), dt.day(), dt.month(),
|
|
dt.year());
|
|
return tmp;
|
|
}
|
|
|
|
uint16_t BridgeBase::fletcher16(const uint8_t *data, size_t len) {
|
|
uint8_t sum1 = 0, sum2 = 0;
|
|
|
|
for (size_t i = 0; i < len; i++) {
|
|
sum1 = (sum1 + data[i]) % 255;
|
|
sum2 = (sum2 + sum1) % 255;
|
|
}
|
|
|
|
return (sum2 << 8) | sum1;
|
|
}
|
|
|
|
bool BridgeBase::validateChecksum(const uint8_t *data, size_t len, uint16_t received_checksum) {
|
|
uint16_t calculated_checksum = fletcher16(data, len);
|
|
return received_checksum == calculated_checksum;
|
|
}
|
|
|
|
void BridgeBase::handleReceivedPacket(mesh::Packet *packet) {
|
|
if (!_seen_packets.hasSeen(packet)) {
|
|
_mgr->queueInbound(packet, millis() + BRIDGE_DELAY);
|
|
} else {
|
|
_mgr->free(packet);
|
|
}
|
|
}
|