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