#pragma once #include #include #include #include #include #include #include "msgpack.h" #include "halfsiphash.h" #include "static_vector.h" struct Envelope { static constexpr int8_t ext_id = 0; uint32_t message_id; uint32_t checksum; std::vector payload; auto as_tuple() const { return std::tie(message_id, checksum, payload); } auto as_tuple() { return std::tie(message_id, checksum, payload); } }; struct DeviceError { static constexpr int8_t ext_id = 1; uint32_t code; std::string message; auto as_tuple() const { return std::tie(code, message); } auto as_tuple() { return std::tie(code, message); } }; struct RequestPICOBOOT { static constexpr int8_t ext_id = 2; auto as_tuple() const { return std::tie(); } auto as_tuple() { return std::tie(); } }; struct ResponsePICOBOOT { static constexpr int8_t ext_id = 3; auto as_tuple() const { return std::tie(); } auto as_tuple() { return std::tie(); } }; struct RequestInfo { static constexpr int8_t ext_id = 4; auto as_tuple() const { return std::tie(); } auto as_tuple() { return std::tie(); } }; struct ResponseInfo { static constexpr int8_t ext_id = 5; std::array board_id; std::array mac; std::array ip; std::string firmware_name; auto as_tuple() const { return std::tie(board_id, mac, ip, firmware_name); } auto as_tuple() { return std::tie(board_id, mac, ip, firmware_name); } }; struct RequestLog { static constexpr int8_t ext_id = 6; auto as_tuple() const { return std::tie(); } auto as_tuple() { return std::tie(); } }; struct LogEntry { uint32_t timestamp_us; std::string message; auto as_tuple() const { return std::tie(timestamp_us, message); } auto as_tuple() { return std::tie(timestamp_us, message); } }; struct ResponseLog { static constexpr int8_t ext_id = 7; std::vector entries; auto as_tuple() const { return std::tie(entries); } auto as_tuple() { return std::tie(entries); } }; struct RequestTest { static constexpr int8_t ext_id = 127; std::string name; auto as_tuple() const { return std::tie(name); } auto as_tuple() { return std::tie(name); } }; struct ResponseTest { static constexpr int8_t ext_id = 126; bool pass; std::vector messages; auto as_tuple() const { return std::tie(pass, messages); } auto as_tuple() { return std::tie(pass, messages); } }; static constexpr uint8_t hash_key[8] = {}; struct DecodedMessage { uint32_t message_id; int8_t type_id; std::vector payload; }; inline size_t pack_envelope_into(span_writer &out, uint32_t message_id, const uint8_t *payload, size_t payload_len) { uint32_t checksum = halfsiphash::hash32(payload, payload_len, hash_key); uint8_t env_buf[512]; span_writer env_body(env_buf, sizeof(env_buf)); msgpack::packer env_p(env_body); env_p.pack_array(3); env_p.pack(message_id); env_p.pack(checksum); env_p.pack_bin(std::span{payload, payload_len}); msgpack::packer outer(out); outer.pack_ext(Envelope::ext_id, env_body); return out.size(); } template inline size_t encode_response_into(span_writer &out, uint32_t message_id, const T &msg) { uint8_t inner_buf[256]; msgpack::packer inner(inner_buf, sizeof(inner_buf)); inner.pack(msg); auto &pl = inner.get_payload(); return pack_envelope_into(out, message_id, pl.data(), pl.size()); } inline msgpack::result try_decode(const uint8_t *data, size_t len) { msgpack::parser p(data, static_cast(len)); Envelope env; auto r = msgpack::unpack(p, env); if (!r) return std::unexpected(r.error()); uint32_t expected = halfsiphash::hash32(env.payload.data(), env.payload.size(), hash_key); if (env.checksum != expected) return std::unexpected(msgpack::error_code::invalid); msgpack::parser inner(env.payload.data(), static_cast(env.payload.size())); if (!inner.is_ext()) return std::unexpected(msgpack::error_code::type_error); auto ext = inner.get_ext(); if (!ext) return std::unexpected(ext.error()); auto& [type_id, ext_data] = *ext; return DecodedMessage{env.message_id, type_id, std::vector(reinterpret_cast(ext_data.data()), reinterpret_cast(ext_data.data()) + ext_data.size())}; } template inline msgpack::result try_decode(const static_vector &buf) { return try_decode(buf.data(), buf.size()); } template inline msgpack::result decode_response(const uint8_t *data, size_t len) { msgpack::parser p(data, static_cast(len)); Envelope env; auto r = msgpack::unpack(p, env); if (!r) return std::unexpected(r.error()); uint32_t expected = halfsiphash::hash32(env.payload.data(), env.payload.size(), hash_key); if (env.checksum != expected) return std::unexpected(msgpack::error_code::invalid); msgpack::parser inner(env.payload.data(), static_cast(env.payload.size())); T out; auto r2 = msgpack::unpack(inner, out); if (!r2) return std::unexpected(r2.error()); return out; } inline size_t encode_request_into(span_writer &out, uint32_t message_id, const auto &msg) { return encode_response_into(out, message_id, msg); }