#include "packet.hpp" #include namespace packet { bool number(const std::string& token, std::uint32_t maximum, std::uint32_t& value) { if (token.empty()) { return false; } std::uint32_t current = 0; for (char character : token) { if (character < '0' || character > '9') { return false; } unsigned digit = static_cast(character - '0'); if (current > maximum / 10) { return false; } if (current == maximum / 10 && digit > maximum % 10) { return false; } current = current * 10 + digit; } value = current; return true; } static int nibble(char character) { if (character >= '0' && character <= '9') { return character - '0'; } if (character >= 'a' && character <= 'f') { return character - 'a' + 10; } if (character >= 'A' && character <= 'F') { return character - 'A' + 10; } return -1; } bool decode(const std::string& token, std::string& bytes) { bytes.clear(); if (token == "-") { return true; } if (token.empty() || token.size() > 128 || token.size() % 2 != 0) { return false; } std::string result; result.reserve(token.size() / 2); for (std::size_t index = 0; index < token.size(); index += 2) { int high = nibble(token[index]); int low = nibble(token[index + 1]); if (high < 0 || low < 0) { return false; } result.push_back(static_cast(high * 16 + low)); } bytes.swap(result); return true; } std::string encode(const std::string& bytes) { if (bytes.empty()) { return "-"; } const char* alphabet = "0123456789abcdef"; std::string result; result.reserve(bytes.size() * 2); for (unsigned char byte : bytes) { result.push_back(alphabet[byte >> 4]); result.push_back(alphabet[byte & 15]); } return result; } std::uint32_t checksum(const Packet& packet) { std::uint32_t result = 2166136261u; auto feed = [&result](unsigned byte) { result ^= byte; result *= 16777619u; }; for (unsigned shift = 0; shift != 32; shift += 8) { feed((packet.id >> shift) & 255); } feed(packet.priority); for (unsigned shift = 0; shift != 32; shift += 8) { feed((packet.deadline >> shift) & 255); } for (unsigned char byte : packet.data) { feed(byte); } return result; } std::vector words(const std::string& line) { std::istringstream input(line); std::vector tokens; std::string token; while (input >> token) { tokens.push_back(token); } return tokens; } }