mirror of
https://github.com/mikecarper/MeshCore.git
synced 2026-10-22 02:02:00 +00:00
mikecarper
95aca52b4e
Persist Companion TX preferences per contact and channel. Default repeater, room, and sensor replies to both active TX profiles, with a reply-only force option for an RX-only secondary profile. Track both reply copies before a temporary-radio handoff and account for OTA copies under queue backpressure. Add bridge/crossover filter modes and the third built-in wardriving filter, plus compact filter CLI syntax, documentation, and CI coverage. Fix quoted target names being interpreted as slot/key selectors, partial recovery of invalid saved reply settings, filter suspension during tempradio2, and unnecessary packet allocation while OTA traffic is throttled. Validation: 1,477 native tests, 52 Python integration tests, 29 filter UI tests, and five firmware builds covering ESP32, nRF52, and STM32 passed.
113 lines
3.2 KiB
C++
113 lines
3.2 KiB
C++
#include "Packet.h"
|
|
#include <string.h>
|
|
#include <SHA256.h>
|
|
|
|
namespace mesh {
|
|
|
|
Packet::Packet() {
|
|
header = 0;
|
|
path_len = 0;
|
|
payload_len = 0;
|
|
_rssi = 0;
|
|
_snr = 0;
|
|
tx_cr = 0;
|
|
flood_retry_policy = FLOOD_RETRY_POLICY_DEFAULT;
|
|
radio_generation = radio_origin_generation = 0;
|
|
radio_profile = radio_origin = 0;
|
|
radio_bound = false; radio_local = true;
|
|
tx_radio = RADIO_TX_AUTO;
|
|
radio_reply = radio_reply_force = false;
|
|
}
|
|
|
|
bool Packet::isValidPathLen(uint8_t path_len) {
|
|
uint8_t hash_count = path_len & 63;
|
|
uint8_t hash_size = (path_len >> 6) + 1;
|
|
if (hash_size == 4) return false; // Reserved for future
|
|
return hash_count*hash_size <= MAX_PATH_SIZE;
|
|
}
|
|
|
|
size_t Packet::writePath(uint8_t* dest, const uint8_t* src, uint8_t path_len) {
|
|
uint8_t hash_count = path_len & 63;
|
|
uint8_t hash_size = (path_len >> 6) + 1;
|
|
size_t len = hash_count*hash_size;
|
|
if (len > MAX_PATH_SIZE) {
|
|
MESH_DEBUG_PRINTLN("Packet::copyPath, invalid path_len=%d", (uint32_t)path_len);
|
|
return 0; // Error
|
|
}
|
|
memcpy(dest, src, len);
|
|
return len;
|
|
}
|
|
|
|
uint8_t Packet::copyPath(uint8_t* dest, const uint8_t* src, uint8_t path_len) {
|
|
writePath(dest, src, path_len);
|
|
return path_len;
|
|
}
|
|
|
|
int Packet::getRawLength() const {
|
|
return 2 + getPathByteLen() + payload_len + (hasTransportCodes() ? 4 : 0);
|
|
}
|
|
|
|
void Packet::calculatePacketHash(uint8_t* hash) const {
|
|
SHA256 sha;
|
|
uint8_t t = getPayloadType();
|
|
sha.update(&t, 1);
|
|
if (t == PAYLOAD_TYPE_TRACE) {
|
|
sha.update(&path_len, sizeof(path_len)); // CAVEAT: TRACE packets can revisit same node on return path
|
|
}
|
|
sha.update(payload, payload_len);
|
|
sha.finalize(hash, MAX_HASH_SIZE);
|
|
}
|
|
|
|
uint8_t Packet::writeTo(uint8_t dest[]) const {
|
|
uint8_t i = 0;
|
|
dest[i++] = header;
|
|
if (hasTransportCodes()) {
|
|
memcpy(&dest[i], &transport_codes[0], 2); i += 2;
|
|
memcpy(&dest[i], &transport_codes[1], 2); i += 2;
|
|
}
|
|
dest[i++] = path_len;
|
|
i += writePath(&dest[i], path, path_len);
|
|
memcpy(&dest[i], payload, payload_len); i += payload_len;
|
|
return i;
|
|
}
|
|
|
|
bool Packet::readFrom(const uint8_t src[], uint8_t len) {
|
|
if (src == NULL || len < 2) return false; // header + path_len
|
|
|
|
uint8_t i = 0;
|
|
_rssi = 0;
|
|
_snr = 0;
|
|
tx_cr = 0;
|
|
flood_retry_policy = FLOOD_RETRY_POLICY_DEFAULT;
|
|
radio_generation = radio_origin_generation = 0;
|
|
radio_profile = radio_origin = 0;
|
|
radio_bound = false; radio_local = true;
|
|
header = src[i++];
|
|
tx_radio = RADIO_TX_AUTO;
|
|
radio_reply = radio_reply_force = false;
|
|
if (getPayloadVer() > PAYLOAD_VER_1) return false;
|
|
|
|
if (hasTransportCodes()) {
|
|
if ((uint16_t)i + sizeof(transport_codes) + 1 > len) return false;
|
|
memcpy(&transport_codes[0], &src[i], 2); i += 2;
|
|
memcpy(&transport_codes[1], &src[i], 2); i += 2;
|
|
} else {
|
|
transport_codes[0] = transport_codes[1] = 0;
|
|
}
|
|
|
|
if (i >= len) return false;
|
|
path_len = src[i++];
|
|
if (!isValidPathLen(path_len)) return false; // bad encoding
|
|
|
|
uint8_t bl = getPathByteLen();
|
|
if ((uint16_t)i + bl > len) return false;
|
|
memcpy(path, &src[i], bl); i += bl;
|
|
|
|
payload_len = len - i;
|
|
if (payload_len > sizeof(payload)) return false; // bad encoding
|
|
memcpy(payload, &src[i], payload_len); //i += payload_len;
|
|
return true; // success
|
|
}
|
|
|
|
}
|