MACRAW IP stack with ARP/ICMP, stable device ordering, LED blink on test
This commit is contained in:
@@ -8,31 +8,32 @@
|
||||
#include "timer_queue.h"
|
||||
#include "net.h"
|
||||
|
||||
static timer_queue timers;
|
||||
|
||||
void dispatch_init() {
|
||||
tusb_init();
|
||||
net_init();
|
||||
}
|
||||
|
||||
[[noreturn]] void dispatch_run(std::span<const handler_entry> handlers,
|
||||
std::span<const w6300::socket_id> sockets) {
|
||||
void dispatch_schedule_ms(uint32_t ms, std::function<void()> fn) {
|
||||
timers.schedule_ms(ms, std::move(fn));
|
||||
}
|
||||
|
||||
[[noreturn]] void dispatch_run(std::span<const handler_entry> handlers) {
|
||||
std::unordered_map<int8_t, std::vector<std::vector<uint8_t>> (*)(uint32_t, std::span<const uint8_t>)> handler_map;
|
||||
for (auto& entry : handlers) {
|
||||
handler_map[entry.type_id] = entry.handle;
|
||||
}
|
||||
|
||||
static usb_cdc usb;
|
||||
static timer_queue timers;
|
||||
static static_vector<uint8_t, 256> usb_rx_buf;
|
||||
|
||||
for (auto sn : sockets) {
|
||||
w6300::set_socket_io_mode(sn, w6300::sock_io_mode::nonblock);
|
||||
}
|
||||
|
||||
while (true) {
|
||||
tud_task();
|
||||
|
||||
usb.drain();
|
||||
timers.run();
|
||||
net_poll();
|
||||
|
||||
while (tud_cdc_available()) {
|
||||
uint8_t byte;
|
||||
@@ -60,25 +61,6 @@ void dispatch_init() {
|
||||
}
|
||||
}
|
||||
|
||||
for (auto sn : sockets) {
|
||||
static uint8_t udp_rx_buf[512];
|
||||
w6300::ip_address src_addr = {};
|
||||
w6300::port_num src_port{0};
|
||||
|
||||
auto result = w6300::recvfrom(sn, std::span{udp_rx_buf}, src_addr, src_port);
|
||||
if (!result) continue;
|
||||
|
||||
auto msg = try_decode(udp_rx_buf, *result);
|
||||
if (!msg) continue;
|
||||
|
||||
auto it = handler_map.find(msg->type_id);
|
||||
if (it != handler_map.end()) {
|
||||
for (auto& response : it->second(msg->message_id, msg->payload)) {
|
||||
w6300::sendto(sn, std::span<const uint8_t>{response}, src_addr, src_port);
|
||||
}
|
||||
}
|
||||
}
|
||||
|
||||
__wfi();
|
||||
}
|
||||
}
|
||||
|
||||
Reference in New Issue
Block a user