* new Packet::writeTo(), readFrom() methods. (for saving snapshots of packets)

This commit is contained in:
Scott Powell
2025-01-30 18:34:18 +11:00
parent bc655c8797
commit 78e307c495
2 changed files with 34 additions and 0 deletions

View File

@@ -19,5 +19,25 @@ void Packet::calculatePacketHash(uint8_t* hash) const {
sha.finalize(hash, MAX_HASH_SIZE);
}
uint8_t Packet::writeTo(uint8_t dest[]) const {
uint8_t i = 0;
dest[i++] = header;
dest[i++] = path_len;
memcpy(&dest[i], path, path_len); i += path_len;
memcpy(&dest[i], payload, payload_len); i += payload_len;
return i;
}
bool Packet::readFrom(const uint8_t src[], uint8_t len) {
uint8_t i = 0;
header = src[i++];
path_len = src[i++];
if (path_len > sizeof(path)) return false; // bad encoding
memcpy(path, &src[i], path_len); i += path_len;
if (i >= len) return false; // bad encoding
payload_len = len - i;
memcpy(payload, &src[i], payload_len); //i += payload_len;
return true; // success
}
}