4 #include <msp/core/maputils.h>
5 #include <msp/strings/format.h>
6 #include <msp/strings/lexicalcast.h>
13 Protocol::Protocol(unsigned npi):
17 PacketDefBuilder<PacketHeader, Serializer<PacketHeader>>(*this, header_def, Serializer<PacketHeader>())
18 .fields(&PacketHeader::type, &PacketHeader::length);
21 unsigned Protocol::get_next_packet_class_id()
23 static unsigned next_id = 1;
27 void Protocol::add_packet(unique_ptr<PacketDefBase> pdef)
29 unique_ptr<PacketDefBase> &ptr = packet_class_defs[pdef->get_class_id()];
31 packet_id_defs.erase(ptr->get_id());
33 if(unsigned id = ptr->get_id())
34 packet_id_defs[id] = ptr.get();
37 const Protocol::PacketDefBase &Protocol::get_packet_by_class_id(unsigned id) const
39 return *get_item(packet_class_defs, id);
42 const Protocol::PacketDefBase &Protocol::get_packet_by_id(unsigned id) const
44 return *get_item(packet_id_defs, id);
47 unsigned Protocol::get_max_packet_id() const
49 if(packet_id_defs.empty())
51 return prev(packet_id_defs.end())->first;
54 size_t Protocol::dispatch(ReceiverBase &rcv, const char *buf, size_t size, unsigned base_id) const
57 const char *ptr = header_def.deserialize(header, buf, buf+size);
58 if(header.length>size)
59 throw bad_packet("truncated");
60 const PacketDefBase &pdef = get_packet_by_id(header.type-base_id);
61 ptr = pdef.dispatch(rcv, ptr, ptr+header.length);
65 bool Protocol::get_packet_header(PacketHeader &header, const char *buf, size_t size) const
69 header_def.deserialize(header, buf, buf+size);
73 size_t Protocol::get_packet_size(const char *buf, size_t size) const
76 return (get_packet_header(header, buf, size) ? header.length : 0);
79 uint64_t Protocol::get_hash() const
81 uint64_t result = hash<64>(packet_id_defs.size());
82 for(auto &kvp: packet_id_defs)
84 hash_update<64>(result, kvp.first);
85 hash_update<64>(result, kvp.second->get_hash());
91 /* TODO These assumes the machine is little-endian; are there any relevant
92 big-endian platforms these days? */
94 char *Protocol::BasicSerializer<T>::serialize(const T &value, char *buf, char *end) const
96 if(end-buf<static_cast<int>(sizeof(T)))
97 throw buffer_error("overflow");
99 const char *ptr = reinterpret_cast<const char *>(&value)+sizeof(T);
100 for(size_t i=0; i<sizeof(T); ++i)
107 const char *Protocol::BasicSerializer<T>::deserialize(T &value, const char *buf, const char *end) const
109 if(end-buf<static_cast<int>(sizeof(T)))
110 throw buffer_error("underflow");
112 char *ptr = reinterpret_cast<char *>(&value)+sizeof(T);
113 for(size_t i=0; i<sizeof(T); ++i)
119 template char *Protocol::BasicSerializer<bool>::serialize(const bool &, char *, char *) const;
120 template char *Protocol::BasicSerializer<int8_t>::serialize(const int8_t &, char *, char *) const;
121 template char *Protocol::BasicSerializer<int16_t>::serialize(const int16_t &, char *, char *) const;
122 template char *Protocol::BasicSerializer<int32_t>::serialize(const int32_t &, char *, char *) const;
123 template char *Protocol::BasicSerializer<int64_t>::serialize(const int64_t &, char *, char *) const;
124 template char *Protocol::BasicSerializer<uint8_t>::serialize(const uint8_t &, char *, char *) const;
125 template char *Protocol::BasicSerializer<uint16_t>::serialize(const uint16_t &, char *, char *) const;
126 template char *Protocol::BasicSerializer<uint32_t>::serialize(const uint32_t &, char *, char *) const;
127 template char *Protocol::BasicSerializer<uint64_t>::serialize(const uint64_t &, char *, char *) const;
128 template char *Protocol::BasicSerializer<float>::serialize(const float &, char *, char *) const;
129 template char *Protocol::BasicSerializer<double>::serialize(const double &, char *, char *) const;
130 template const char *Protocol::BasicSerializer<bool>::deserialize(bool &, const char *, const char *) const;
131 template const char *Protocol::BasicSerializer<int8_t>::deserialize(int8_t &, const char *, const char *) const;
132 template const char *Protocol::BasicSerializer<int16_t>::deserialize(int16_t &, const char *, const char *) const;
133 template const char *Protocol::BasicSerializer<int32_t>::deserialize(int32_t &, const char *, const char *) const;
134 template const char *Protocol::BasicSerializer<int64_t>::deserialize(int64_t &, const char *, const char *) const;
135 template const char *Protocol::BasicSerializer<uint8_t>::deserialize(uint8_t &, const char *, const char *) const;
136 template const char *Protocol::BasicSerializer<uint16_t>::deserialize(uint16_t &, const char *, const char *) const;
137 template const char *Protocol::BasicSerializer<uint32_t>::deserialize(uint32_t &, const char *, const char *) const;
138 template const char *Protocol::BasicSerializer<uint64_t>::deserialize(uint64_t &, const char *, const char *) const;
139 template const char *Protocol::BasicSerializer<float>::deserialize(float &, const char *, const char *) const;
140 template const char *Protocol::BasicSerializer<double>::deserialize(double &, const char *, const char *) const;
143 Protocol::StringSerializer::StringSerializer(const Protocol &p):
147 char *Protocol::StringSerializer::serialize(const string &str, char *buf, char *end) const
149 buf = length_serializer.serialize(str.size(), buf, end);
150 if(end-buf<static_cast<int>(str.size()))
151 throw buffer_error("overflow");
152 copy(str.begin(), str.end(), buf);
153 return buf+str.size();
156 const char *Protocol::StringSerializer::deserialize(string &str, const char *buf, const char *end) const
159 buf = length_serializer.deserialize(length, buf, end);
160 if(end-buf<static_cast<int>(length))
161 throw buffer_error("underflow");
162 str.assign(buf, buf+length);
167 Protocol::PacketDefBase::PacketDefBase(unsigned i):
172 Protocol::PacketHeader::PacketHeader(uint16_t t, uint16_t l):