Compare commits

...

1 Commits

17 changed files with 149 additions and 148 deletions

View File

@@ -4,6 +4,7 @@ add_subdirectory(util)
add_subdirectory(w6300) add_subdirectory(w6300)
add_subdirectory(debug_log) add_subdirectory(debug_log)
add_subdirectory(msgpack) add_subdirectory(msgpack)
add_subdirectory(eth)
add_library(limen STATIC add_library(limen STATIC
src/arp.cpp src/arp.cpp
@@ -13,7 +14,6 @@ add_library(limen STATIC
src/icmp.cpp src/icmp.cpp
src/igmp.cpp src/igmp.cpp
src/ipv4.cpp src/ipv4.cpp
src/net.cpp
src/test_handlers.cpp src/test_handlers.cpp
src/udp.cpp src/udp.cpp
) )
@@ -29,9 +29,9 @@ target_link_libraries(limen PUBLIC
w6300 w6300
debug_log debug_log
msgpack msgpack
eth
pico_stdlib pico_stdlib
pico_sha256 pico_sha256
pico_unique_id
) )
set(LIMEN_PARTITION_TABLE ${CMAKE_CURRENT_SOURCE_DIR}/partition_table.json CACHE INTERNAL "") set(LIMEN_PARTITION_TABLE ${CMAKE_CURRENT_SOURCE_DIR}/partition_table.json CACHE INTERNAL "")

12
eth/CMakeLists.txt Normal file
View File

@@ -0,0 +1,12 @@
add_library(eth STATIC eth.cpp)
target_include_directories(eth PUBLIC ${CMAKE_CURRENT_SOURCE_DIR})
target_compile_options(eth PRIVATE -Wall -Wextra -Wno-unused-parameter)
target_link_libraries(eth PUBLIC
util
debug_log
w6300
pico_unique_id
)

View File

