123 lines
3.6 KiB
C++
123 lines
3.6 KiB
C++
#include <unordered_map>
|
|
#include "pico/stdlib.h"
|
|
#include "pico/time.h"
|
|
#include "hardware/gpio.h"
|
|
#include "dispatch.h"
|
|
#include "handlers.h"
|
|
#include "w6300.h"
|
|
|
|
static constexpr uint8_t LED_PIN = 25;
|
|
|
|
static void led_toggle() {
|
|
gpio_xor_mask(1 << LED_PIN);
|
|
dispatch_schedule_ms(1000, led_toggle);
|
|
}
|
|
|
|
std::string_view firmware_name = "picomap_test";
|
|
|
|
static constexpr uint16_t PICOMAP_DISCOVERY_PORT = 28777;
|
|
|
|
static constexpr std::array<uint8_t, 4> picomap_discovery_ip = {239, 0, 112, 109};
|
|
|
|
static constexpr std::array<uint8_t, 6> picomap_discovery_mac = {
|
|
0x01, 0x00, 0x5e, 0x00, 0x70, 0x6d,
|
|
};
|
|
|
|
static w6300::socket_id test_socket{1};
|
|
|
|
static ResponseTest test_discovery() {
|
|
ResponseTest resp;
|
|
resp.pass = true;
|
|
|
|
uint8_t req_buf[256];
|
|
span_writer req_out(req_buf, sizeof(req_buf));
|
|
size_t req_len = encode_request_into(req_out, 0, RequestInfo{});
|
|
auto send_result = w6300::send(test_socket, std::span<const uint8_t>{req_buf, req_len});
|
|
if (!send_result) {
|
|
resp.pass = false;
|
|
resp.messages.push_back("send: error " + std::to_string(static_cast<int>(send_result.error())));
|
|
return resp;
|
|
}
|
|
|
|
uint8_t rx_buf[512];
|
|
|
|
auto deadline = make_timeout_time_ms(5000);
|
|
std::expected<uint16_t, w6300::sock_error> recv_result = std::unexpected(w6300::sock_error::busy);
|
|
while (get_absolute_time() < deadline) {
|
|
recv_result = w6300::recv(test_socket, std::span{rx_buf});
|
|
if (recv_result || recv_result.error() != w6300::sock_error::busy) break;
|
|
}
|
|
|
|
if (!recv_result) {
|
|
resp.pass = false;
|
|
if (recv_result.error() == w6300::sock_error::busy) {
|
|
resp.messages.push_back("recv: timed out after 5s");
|
|
} else {
|
|
resp.messages.push_back("recv: error " + std::to_string(static_cast<int>(recv_result.error())));
|
|
}
|
|
return resp;
|
|
}
|
|
|
|
resp.messages.push_back("received " + std::to_string(*recv_result) + " bytes");
|
|
|
|
auto info = decode_response<ResponseInfo>(rx_buf, *recv_result);
|
|
if (!info) {
|
|
resp.pass = false;
|
|
resp.messages.push_back("decode: msgpack error " + std::to_string(static_cast<int>(info.error())));
|
|
return resp;
|
|
}
|
|
|
|
if (info->firmware_name.empty()) {
|
|
resp.pass = false;
|
|
resp.messages.push_back("firmware_name is empty");
|
|
} else {
|
|
resp.messages.push_back("firmware_name: " + info->firmware_name);
|
|
}
|
|
|
|
bool mac_zero = true;
|
|
for (auto b : info->mac) { if (b != 0) { mac_zero = false; break; } }
|
|
if (mac_zero) {
|
|
resp.pass = false;
|
|
resp.messages.push_back("mac is all zeros");
|
|
}
|
|
|
|
bool ip_zero = true;
|
|
for (auto b : info->ip) { if (b != 0) { ip_zero = false; break; } }
|
|
if (ip_zero) {
|
|
resp.pass = false;
|
|
resp.messages.push_back("ip is all zeros");
|
|
}
|
|
|
|
return resp;
|
|
}
|
|
|
|
using test_fn = ResponseTest (*)();
|
|
|
|
static const std::unordered_map<std::string_view, test_fn> tests = {
|
|
{"discovery", test_discovery},
|
|
};
|
|
|
|
static ResponseTest handle_test(const RequestTest& req) {
|
|
auto it = tests.find(req.name);
|
|
if (it == tests.end())
|
|
return {false, {"unknown test: " + req.name}};
|
|
return it->second();
|
|
}
|
|
|
|
static constexpr handler_entry handlers[] = {
|
|
{RequestPICOBOOT::ext_id, typed_handler<RequestPICOBOOT, handle_picoboot>},
|
|
{RequestInfo::ext_id, typed_handler<RequestInfo, handle_info>},
|
|
{RequestLog::ext_id, typed_handler<RequestLog, handle_log>},
|
|
{RequestTest::ext_id, typed_handler<RequestTest, handle_test>},
|
|
};
|
|
|
|
int main() {
|
|
dispatch_init();
|
|
|
|
gpio_init(LED_PIN);
|
|
gpio_set_dir(LED_PIN, GPIO_OUT);
|
|
dispatch_schedule_ms(1000, led_toggle);
|
|
|
|
dispatch_run(handlers);
|
|
}
|