mirror of https://github.com/meshcore-dev/MeshCore
6 changed files with 166 additions and 2 deletions
@ -0,0 +1,35 @@ |
|||||
|
#include "RegionMap.h" |
||||
|
#include <SHA256.h> |
||||
|
|
||||
|
void RegionMap::load(FILESYSTEM* _fs) { |
||||
|
// TODO
|
||||
|
} |
||||
|
void RegionMap::save(FILESYSTEM* _fs) { |
||||
|
// TODO
|
||||
|
} |
||||
|
|
||||
|
RegionEntry* RegionMap::findMatch(mesh::Packet* packet, uint8_t mask) { |
||||
|
for (int i = 0; i < num_regions; i++) { |
||||
|
auto region = ®ions[i]; |
||||
|
if (region->flags & mask) { // does region allow this? (per 'mask' param)
|
||||
|
TransportKey keys[4]; |
||||
|
int num = _store->loadKeysFor(region->name, region->id, keys, 4); |
||||
|
for (int j = 0; j < num; j++) { |
||||
|
uint16_t code = keys[j].calcTransportCode(packet); |
||||
|
if (packet->transport_codes[0] == code) { // a match!!
|
||||
|
return region; |
||||
|
} |
||||
|
} |
||||
|
} |
||||
|
} |
||||
|
return NULL; // no matches
|
||||
|
} |
||||
|
|
||||
|
const RegionEntry* RegionMap::findName(const char* name) const { |
||||
|
for (int i = 0; i < num_regions; i++) { |
||||
|
auto region = ®ions[i]; |
||||
|
if (strcmp(name, region->name) == 0) return region; |
||||
|
} |
||||
|
return NULL; // not found
|
||||
|
} |
||||
|
|
||||
@ -0,0 +1,39 @@ |
|||||
|
#pragma once |
||||
|
|
||||
|
#include <Arduino.h> // needed for PlatformIO |
||||
|
#include <Packet.h> |
||||
|
#include "TransportKeyStore.h" |
||||
|
|
||||
|
#ifndef MAX_REGION_ENTRIES |
||||
|
#define MAX_REGION_ENTRIES 32 |
||||
|
#endif |
||||
|
|
||||
|
#define REGION_ALLOW_FLOOD 0x01 |
||||
|
|
||||
|
struct RegionEntry { |
||||
|
uint16_t id; |
||||
|
uint16_t parent; |
||||
|
uint8_t flags; |
||||
|
char name[31]; |
||||
|
}; |
||||
|
|
||||
|
class RegionMap { |
||||
|
TransportKeyStore* _store; |
||||
|
uint16_t next_id; |
||||
|
uint16_t num_regions; |
||||
|
RegionEntry regions[MAX_REGION_ENTRIES]; |
||||
|
RegionEntry wildcard; |
||||
|
|
||||
|
public: |
||||
|
RegionMap(TransportKeyStore& store) : _store(&store) { |
||||
|
next_id = 1; num_regions = 0; |
||||
|
wildcard.id = wildcard.parent = 0; |
||||
|
wildcard.flags = REGION_ALLOW_FLOOD; // default behaviour, allow flood
|
||||
|
} |
||||
|
void load(FILESYSTEM* _fs); |
||||
|
void save(FILESYSTEM* _fs); |
||||
|
|
||||
|
RegionEntry* findMatch(mesh::Packet* packet, uint8_t mask); |
||||
|
const RegionEntry& getWildcard() const { return wildcard; } |
||||
|
const RegionEntry* findName(const char* name) const; |
||||
|
}; |
||||
@ -0,0 +1,44 @@ |
|||||
|
#include "TransportKeyStore.h" |
||||
|
#include <SHA256.h> |
||||
|
|
||||
|
uint16_t TransportKey::calcTransportCode(const mesh::Packet* packet) const { |
||||
|
uint16_t code; |
||||
|
SHA256 sha; |
||||
|
sha.resetHMAC(key, sizeof(key)); |
||||
|
uint8_t type = packet->getPayloadType(); |
||||
|
sha.update(&type, 1); |
||||
|
sha.update(packet->payload, packet->payload_len); |
||||
|
sha.finalizeHMAC(key, sizeof(key), &code, 2); |
||||
|
return code; |
||||
|
} |
||||
|
|
||||
|
int TransportKeyStore::loadKeysFor(const char* name, uint16_t id, TransportKey keys[], int max_num) { |
||||
|
int n = 0; |
||||
|
for (int i = 0; i < num_cache && n < max_num; i++) { // first, check cache
|
||||
|
if (cache_ids[i] == id) { |
||||
|
keys[n++] = cache_keys[i]; |
||||
|
} |
||||
|
} |
||||
|
if (n > 0) return n; // cache hit!
|
||||
|
|
||||
|
if (*name == '#') { // is a publicly-known hashtag region
|
||||
|
SHA256 sha; |
||||
|
sha.update(name, strlen(name)); |
||||
|
sha.finalize(&keys[0], sizeof(keys[0].key)); |
||||
|
n = 1; |
||||
|
} else { |
||||
|
// TODO: retrieve from difficult-to-copy keystore
|
||||
|
} |
||||
|
|
||||
|
// store in cache (if room)
|
||||
|
for (int i = 0; i < n; i++) { |
||||
|
if (num_cache < MAX_TKS_ENTRIES) { |
||||
|
cache_ids[num_cache] = id; |
||||
|
cache_keys[num_cache] = keys[i]; |
||||
|
num_cache++; |
||||
|
} else { |
||||
|
// TODO: evict oldest cache entry
|
||||
|
} |
||||
|
} |
||||
|
return n; |
||||
|
} |
||||
@ -0,0 +1,23 @@ |
|||||
|
#pragma once |
||||
|
|
||||
|
#include <Arduino.h> // needed for PlatformIO |
||||
|
#include <Packet.h> |
||||
|
#include <helpers/IdentityStore.h> |
||||
|
|
||||
|
struct TransportKey { |
||||
|
uint8_t key[16]; |
||||
|
|
||||
|
uint16_t calcTransportCode(const mesh::Packet* packet) const; |
||||
|
}; |
||||
|
|
||||
|
#define MAX_TKS_ENTRIES 16 |
||||
|
|
||||
|
class TransportKeyStore { |
||||
|
uint16_t cache_ids[MAX_TKS_ENTRIES]; |
||||
|
TransportKey cache_keys[MAX_TKS_ENTRIES]; |
||||
|
int num_cache; |
||||
|
|
||||
|
public: |
||||
|
TransportKeyStore() { num_cache = 0; } |
||||
|
int loadKeysFor(const char* name, uint16_t id, TransportKey keys[], int max_num); |
||||
|
}; |
||||
Loading…
Reference in new issue