@@ -1,18 +1,16 @@
#include "net.h" #include "eth.h"
#include <array> #include <array>
#include "pico/unique_id.h" #include "pico/unique_id.h"
#include "pico/time.h"
#include "eth.h"
#include "parse_buffer.h" #include "parse_buffer.h"
#include "prepend_buffer.h" #include "prepend_buffer.h"
#include "w6300.h" #include "w6300.h"
#include "debug_log.h" #include "debug_log.h"
namespace net { namespace eth {
namespace { namespace {
state g_state; mac_addr g_mac;
w6300::socket_id raw_socket{0}; w6300::socket_id raw_socket{0};
frame_cb_list frame_callbacks; frame_cb_list frame_callbacks;
@@ -26,11 +24,11 @@ size_t eth_handler_count = 0;
std::array<mac_filter, 4> mac_filters; std::array<mac_filter, 4> mac_filters;
size_t mac_filter_count = 0; size_t mac_filter_count = 0;
bool default_mac_filter(const eth::mac_addr& dst) { bool default_mac_filter(const mac_addr& dst) {
return dst == g_state.mac || dst == eth::MAC_BROADCAST; return dst == g_mac || dst == MAC_BROADCAST;
} }
bool mac_match(const eth::mac_addr& dst) { bool mac_match(const mac_addr& dst) {
for (size_t i = 0; i < mac_filter_count; i++) { for (size_t i = 0; i < mac_filter_count; i++) {
if (mac_filters[i](dst)) { if (mac_filters[i](dst)) {
return true; return true;
@@ -40,10 +38,10 @@ bool mac_match(const eth::mac_addr& dst) {
} }
void process_frame(std::span<const uint8_t> frame, span_writer& tx) { void process_frame(std::span<const uint8_t> frame, span_writer& tx) {
if (frame.size() < sizeof(eth::header)) { if (frame.size() < sizeof(header)) {
return; return;
} }
auto& eth_hdr = *reinterpret_cast<const eth::header*>(frame.data()); auto& eth_hdr = *reinterpret_cast<const header*>(frame.data());
if (!mac_match(eth_hdr.dst)) { if (!mac_match(eth_hdr.dst)) {
return; return;
@@ -72,7 +70,7 @@ void register_default_mac_filter() {
void register_ethertype(uint16_t ethertype_be, ethertype_handler fn) { void register_ethertype(uint16_t ethertype_be, ethertype_handler fn) {
if (eth_handler_count >= eth_handlers.size()) { if (eth_handler_count >= eth_handlers.size()) {
dlogf("net::register_ethertype overflow: ethertype=0x%04x dropped", __builtin_bswap16(ethertype_be)); dlogf("eth::register_ethertype overflow: ethertype=0x%04x dropped", __builtin_bswap16(ethertype_be));
return; return;
} }
eth_handlers[eth_handler_count++] = {ethertype_be, fn}; eth_handlers[eth_handler_count++] = {ethertype_be, fn};
@@ -80,14 +78,14 @@ void register_ethertype(uint16_t ethertype_be, ethertype_handler fn) {
void register_mac_filter(mac_filter fn) { void register_mac_filter(mac_filter fn) {
if (mac_filter_count >= mac_filters.size()) { if (mac_filter_count >= mac_filters.size()) {
dlog("net::register_mac_filter overflow: filter dropped"); dlog("eth::register_mac_filter overflow: filter dropped");
return; return;
} }
mac_filters[mac_filter_count++] = fn; mac_filters[mac_filter_count++] = fn;
} }
void send_raw(std::span<const uint8_t> data) { void send_raw(std::span<const uint8_t> data) {
dlog_if_slow("net::send_raw", 1000, [&]{ dlog_if_slow("eth::send_raw", 1000, [&]{
auto result = w6300::send(raw_socket, data); auto result = w6300::send(raw_socket, data);
if (!result) { if (!result) {
dlogf("w6300 send failed: %zu bytes, err %d", dlogf("w6300 send failed: %zu bytes, err %d",
@@ -106,17 +104,12 @@ bool init() {
pico_unique_board_id_t uid; pico_unique_board_id_t uid;
pico_get_unique_board_id(&uid); pico_get_unique_board_id(&uid);
g_state.mac[0] = (uid.id[0] & 0xFC) | 0x02; g_mac[0] = (uid.id[0] & 0xFC) | 0x02;
g_state.mac[1] = uid.id[1]; g_mac[1] = uid.id[1];
g_state.mac[2] = uid.id[2]; g_mac[2] = uid.id[2];
g_state.mac[3] = uid.id[3]; g_mac[3] = uid.id[3];
g_state.mac[4] = uid.id[4]; g_mac[4] = uid.id[4];
g_state.mac[5] = uid.id[5]; g_mac[5] = uid.id[5];
g_state.ip[0] = 169;
g_state.ip[1] = 254;
g_state.ip[2] = g_state.mac[4];
g_state.ip[3] = g_state.mac[5];
w6300::open_socket(raw_socket, w6300::protocol::macraw, w6300::sock_flag::none); w6300::open_socket(raw_socket, w6300::protocol::macraw, w6300::sock_flag::none);
w6300::set_interrupt_mask(w6300::ik_sock_0); w6300::set_interrupt_mask(w6300::ik_sock_0);
@@ -124,14 +117,14 @@ bool init() {
return true; return true;
} }
const state& get_state() { const mac_addr& get_mac() {
return g_state; return g_mac;
} }
frame_cb_handle add_frame_callback(frame_callback cb) { frame_cb_handle add_frame_callback(frame_callback cb) {
auto h = frame_callbacks.insert(cb); auto h = frame_callbacks.insert(cb);
if (!h) { if (!h) {
dlog("net::add_frame_callback overflow: callback dropped"); dlog("eth::add_frame_callback overflow: callback dropped");
} }
return h; return h;
} }
@@ -158,4 +151,4 @@ void poll(std::span<uint8_t> tx) {
w6300::rearm_gpio_irq(); w6300::rearm_gpio_irq();
} }
} // namespace net } // namespace eth

47
eth/eth.h Normal file
View File

@@ -0,0 +1,47 @@
#pragma once
#include <array>
#include <cstdint>
#include <span>
#include "callback_list.h"
#include "span_writer.h"
namespace eth {
using mac_addr = std::array<uint8_t, 6>;
static constexpr mac_addr MAC_BROADCAST = {0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF};
static constexpr uint16_t ETH_ARP = __builtin_bswap16(0x0806);
static constexpr uint16_t ETH_IPV4 = __builtin_bswap16(0x0800);
struct __attribute__((packed)) header {
mac_addr dst;
mac_addr src;
uint16_t ethertype;
};
static_assert(sizeof(header) == 14);
template <typename Buf>
void prepend(Buf& buf, const mac_addr& dst, const mac_addr& src, uint16_t ethertype) {
auto* h = buf.template prepend<header>();
h->dst = dst;
h->src = src;
h->ethertype = ethertype;
}
using frame_callback = bool (*)(std::span<const uint8_t> frame);
using frame_cb_list = callback_list<frame_callback, 16>;
using frame_cb_handle = frame_cb_list::node*;
using ethertype_handler = void (*)(std::span<const uint8_t> frame, span_writer& tx);
using mac_filter = bool (*)(const mac_addr& dst);
bool init();
const mac_addr& get_mac();
frame_cb_handle add_frame_callback(frame_callback cb);
void remove_frame_callback(frame_cb_handle h);
void poll(std::span<uint8_t> tx);
void send_raw(std::span<const uint8_t> data);
void register_ethertype(uint16_t ethertype_be, ethertype_handler fn);
void register_mac_filter(mac_filter fn);
} // namespace eth

View File

@@ -5,7 +5,8 @@
#include <span> #include <span>
#include "wire.h" #include "wire.h"
#include "timer_queue.h" #include "timer_queue.h"
#include "net.h" #include "eth.h"
#include "ipv4.h"
#include "prepend_buffer.h" #include "prepend_buffer.h"
#include "udp.h" #include "udp.h"
@@ -17,7 +18,6 @@ struct responder {
template <typename T> template <typename T>
void respond(const T& msg) const { void respond(const T& msg) const {
const auto& ns = net::get_state();
prepend_buffer<4096> buf; prepend_buffer<4096> buf;
span_writer out(buf.payload_ptr(), 2048); span_writer out(buf.payload_ptr(), 2048);
auto r = encode_response_into(out, message_id, msg); auto r = encode_response_into(out, message_id, msg);
@@ -25,9 +25,9 @@ struct responder {
return; return;
} }
buf.append(*r); buf.append(*r);
udp::prepend(buf, reply_to.mac, ns.mac, ns.ip, reply_to.ip, udp::prepend(buf, reply_to.mac, eth::get_mac(), ipv4::get_ip(), reply_to.ip,
dispatch_listen_port_be(), reply_to.port, *r); dispatch_listen_port_be(), reply_to.port, *r);
net::send_raw(buf.span()); eth::send_raw(buf.span());
} }
}; };

View File

@@ -1,28 +0,0 @@
#pragma once
#include <array>
#include <cstdint>
namespace eth {
using mac_addr = std::array<uint8_t, 6>;
static constexpr mac_addr MAC_BROADCAST = {0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF};
static constexpr uint16_t ETH_ARP = __builtin_bswap16(0x0806);
static constexpr uint16_t ETH_IPV4 = __builtin_bswap16(0x0800);
struct __attribute__((packed)) header {
mac_addr dst;
mac_addr src;
uint16_t ethertype;
};
static_assert(sizeof(header) == 14);
template <typename Buf>
void prepend(Buf& buf, const mac_addr& dst, const mac_addr& src, uint16_t ethertype) {
auto* h = buf.template prepend<header>();
h->dst = dst;
h->src = src;
h->ethertype = ethertype;
}
} // namespace eth

View File

@@ -59,6 +59,9 @@ void prepend(Buf& buf, const eth::mac_addr& dst_mac, const eth::mac_addr& src_ma
void handle(std::span<const uint8_t> frame, span_writer& tx); void handle(std::span<const uint8_t> frame, span_writer& tx);
void init();
const ip4_addr& get_ip();
bool addressed_to_us(ip4_addr dst); bool addressed_to_us(ip4_addr dst);
using protocol_handler = void (*)(std::span<const uint8_t> frame, span_writer& tx); using protocol_handler = void (*)(std::span<const uint8_t> frame, span_writer& tx);

View File

@@ -1,33 +0,0 @@
#pragma once
#include <cstdint>
#include <span>
#include "eth.h"
#include "ipv4.h"
#include "span_writer.h"
#include "callback_list.h"
namespace net {
struct state {
eth::mac_addr mac;
ipv4::ip4_addr ip;
};
using frame_callback = bool (*)(std::span<const uint8_t> frame);
using frame_cb_list = callback_list<frame_callback, 16>;
using frame_cb_handle = frame_cb_list::node*;
using ethertype_handler = void (*)(std::span<const uint8_t> frame, span_writer& tx);
using mac_filter = bool (*)(const eth::mac_addr& dst);
bool init();
const state& get_state();
frame_cb_handle add_frame_callback(frame_callback cb);
void remove_frame_callback(frame_cb_handle h);
void poll(std::span<uint8_t> tx);
void send_raw(std::span<const uint8_t> data);
void register_ethertype(uint16_t ethertype_be, ethertype_handler fn);
void register_mac_filter(mac_filter fn);
} // namespace net

View File

@@ -3,7 +3,6 @@
#include <span> #include <span>
#include "eth.h" #include "eth.h"
#include "ipv4.h" #include "ipv4.h"
#include "net.h"
#include "span_writer.h" #include "span_writer.h"
namespace udp { namespace udp {

View File

@@ -1,5 +1,6 @@
#include "arp.h" #include "arp.h"
#include "net.h" #include "eth.h"
#include "ipv4.h"
#include "parse_buffer.h" #include "parse_buffer.h"
#include "prepend_buffer.h" #include "prepend_buffer.h"
@@ -11,7 +12,8 @@ static constexpr uint16_t ARP_OP_REQUEST = __builtin_bswap16(1);
static constexpr uint16_t ARP_OP_REPLY = __builtin_bswap16(2); static constexpr uint16_t ARP_OP_REPLY = __builtin_bswap16(2);
void handle(std::span<const uint8_t> frame, span_writer& tx) { void handle(std::span<const uint8_t> frame, span_writer& tx) {
const auto& ns = net::get_state(); const auto& mac = eth::get_mac();
const auto& ip = ipv4::get_ip();
parse_buffer pb(frame); parse_buffer pb(frame);
pb.consume<eth::header>(); pb.consume<eth::header>();
auto* arp_hdr = pb.consume<header>(); auto* arp_hdr = pb.consume<header>();
@@ -21,7 +23,7 @@ void handle(std::span<const uint8_t> frame, span_writer& tx) {
if (arp_hdr->ptype != ARP_PTYPE_IPV4) return; if (arp_hdr->ptype != ARP_PTYPE_IPV4) return;
if (arp_hdr->hlen != 6 || arp_hdr->plen != 4) return; if (arp_hdr->hlen != 6 || arp_hdr->plen != 4) return;
if (arp_hdr->oper != ARP_OP_REQUEST) return; if (arp_hdr->oper != ARP_OP_REQUEST) return;
if (arp_hdr->tpa != ns.ip) return; if (arp_hdr->tpa != ip) return;
prepend_buffer<4096> buf; prepend_buffer<4096> buf;
auto* reply = buf.template prepend<header>(); auto* reply = buf.template prepend<header>();
@@ -30,18 +32,18 @@ void handle(std::span<const uint8_t> frame, span_writer& tx) {
reply->hlen = 6; reply->hlen = 6;
reply->plen = 4; reply->plen = 4;
reply->oper = ARP_OP_REPLY; reply->oper = ARP_OP_REPLY;
reply->sha = ns.mac; reply->sha = mac;
reply->spa = ns.ip; reply->spa = ip;
reply->tha = arp_hdr->sha; reply->tha = arp_hdr->sha;
reply->tpa = arp_hdr->spa; reply->tpa = arp_hdr->spa;
eth::prepend(buf, arp_hdr->sha, ns.mac, eth::ETH_ARP); eth::prepend(buf, arp_hdr->sha, mac, eth::ETH_ARP);
net::send_raw(buf.span()); eth::send_raw(buf.span());
} }
__attribute__((constructor)) __attribute__((constructor))
static void register_ethertype() { static void register_ethertype() {
net::register_ethertype(eth::ETH_ARP, handle); eth::register_ethertype(eth::ETH_ARP, handle);
} }
} // namespace arp } // namespace arp

View File

@@ -3,7 +3,8 @@
#include "pico/stdlib.h" #include "pico/stdlib.h"
#include "wire.h" #include "wire.h"
#include "timer_queue.h" #include "timer_queue.h"
#include "net.h" #include "eth.h"
#include "ipv4.h"
#include "igmp.h" #include "igmp.h"
#include "udp.h" #include "udp.h"
#include "debug_log.h" #include "debug_log.h"
@@ -34,7 +35,8 @@ static void on_udp_message(std::span<const uint8_t> payload, const udp::address&
void dispatch_init(uint16_t port_be) { void dispatch_init(uint16_t port_be) {
listen_port_be = port_be; listen_port_be = port_be;
udp::register_port(port_be, on_udp_message); udp::register_port(port_be, on_udp_message);
net::init(); eth::init();
ipv4::init();
dispatch_schedule_ms(60000, igmp_reannounce); dispatch_schedule_ms(60000, igmp_reannounce);
dlog("dispatch_init complete"); dlog("dispatch_init complete");
} }
@@ -59,7 +61,7 @@ bool dispatch_cancel_timer(timer_handle h) {
uint32_t save = save_and_disable_interrupts(); uint32_t save = save_and_disable_interrupts();
dlog_if_slow("timers", 1000, [&]{ timers.run(); }); dlog_if_slow("timers", 1000, [&]{ timers.run(); });
dlog_if_slow("net::poll", 1000, [&]{ net::poll(std::span{tx_buf}); }); dlog_if_slow("eth::poll", 1000, [&]{ eth::poll(std::span{tx_buf}); });
__wfi(); __wfi();
restore_interrupts(save); restore_interrupts(save);

View File

@@ -5,7 +5,8 @@
#include "hardware/watchdog.h" #include "hardware/watchdog.h"
#include "flash.h" #include "flash.h"
#include "dispatch.h" #include "dispatch.h"
#include "net.h" #include "eth.h"
#include "ipv4.h"
#include "debug_log.h" #include "debug_log.h"
static boot_reason detected_boot_reason; static boot_reason detected_boot_reason;
@@ -34,9 +35,8 @@ std::optional<ResponseInfo> handle_info(const responder&, const RequestInfo&) {
pico_unique_board_id_t uid; pico_unique_board_id_t uid;
pico_get_unique_board_id(&uid); pico_get_unique_board_id(&uid);
std::copy(uid.id, uid.id + 8, resp.board_id.begin()); std::copy(uid.id, uid.id + 8, resp.board_id.begin());
auto& ns = net::get_state(); resp.mac = eth::get_mac();
resp.mac = ns.mac; resp.ip = ipv4::get_ip();
resp.ip = ns.ip;
resp.firmware_name = firmware_name; resp.firmware_name = firmware_name;
resp.boot = detected_boot_reason; resp.boot = detected_boot_reason;
resp.build_epoch = firmware_build_epoch; resp.build_epoch = firmware_build_epoch;

View File

@@ -1,7 +1,7 @@
#include "icmp.h" #include "icmp.h"
#include <cstring> #include <cstring>
#include "eth.h"
#include "ipv4.h" #include "ipv4.h"
#include "net.h"
#include "parse_buffer.h" #include "parse_buffer.h"
#include "prepend_buffer.h" #include "prepend_buffer.h"
@@ -24,7 +24,6 @@ void handle(std::span<const uint8_t> frame, span_writer& tx) {
if (!icmp_pkt) return; if (!icmp_pkt) return;
if (icmp_pkt->type != 8) return; if (icmp_pkt->type != 8) return;
const auto& ns = net::get_state();
prepend_buffer<4096> buf; prepend_buffer<4096> buf;
memcpy(buf.append(icmp_len), pb.remaining().data() - sizeof(echo), icmp_len); memcpy(buf.append(icmp_len), pb.remaining().data() - sizeof(echo), icmp_len);
@@ -33,8 +32,8 @@ void handle(std::span<const uint8_t> frame, span_writer& tx) {
reply->checksum = 0; reply->checksum = 0;
reply->checksum = ipv4::checksum(reply, icmp_len); reply->checksum = ipv4::checksum(reply, icmp_len);
ipv4::prepend(buf, eth_hdr->src, ns.mac, ns.ip, ip->src, 1, icmp_len); ipv4::prepend(buf, eth_hdr->src, eth::get_mac(), ipv4::get_ip(), ip->src, 1, icmp_len);
net::send_raw(buf.span()); eth::send_raw(buf.span());
} }
__attribute__((constructor)) __attribute__((constructor))

View File

@@ -1,7 +1,7 @@
#include "igmp.h" #include "igmp.h"
#include <vector> #include <vector>
#include "eth.h"
#include "ipv4.h" #include "ipv4.h"
#include "net.h"
#include "parse_buffer.h" #include "parse_buffer.h"
#include "prepend_buffer.h" #include "prepend_buffer.h"
@@ -35,10 +35,9 @@ bool is_member_mac(const eth::mac_addr& mac) {
} }
static void send_report(const ipv4::ip4_addr& group) { static void send_report(const ipv4::ip4_addr& group) {
const auto& ns = net::get_state();
prepend_buffer<4096> buf; prepend_buffer<4096> buf;
prepend_report(buf, ns.mac, ns.ip, group); prepend_report(buf, eth::get_mac(), ipv4::get_ip(), group);
net::send_raw(buf.span()); eth::send_raw(buf.span());
} }
void join(const ipv4::ip4_addr& group) { void join(const ipv4::ip4_addr& group) {
@@ -82,7 +81,7 @@ void handle(std::span<const uint8_t> frame, span_writer& tx) {
__attribute__((constructor)) __attribute__((constructor))
static void register_protocol() { static void register_protocol() {
ipv4::register_protocol(2, handle); ipv4::register_protocol(2, handle);
net::register_mac_filter(is_member_mac); eth::register_mac_filter(is_member_mac);
ipv4::register_addr_filter(is_member); ipv4::register_addr_filter(is_member);
} }

View File

@@ -1,6 +1,6 @@
#include "ipv4.h" #include "ipv4.h"
#include <array> #include <array>
#include "net.h" #include "eth.h"
#include "parse_buffer.h" #include "parse_buffer.h"
#include "debug_log.h" #include "debug_log.h"
@@ -10,6 +10,8 @@ namespace {
constexpr ip4_addr IP_BROADCAST_ALL = {255, 255, 255, 255}; constexpr ip4_addr IP_BROADCAST_ALL = {255, 255, 255, 255};
ip4_addr g_ip;
std::array<addr_filter, 4> addr_filters; std::array<addr_filter, 4> addr_filters;
size_t addr_filter_count = 0; size_t addr_filter_count = 0;
@@ -21,12 +23,20 @@ std::array<protocol_entry, 8> protocol_handlers;
size_t protocol_handler_count = 0; size_t protocol_handler_count = 0;
bool default_addr_filter(const ip4_addr& dst) { bool default_addr_filter(const ip4_addr& dst) {
const auto& ns = net::get_state(); return dst == g_ip || dst == IP_BROADCAST_ALL || dst == SUBNET_BROADCAST;
return dst == ns.ip || dst == IP_BROADCAST_ALL || dst == SUBNET_BROADCAST;
} }
} // namespace } // namespace
void init() {
const auto& mac = eth::get_mac();
g_ip = {169, 254, mac[4], mac[5]};
}
const ip4_addr& get_ip() {
return g_ip;
}
uint16_t checksum(const void* data, size_t len) { uint16_t checksum(const void* data, size_t len) {
auto p = static_cast<const uint8_t*>(data); auto p = static_cast<const uint8_t*>(data);
uint32_t sum = 0; uint32_t sum = 0;
@@ -93,7 +103,7 @@ void handle(std::span<const uint8_t> frame, span_writer& tx) {
__attribute__((constructor)) __attribute__((constructor))
static void register_self() { static void register_self() {
net::register_ethertype(eth::ETH_IPV4, handle); eth::register_ethertype(eth::ETH_IPV4, handle);
register_addr_filter(default_addr_filter); register_addr_filter(default_addr_filter);
} }

View File

@@ -4,7 +4,8 @@
#include "pico/stdlib.h" #include "pico/stdlib.h"
#include "pico/time.h" #include "pico/time.h"
#include "handlers.h" #include "handlers.h"
#include "net.h" #include "eth.h"
#include "ipv4.h"
#include "icmp.h" #include "icmp.h"
#include "igmp.h" #include "igmp.h"
#include "udp.h" #include "udp.h"
@@ -55,7 +56,7 @@ struct test_state {
bool in_flight = false; bool in_flight = false;
responder resp; responder resp;
timer_handle timer = nullptr; timer_handle timer = nullptr;
net::frame_cb_handle frame_cb = nullptr; eth::frame_cb_handle frame_cb = nullptr;
discovery_data* active_discovery = nullptr; discovery_data* active_discovery = nullptr;
ping_rate_data* active_rate = nullptr; ping_rate_data* active_rate = nullptr;
@@ -72,7 +73,7 @@ static test_state ts;
static void test_end(const ResponseTest& result) { static void test_end(const ResponseTest& result) {
if (ts.timer) { dispatch_cancel_timer(ts.timer); ts.timer = nullptr; } if (ts.timer) { dispatch_cancel_timer(ts.timer); ts.timer = nullptr; }
if (ts.frame_cb) { net::remove_frame_callback(ts.frame_cb); ts.frame_cb = nullptr; } if (ts.frame_cb) { eth::remove_frame_callback(ts.frame_cb); ts.frame_cb = nullptr; }
ts.active_discovery = nullptr; ts.active_discovery = nullptr;
ts.active_rate = nullptr; ts.active_rate = nullptr;
ts.resp.respond(result); ts.resp.respond(result);
@@ -93,7 +94,7 @@ static bool discover_reply_cb(std::span<const uint8_t> frame) {
if (options_len > 0 && !pb.skip(options_len)) return false; if (options_len > 0 && !pb.skip(options_len)) return false;
auto* uhdr = pb.consume<udp::header>(); auto* uhdr = pb.consume<udp::header>();
if (!uhdr || uhdr->src_port != PICOMAP_PORT_BE) return false; if (!uhdr || uhdr->src_port != PICOMAP_PORT_BE) return false;
if (ip->src == net::get_state().ip) return false; if (ip->src == ipv4::get_ip()) return false;
dispatch_cancel_timer(ts.timer); dispatch_cancel_timer(ts.timer);
ts.timer = nullptr; ts.timer = nullptr;
ts.frame_cb = nullptr; ts.frame_cb = nullptr;
@@ -105,7 +106,7 @@ static bool discover_reply_cb(std::span<const uint8_t> frame) {
} }
static void discover_timeout_cb() { static void discover_timeout_cb() {
net::remove_frame_callback(ts.frame_cb); eth::remove_frame_callback(ts.frame_cb);
ts.frame_cb = nullptr; ts.frame_cb = nullptr;
ts.timer = nullptr; ts.timer = nullptr;
auto cont = ts.active_discovery ? ts.active_discovery->on_timeout : nullptr; auto cont = ts.active_discovery ? ts.active_discovery->on_timeout : nullptr;
@@ -119,7 +120,6 @@ static void discover_peer(discovery_data& d,
d.on_timeout = timeout; d.on_timeout = timeout;
ts.active_discovery = &d; ts.active_discovery = &d;
const auto& ns = net::get_state();
eth::mac_addr mcast_mac = igmp::mac_for_ip(PICOMAP_DISCOVERY_GROUP); eth::mac_addr mcast_mac = igmp::mac_for_ip(PICOMAP_DISCOVERY_GROUP);
prepend_buffer<4096> buf; prepend_buffer<4096> buf;
@@ -134,13 +134,13 @@ static void discover_peer(discovery_data& d,
} }
buf.append(*encoded); buf.append(*encoded);
udp::prepend(buf, mcast_mac, ns.mac, ns.ip, PICOMAP_DISCOVERY_GROUP, udp::prepend(buf, mcast_mac, eth::get_mac(), ipv4::get_ip(), PICOMAP_DISCOVERY_GROUP,
PICOMAP_PORT_BE, PICOMAP_PORT_BE, *encoded, 1); PICOMAP_PORT_BE, PICOMAP_PORT_BE, *encoded, 1);
ts.frame_cb = net::add_frame_callback(discover_reply_cb); ts.frame_cb = eth::add_frame_callback(discover_reply_cb);
ts.timer = dispatch_schedule_ms(5000, discover_timeout_cb); ts.timer = dispatch_schedule_ms(5000, discover_timeout_cb);
net::send_raw(buf.span()); eth::send_raw(buf.span());
} }
static bool igmp_report_cb(std::span<const uint8_t> frame) { static bool igmp_report_cb(std::span<const uint8_t> frame) {
@@ -158,14 +158,13 @@ static void igmp_timeout_cb() {
} }
static void test_discovery_igmp() { static void test_discovery_igmp() {
const auto& ns = net::get_state();
prepend_buffer<4096> buf; prepend_buffer<4096> buf;
igmp::prepend_query(buf, ns.mac, ns.ip, PICOMAP_DISCOVERY_GROUP); igmp::prepend_query(buf, eth::get_mac(), ipv4::get_ip(), PICOMAP_DISCOVERY_GROUP);
ts.frame_cb = net::add_frame_callback(igmp_report_cb); ts.frame_cb = eth::add_frame_callback(igmp_report_cb);
ts.timer = dispatch_schedule_ms(5000, igmp_timeout_cb); ts.timer = dispatch_schedule_ms(5000, igmp_timeout_cb);
net::send_raw(buf.span()); eth::send_raw(buf.span());
} }
static void info_found(const peer_info& peer) { static void info_found(const peer_info& peer) {
@@ -184,7 +183,7 @@ static bool ping_reply_cb(std::span<const uint8_t> frame) {
ipv4::ip4_addr src_ip; ipv4::ip4_addr src_ip;
if (!icmp::parse_echo_reply(frame, src_ip, PING_ECHO_ID)) return false; if (!icmp::parse_echo_reply(frame, src_ip, PING_ECHO_ID)) return false;
ts.frame_cb = nullptr; ts.frame_cb = nullptr;
if (src_ip == net::get_state().ip) if (src_ip == ipv4::get_ip())
test_end({false, {"got reply from self: " + ipv4::to_string(src_ip)}}); test_end({false, {"got reply from self: " + ipv4::to_string(src_ip)}});
else else
test_end({true, {"reply from " + ipv4::to_string(src_ip)}}); test_end({true, {"reply from " + ipv4::to_string(src_ip)}});
@@ -197,13 +196,12 @@ static void ping_timeout_cb() {
} }
static void start_ping(ipv4::ip4_addr dst_ip) { static void start_ping(ipv4::ip4_addr dst_ip) {
const auto& ns = net::get_state();
prepend_buffer<4096> buf; prepend_buffer<4096> buf;
icmp::prepend_echo_request(buf, ns.mac, ns.ip, icmp::prepend_echo_request(buf, eth::get_mac(), ipv4::get_ip(),
eth::MAC_BROADCAST, dst_ip, PING_ECHO_ID, 1); eth::MAC_BROADCAST, dst_ip, PING_ECHO_ID, 1);
ts.frame_cb = net::add_frame_callback(ping_reply_cb); ts.frame_cb = eth::add_frame_callback(ping_reply_cb);
ts.timer = dispatch_schedule_ms(5000, ping_timeout_cb); ts.timer = dispatch_schedule_ms(5000, ping_timeout_cb);
net::send_raw(buf.span()); eth::send_raw(buf.span());
} }
static void test_ping_subnet() { start_ping({169, 254, 255, 255}); } static void test_ping_subnet() { start_ping({169, 254, 255, 255}); }
@@ -215,22 +213,21 @@ static size_t ping_rate_frame_size() {
} }
static void ping_rate_send_one() { static void ping_rate_send_one() {
const auto& ns = net::get_state();
auto& r = *ts.active_rate; auto& r = *ts.active_rate;
prepend_buffer<4096> buf; prepend_buffer<4096> buf;
if (r.payload_len > 0) if (r.payload_len > 0)
memset(buf.append(r.payload_len), 0xAA, r.payload_len); memset(buf.append(r.payload_len), 0xAA, r.payload_len);
icmp::prepend_echo_request(buf, ns.mac, ns.ip, icmp::prepend_echo_request(buf, eth::get_mac(), ipv4::get_ip(),
r.peer.mac, r.peer.ip, PING_RATE_ECHO_ID, r.peer.mac, r.peer.ip, PING_RATE_ECHO_ID,
r.sent + 1, r.payload_len); r.sent + 1, r.payload_len);
net::send_raw(buf.span()); eth::send_raw(buf.span());
r.sent++; r.sent++;
} }
static bool ping_rate_reply_cb(std::span<const uint8_t> frame) { static bool ping_rate_reply_cb(std::span<const uint8_t> frame) {
ipv4::ip4_addr src_ip; ipv4::ip4_addr src_ip;
if (!icmp::parse_echo_reply(frame, src_ip, PING_RATE_ECHO_ID)) return false; if (!icmp::parse_echo_reply(frame, src_ip, PING_RATE_ECHO_ID)) return false;
if (src_ip == net::get_state().ip) return false; if (src_ip == ipv4::get_ip()) return false;
auto& r = *ts.active_rate; auto& r = *ts.active_rate;
r.received++; r.received++;
@@ -276,7 +273,7 @@ static void ping_rate_found(const peer_info& peer) {
r.received = 0; r.received = 0;
r.start_us = time_us_32(); r.start_us = time_us_32();
ts.frame_cb = net::add_frame_callback(ping_rate_reply_cb); ts.frame_cb = eth::add_frame_callback(ping_rate_reply_cb);
ts.timer = dispatch_schedule_ms(10000, ping_rate_timeout_cb); ts.timer = dispatch_schedule_ms(10000, ping_rate_timeout_cb);
for (uint16_t i = 0; i < r.pipeline && r.sent < r.target; i++) for (uint16_t i = 0; i < r.pipeline && r.sent < r.target; i++)

View File

@@ -2,7 +2,6 @@
#include <array> #include <array>
#include "eth.h" #include "eth.h"
#include "ipv4.h" #include "ipv4.h"
#include "net.h"
#include "parse_buffer.h" #include "parse_buffer.h"
#include "debug_log.h" #include "debug_log.h"