mirror of
https://github.com/meshtastic/firmware.git
synced 2025-12-29 22:20:37 +00:00
* UDP for RAK4631 Eth Gw and the t-eth-elite. Also enable IP output on Portduino. Solves #7149 * Copilot suggestion Co-authored-by: Copilot <175728472+Copilot@users.noreply.github.com> * fix portduino build * initialize local port --------- Co-authored-by: Copilot <175728472+Copilot@users.noreply.github.com> Co-authored-by: Ben Meadors <benmmeadors@gmail.com>
This commit is contained in:
69
src/platform/nrf52/AsyncUDP.cpp
Normal file
69
src/platform/nrf52/AsyncUDP.cpp
Normal file
@@ -0,0 +1,69 @@
|
||||
#include "AsyncUDP.h"
|
||||
|
||||
AsyncUDP::AsyncUDP() : OSThread("AsyncUDP"), localPort(0) {}
|
||||
|
||||
bool AsyncUDP::listenMulticast(IPAddress multicastIP, uint16_t port, uint8_t ttl)
|
||||
{
|
||||
if (!isMulticast(multicastIP))
|
||||
return false;
|
||||
localPort = port;
|
||||
udp.beginMulticast(multicastIP, port);
|
||||
return true;
|
||||
}
|
||||
|
||||
size_t AsyncUDP::write(uint8_t b)
|
||||
{
|
||||
return udp.write(&b, 1);
|
||||
}
|
||||
|
||||
size_t AsyncUDP::write(const uint8_t *data, size_t len)
|
||||
{
|
||||
return udp.write(data, len);
|
||||
}
|
||||
|
||||
void AsyncUDP::onPacket(const std::function<void(AsyncUDPPacket)> &callback)
|
||||
{
|
||||
_onPacket = callback;
|
||||
}
|
||||
|
||||
bool AsyncUDP::writeTo(const uint8_t *data, size_t len, IPAddress ip, uint16_t port)
|
||||
{
|
||||
if (!udp.beginPacket(ip, port))
|
||||
return false;
|
||||
udp.write(data, len);
|
||||
return udp.endPacket();
|
||||
}
|
||||
|
||||
// AsyncUDPPacket
|
||||
AsyncUDPPacket::AsyncUDPPacket(EthernetUDP &source) : _udp(source), _remoteIP(source.remoteIP()), _remotePort(source.remotePort())
|
||||
{
|
||||
if (_udp.available() > 0) {
|
||||
_readLength = _udp.read(_buffer, sizeof(_buffer));
|
||||
} else {
|
||||
_readLength = 0;
|
||||
}
|
||||
}
|
||||
|
||||
IPAddress AsyncUDPPacket::remoteIP()
|
||||
{
|
||||
return _remoteIP;
|
||||
}
|
||||
|
||||
uint16_t AsyncUDPPacket::length()
|
||||
{
|
||||
return _readLength;
|
||||
}
|
||||
|
||||
const uint8_t *AsyncUDPPacket::data()
|
||||
{
|
||||
return _buffer;
|
||||
}
|
||||
|
||||
int32_t AsyncUDP::runOnce()
|
||||
{
|
||||
if (_onPacket && udp.parsePacket() > 0) {
|
||||
AsyncUDPPacket packet(udp);
|
||||
_onPacket(packet);
|
||||
}
|
||||
return 5; // check every 5ms
|
||||
}
|
||||
57
src/platform/nrf52/AsyncUDP.h
Normal file
57
src/platform/nrf52/AsyncUDP.h
Normal file
@@ -0,0 +1,57 @@
|
||||
#ifndef ASYNC_UDP_H
|
||||
#define ASYNC_UDP_H
|
||||
|
||||
#include "concurrency/OSThread.h"
|
||||
#include <IPAddress.h>
|
||||
#include <Print.h>
|
||||
#include <RAK13800_W5100S.h>
|
||||
#include <cstdint>
|
||||
#include <functional>
|
||||
|
||||
class AsyncUDPPacket;
|
||||
|
||||
class AsyncUDP : public Print, private concurrency::OSThread
|
||||
{
|
||||
public:
|
||||
AsyncUDP();
|
||||
explicit operator bool() const { return localPort != 0; }
|
||||
|
||||
bool listenMulticast(IPAddress multicastIP, uint16_t port, uint8_t ttl = 64);
|
||||
bool writeTo(const uint8_t *data, size_t len, IPAddress ip, uint16_t port);
|
||||
|
||||
size_t write(uint8_t b) override;
|
||||
size_t write(const uint8_t *data, size_t len) override;
|
||||
void onPacket(const std::function<void(AsyncUDPPacket)> &callback);
|
||||
|
||||
private:
|
||||
EthernetUDP udp;
|
||||
uint16_t localPort;
|
||||
std::function<void(AsyncUDPPacket)> _onPacket;
|
||||
virtual int32_t runOnce() override;
|
||||
};
|
||||
|
||||
class AsyncUDPPacket
|
||||
{
|
||||
public:
|
||||
AsyncUDPPacket(EthernetUDP &source);
|
||||
|
||||
IPAddress remoteIP();
|
||||
uint16_t length();
|
||||
const uint8_t *data();
|
||||
|
||||
private:
|
||||
EthernetUDP &_udp;
|
||||
IPAddress _remoteIP;
|
||||
uint16_t _remotePort;
|
||||
size_t _readLength = 0;
|
||||
|
||||
static constexpr size_t BUF_SIZE = 512;
|
||||
uint8_t _buffer[BUF_SIZE];
|
||||
};
|
||||
|
||||
inline bool isMulticast(const IPAddress &ip)
|
||||
{
|
||||
return (ip[0] & 0xF0) == 0xE0;
|
||||
}
|
||||
|
||||
#endif // ASYNC_UDP_H
|
||||
Reference in New Issue
Block a user