#pragma once #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 link_local; auto as_tuple() const { return std::tie(board_id, mac, link_local); } auto as_tuple() { return std::tie(board_id, mac, link_local); } }; static constexpr uint8_t hash_key[8] = {}; struct DecodedMessage { uint32_t message_id; int8_t type_id; }; inline std::vector pack_envelope(uint32_t message_id, const std::vector &payload) { uint32_t checksum = halfsiphash::hash32(payload.data(), payload.size(), hash_key); msgpack::packer p; p.pack(Envelope{message_id, checksum, payload}); return p.get_payload(); } template inline std::vector encode_response(uint32_t message_id, const T &msg) { msgpack::packer inner; inner.pack(msg); return pack_envelope(message_id, inner.get_payload()); } 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()); return DecodedMessage{env.message_id, std::get<0>(*ext)}; } template inline msgpack::result try_decode(const static_vector &buf) { return try_decode(buf.data(), buf.size()); }