mirror of https://github.com/meshcore-dev/MeshCore
8 changed files with 422 additions and 5 deletions
@ -0,0 +1,58 @@ |
|||
/**
|
|||
* MeshCore - A new lightweight, hybrid routing mesh protocol for packet radios |
|||
* Copyright (c) 2025 Scott Powell / rippleradios.com |
|||
* |
|||
* This project is maintained by the contributors listed in |
|||
* https://github.com/ripplebiz/MeshCore/graphs/contributors
|
|||
* |
|||
* MIT License |
|||
* |
|||
* Permission is hereby granted, free of charge, to any person obtaining a copy |
|||
* of this software and associated documentation files (the "Software"), to deal |
|||
* in the Software without restriction, including without limitation the rights |
|||
* to use, copy, modify, merge, publish, distribute, sublicense, and/or sell |
|||
* copies of the Software, and to permit persons to whom the Software is |
|||
* furnished to do so, subject to the following conditions: |
|||
* |
|||
* The above copyright notice and this permission notice shall be included in all |
|||
* copies or substantial portions of the Software. |
|||
* |
|||
* THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR |
|||
* IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY, |
|||
* FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL THE |
|||
* AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER |
|||
* LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM, |
|||
* OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN THE |
|||
* SOFTWARE. |
|||
* |
|||
*/ |
|||
#pragma once |
|||
|
|||
#include "MeshCore.h" |
|||
|
|||
#include <string.h> |
|||
|
|||
namespace bridge { |
|||
|
|||
/*
|
|||
* +----------------------------------------------------+ |
|||
* | SERIAL PACKET SPEC | |
|||
* +-----------+---------+------------------------------+ |
|||
* | TYPE | NAME | DESCRIPTION | |
|||
* +-----------+---------+------------------------------+ |
|||
* | uint16_t | MAGIC | The packet start marker | |
|||
* | uint16_t | LEN | Length of the payload | |
|||
* | uint16_t | CRC | Checksum for error checking | |
|||
* | uint8_t[] | PAYLOAD | Actual rf packet data | |
|||
* +-----------+---------+------------------------------+ |
|||
*/ |
|||
#define SERIAL_PKT_MAGIC 0xdead |
|||
|
|||
struct Packet { |
|||
uint16_t magic, len, crc; |
|||
uint8_t payload[MAX_TRANS_UNIT]; |
|||
|
|||
Packet() : magic(SERIAL_PKT_MAGIC), len(0), crc(0) {} |
|||
}; |
|||
|
|||
} // namespace bridge
|
|||
@ -0,0 +1,113 @@ |
|||
/**
|
|||
* MeshCore - A new lightweight, hybrid routing mesh protocol for packet radios |
|||
* Copyright (c) 2025 Scott Powell / rippleradios.com |
|||
* |
|||
* This project is maintained by the contributors listed in |
|||
* https://github.com/ripplebiz/MeshCore/graphs/contributors
|
|||
* |
|||
* MIT License |
|||
* |
|||
* Permission is hereby granted, free of charge, to any person obtaining a copy |
|||
* of this software and associated documentation files (the "Software"), to deal |
|||
* in the Software without restriction, including without limitation the rights |
|||
* to use, copy, modify, merge, publish, distribute, sublicense, and/or sell |
|||
* copies of the Software, and to permit persons to whom the Software is |
|||
* furnished to do so, subject to the following conditions: |
|||
* |
|||
* The above copyright notice and this permission notice shall be included in all |
|||
* copies or substantial portions of the Software. |
|||
* |
|||
* THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR |
|||
* IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY, |
|||
* FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL THE |
|||
* AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER |
|||
* LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM, |
|||
* OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN THE |
|||
* SOFTWARE. |
|||
* |
|||
*/ |
|||
#pragma once |
|||
|
|||
#include "MeshCore.h" |
|||
|
|||
#include <Packet.h> |
|||
#include <string.h> |
|||
|
|||
#if MESH_PACKET_LOGGING |
|||
#include <Arduino.h> |
|||
#endif |
|||
|
|||
#ifndef MAX_QUEUE_SIZE |
|||
#define MAX_QUEUE_SIZE 8 |
|||
#endif |
|||
|
|||
namespace bridge { |
|||
|
|||
class PacketQueue { |
|||
private: |
|||
struct { |
|||
size_t len; |
|||
uint8_t bytes[MAX_TRANS_UNIT]; |
|||
} buffer[MAX_QUEUE_SIZE]; |
|||
|
|||
protected: |
|||
uint16_t head = 0, tail = 0; |
|||
|
|||
public: |
|||
size_t available() const { return (tail - head + MAX_QUEUE_SIZE) % MAX_QUEUE_SIZE; } |
|||
|
|||
size_t enqueue(const uint8_t *bytes, const uint8_t len) { |
|||
if (len == 0 || len > MAX_TRANS_UNIT) { |
|||
#if BRIDGE_DEBUG |
|||
Serial.printf("BRIDGE: enqueue() failed len=%d\n", len); |
|||
#endif |
|||
return 0; |
|||
} |
|||
|
|||
if ((tail + 1) % MAX_QUEUE_SIZE == head) { // Buffer full
|
|||
head = (head + 1) % MAX_QUEUE_SIZE; // Overwrite oldest packet
|
|||
} |
|||
|
|||
buffer[tail].len = len; |
|||
memcpy(buffer[tail].bytes, bytes, len); |
|||
|
|||
#if MESH_PACKET_LOGGING |
|||
Serial.printf("BRIDGE: enqueue() len=%d payload[5]=", len); |
|||
for (size_t i = 0; i < len && i < 5; ++i) { |
|||
Serial.printf("0x%02x ", buffer[tail].bytes[i]); |
|||
} |
|||
Serial.printf("\n"); |
|||
#endif |
|||
|
|||
tail = (tail + 1) % MAX_QUEUE_SIZE; |
|||
return len; |
|||
} |
|||
|
|||
size_t enqueue(const mesh::Packet *pkt) { |
|||
uint8_t bytes[MAX_TRANS_UNIT]; |
|||
const size_t len = pkt->writeTo(bytes); |
|||
return enqueue(bytes, len); |
|||
} |
|||
|
|||
size_t dequeue(uint8_t *bytes) { |
|||
if (head == tail) { // Buffer empty
|
|||
return 0; |
|||
} |
|||
|
|||
const size_t len = buffer[head].len; |
|||
memcpy(bytes, buffer[head].bytes, len); |
|||
head = (head + 1) % MAX_QUEUE_SIZE; |
|||
|
|||
#if MESH_PACKET_LOGGING |
|||
Serial.printf("BRIDGE: dequeue() payload[5]="); |
|||
for (size_t i = 0; i < len && i < 5; ++i) { |
|||
Serial.printf("0x%02x ", bytes[i]); |
|||
} |
|||
Serial.printf("\n"); |
|||
#endif |
|||
|
|||
return len; |
|||
} |
|||
}; |
|||
|
|||
} // namespace bridge
|
|||
@ -0,0 +1,135 @@ |
|||
/**
|
|||
* MeshCore - A new lightweight, hybrid routing mesh protocol for packet radios |
|||
* Copyright (c) 2025 Scott Powell / rippleradios.com |
|||
* |
|||
* This project is maintained by the contributors listed in |
|||
* https://github.com/ripplebiz/MeshCore/graphs/contributors
|
|||
* |
|||
* MIT License |
|||
* |
|||
* Permission is hereby granted, free of charge, to any person obtaining a copy |
|||
* of this software and associated documentation files (the "Software"), to deal |
|||
* in the Software without restriction, including without limitation the rights |
|||
* to use, copy, modify, merge, publish, distribute, sublicense, and/or sell |
|||
* copies of the Software, and to permit persons to whom the Software is |
|||
* furnished to do so, subject to the following conditions: |
|||
* |
|||
* The above copyright notice and this permission notice shall be included in all |
|||
* copies or substantial portions of the Software. |
|||
* |
|||
* THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR |
|||
* IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY, |
|||
* FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL THE |
|||
* AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER |
|||
* LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM, |
|||
* OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN THE |
|||
* SOFTWARE. |
|||
* |
|||
*/ |
|||
#include "SerialBridge.h" |
|||
|
|||
#include "MeshCore.h" |
|||
#include "Packet.h" |
|||
|
|||
// Alternative <HardwareSerial.h> for ESP32
|
|||
// Alternative <SerialUART.h> for RP2040
|
|||
#include <Arduino.h> |
|||
|
|||
namespace bridge { |
|||
#ifdef BRIDGE_OVER_SERIAL |
|||
|
|||
#if !defined(BRIDGE_OVER_SERIAL_RX) || !defined(BRIDGE_OVER_SERIAL_TX) |
|||
#error You must define RX and TX pins |
|||
#endif |
|||
|
|||
void SerialBridge::setup() { |
|||
#if defined(ESP32) |
|||
BRIDGE_OVER_SERIAL.setPins(BRIDGE_OVER_SERIAL_RX, BRIDGE_OVER_SERIAL_TX); |
|||
#elif defined(RP2040_PLATFORM) |
|||
BRIDGE_OVER_SERIAL.setPinout(BRIDGE_OVER_SERIAL_TX, BRIDGE_OVER_SERIAL_RX); |
|||
#else |
|||
#error SerialBridge was not tested on the current platform |
|||
#endif |
|||
BRIDGE_OVER_SERIAL.begin(115200); |
|||
Serial.printf("Bridge over serial: enabled\n"); |
|||
} |
|||
|
|||
void SerialBridge::loop() { |
|||
readFromSerial(); |
|||
writeToSerial(); |
|||
} |
|||
|
|||
bool SerialBridge::shouldRetransmit(const mesh::Packet *pkt) { |
|||
if (pkt->isMarkedDoNotRetransmit()) { |
|||
return false; |
|||
} |
|||
} |
|||
|
|||
size_t SerialBridge::getPacket(uint8_t *bytes) { |
|||
return rx_queue.dequeue(bytes); |
|||
} |
|||
|
|||
size_t SerialBridge::sendPacket(const mesh::Packet *pkt) { |
|||
if (shouldRetransmit(pkt)) return 0; |
|||
const size_t len = tx_queue.enqueue(pkt); |
|||
return len; |
|||
} |
|||
|
|||
void SerialBridge::readFromSerial() { |
|||
static constexpr uint16_t size = sizeof(bridge::Packet) + 1; |
|||
static uint8_t buffer[size]; |
|||
static uint16_t tail = 0; |
|||
|
|||
while (BRIDGE_OVER_SERIAL.available()) { |
|||
buffer[tail] = (uint8_t)BRIDGE_OVER_SERIAL.read(); |
|||
tail = (tail + 1) % size; |
|||
|
|||
#if BRIDGE_OVER_SERIAL_DEBUG |
|||
Serial.printf("%02x ", buffer[(tail - 1 + size) % size]); |
|||
#endif |
|||
|
|||
// Check for complete packet by looking back to where the magic number should be
|
|||
uint16_t head = (tail - sizeof(bridge::Packet) + size) % size; |
|||
const uint16_t magic = buffer[head] | (buffer[(head + 1) % size] << 8); |
|||
|
|||
if (magic == SERIAL_PKT_MAGIC) { |
|||
const uint16_t len = buffer[(head + 2) % size] | (buffer[(head + 3) % size] << 8); |
|||
const uint16_t crc = buffer[(head + 4) % size] | (buffer[(head + 5) % size] << 8); |
|||
|
|||
uint8_t payload[MAX_TRANS_UNIT]; |
|||
for (size_t i = 0; i < len; i++) { |
|||
payload[i] = buffer[(head + 6 + i) % size]; |
|||
} |
|||
|
|||
const bool valid = verifyCRC(payload, len, crc); |
|||
|
|||
#if MESH_PACKET_LOGGING |
|||
Serial.printf("BRIDGE: Read from serial len=%d crc=0x%04x\n", len, crc); |
|||
#endif |
|||
|
|||
if (verifyCRC(payload, len, crc)) { |
|||
#if MESH_PACKET_LOGGING |
|||
Serial.printf("BRIDGE: Received packet was validated\n"); |
|||
#endif |
|||
rx_queue.enqueue(payload, len); |
|||
} |
|||
} |
|||
} |
|||
} |
|||
|
|||
void SerialBridge::writeToSerial() { |
|||
bridge::Packet pkt; |
|||
if (!tx_queue.available()) return; |
|||
pkt.len = tx_queue.dequeue(pkt.payload); |
|||
|
|||
if (pkt.len > 0) { |
|||
pkt.crc = SerialBridge::calculateCRC(pkt.payload, pkt.len); |
|||
BRIDGE_OVER_SERIAL.write((uint8_t *)&pkt, sizeof(bridge::Packet)); |
|||
#if MESH_PACKET_LOGGING |
|||
Serial.printf("BRIDGE: Write to serial len=%d crc=0x%04x\n", pkt.len, pkt.crc); |
|||
#endif |
|||
} |
|||
} |
|||
|
|||
#endif |
|||
} // namespace bridge
|
|||
@ -0,0 +1,73 @@ |
|||
/**
|
|||
* MeshCore - A new lightweight, hybrid routing mesh protocol for packet radios |
|||
* Copyright (c) 2025 Scott Powell / rippleradios.com |
|||
* |
|||
* This project is maintained by the contributors listed in |
|||
* https://github.com/ripplebiz/MeshCore/graphs/contributors
|
|||
* |
|||
* MIT License |
|||
* |
|||
* Permission is hereby granted, free of charge, to any person obtaining a copy |
|||
* of this software and associated documentation files (the "Software"), to deal |
|||
* in the Software without restriction, including without limitation the rights |
|||
* to use, copy, modify, merge, publish, distribute, sublicense, and/or sell |
|||
* copies of the Software, and to permit persons to whom the Software is |
|||
* furnished to do so, subject to the following conditions: |
|||
* |
|||
* The above copyright notice and this permission notice shall be included in all |
|||
* copies or substantial portions of the Software. |
|||
* |
|||
* THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR |
|||
* IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY, |
|||
* FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL THE |
|||
* AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER |
|||
* LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM, |
|||
* OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN THE |
|||
* SOFTWARE. |
|||
* |
|||
*/ |
|||
#pragma once |
|||
|
|||
#include "Packet.h" |
|||
#include "PacketQueue.h" |
|||
|
|||
#include <Packet.h> |
|||
|
|||
namespace bridge { |
|||
|
|||
class SerialBridge { |
|||
private: |
|||
PacketQueue rx_queue, tx_queue; |
|||
|
|||
protected: |
|||
bool shouldRetransmit(const mesh::Packet *); |
|||
|
|||
public: |
|||
void loop(); |
|||
void setup(); |
|||
void readFromSerial(); |
|||
void writeToSerial(); |
|||
|
|||
size_t getPacket(uint8_t *); |
|||
size_t sendPacket(const mesh::Packet *); |
|||
|
|||
static uint16_t calculateCRC(const uint8_t *bytes, size_t len) { |
|||
// Fletcher-16
|
|||
// https://en.wikipedia.org/wiki/Fletcher%27s_checksum
|
|||
uint8_t sum1 = 0, sum2 = 0; |
|||
|
|||
for (size_t i = 0; i < len; i++) { |
|||
sum1 = (sum1 + bytes[i]) % 255; |
|||
sum2 = (sum2 + sum1) % 255; |
|||
} |
|||
|
|||
return (sum2 << 8) | sum1; |
|||
}; |
|||
|
|||
static bool verifyCRC(const uint8_t *bytes, size_t len, uint16_t crc) { |
|||
uint16_t computedChecksum = calculateCRC(bytes, len); |
|||
return (computedChecksum == crc); |
|||
} |
|||
}; |
|||
|
|||
} // namespace bridge
|
|||
Loading…
Reference in new issue