1 files changed, 188 insertions, 0 deletions
diff --git a/src/lib/xdr.cc b/src/lib/xdr.cc
new file mode 100644
index 0000000..b44471f
--- /dev/null
+++ b/src/lib/xdr.cc
@@ -0,0 +1,188 @@
+#include "lib/xdr.h"
+
+void XDRWriter::put(uint32_t number)
+{
+	*buffer++ = ((number >> 24) & 0xffU);
+	*buffer++ = ((number >> 16) & 0xffU);
+	*buffer++ = ((number >> 8) & 0xffU);
+	*buffer++ = (number & 0xffU);
+	pos += 4;
+}
+
+void XDRWriter::put(int32_t number)
+{
+	*buffer++ = ((number >> 24) & 0xffU);
+	*buffer++ = ((number >> 16) & 0xffU);
+	*buffer++ = ((number >> 8) & 0xffU);
+	*buffer++ = (number & 0xffU);
+	pos += 4;
+}
+
+void XDRWriter::put(uint64_t number)
+{
+	*buffer++ = ((number >> 56) & 0xffU);
+	*buffer++ = ((number >> 48) & 0xffU);
+	*buffer++ = ((number >> 40) & 0xffU);
+	*buffer++ = ((number >> 32) & 0xffU);
+	*buffer++ = ((number >> 24) & 0xffU);
+	*buffer++ = ((number >> 16) & 0xffU);
+	*buffer++ = ((number >> 8) & 0xffU);
+	*buffer++ = (number & 0xffU);
+	pos += 8;
+}
+
+void XDRWriter::put(int64_t number)
+{
+	*buffer++ = ((number >> 56) & 0xffU);
+	*buffer++ = ((number >> 48) & 0xffU);
+	*buffer++ = ((number >> 40) & 0xffU);
+	*buffer++ = ((number >> 32) & 0xffU);
+	*buffer++ = ((number >> 24) & 0xffU);
+	*buffer++ = ((number >> 16) & 0xffU);
+	*buffer++ = ((number >> 8) & 0xffU);
+	*buffer++ = (number & 0xffU);
+	pos += 8;
+}
+
+void XDRWriter::put(float number)
+{
+	union {
+		uint32_t i;
+		float f;
+	} v;
+	// Setting one member of a struct and then reading another is undefined
+	// behaviour, but works as intended in nearly any (embedded) compiler
+	v.f = number;
+	put(v.i);
+}
+
+void XDRWriter::put(double number)
+{
+	union {
+		uint64_t i;
+		double d;
+	} v;
+	// Setting one member of a struct and then reading another is undefined
+	// behaviour, but works as intended in nearly any (embedded) compiler
+	v.d = number;
+	put(v.i);
+}
+
+void XDRWriter::put(char const *data)
+{
+	if (!is_fixed_length)
+	{
+		put(next_array_len);
+	}
+	uint32_t i;
+	for (i = 0; i < next_array_len; i++)
+	{
+		*buffer++ = data[i];
+	}
+	while ((i++) % 4 != 0)
+	{
+		*buffer++ = 0;
+	}
+	pos += i - 1;
+}
+
+template <uint32_t TSize>
+void XDRWriter::put(char const (&data)[TSize])
+{
+	if (!is_fixed_length)
+	{
+		put(TSize);
+	}
+	uint32_t i;
+	for (i = 0; i < TSize; i++)
+	{
+		*buffer++ = data[i];
+	}
+	while ((i++) % 4 != 0)
+	{
+		*buffer++ = 0;
+	}
+	pos += i - 1;
+}
+
+uint32_t XDRReader::get_uint32()
+{
+	uint32_t ret = (((uint32_t)data[pos] & 0xffU) << 24) | (((uint32_t)data[pos + 1] & 0xffU) << 16) | (((uint32_t)data[pos + 2] & 0xffU) << 8) | ((uint32_t)data[pos + 3] & 0xffU);
+	pos += 4;
+	return ret;
+}
+
+int32_t XDRReader::get_int32()
+{
+	int32_t ret = (((int32_t)data[pos] & 0xff) << 24) | (((int32_t)data[pos + 1] & 0xff) << 16) | (((int32_t)data[pos + 2] & 0xff) << 8) | ((int32_t)data[pos + 3] & 0xff);
+	pos += 4;
+	return ret;
+}
+
+uint64_t XDRReader::get_uint64()
+{
+	uint64_t ret = (((uint64_t)data[pos] & 0xffU) << 56) | (((uint64_t)data[pos + 1] & 0xffU) << 48) | (((uint64_t)data[pos + 2] & 0xffU) << 40) | (((uint64_t)data[pos + 3] & 0xffU) << 32) | (((uint64_t)data[pos + 4] & 0xffU) << 24) | (((uint64_t)data[pos + 5] & 0xffU) << 16) | (((uint64_t)data[pos + 6] & 0xffU) << 8) | ((uint64_t)data[pos + 7] & 0xffU);
+	return ret;
+}
+
+int64_t XDRReader::get_int64()
+{
+	int64_t ret = (((int64_t)data[pos] & 0xff) << 56) | (((int64_t)data[pos + 1] & 0xff) << 48) | (((int64_t)data[pos + 2] & 0xff) << 40) | (((int64_t)data[pos + 3] & 0xff) << 32) | (((int64_t)data[pos + 4] & 0xff) << 24) | (((int64_t)data[pos + 5] & 0xff) << 16) | (((int64_t)data[pos + 6] & 0xff) << 8) | ((int64_t)data[pos + 7] & 0xff);
+	return ret;
+}
+
+float XDRReader::get_float()
+{
+	union {
+		uint32_t i;
+		float f;
+	} v;
+	// Setting one member of a struct and then reading another is undefined
+	// behaviour, but works as intended in nearly any (embedded) compiler
+	v.i = get_uint32();
+	return v.f;
+}
+
+double XDRReader::get_double()
+{
+	union {
+		uint64_t i;
+		double d;
+	} v;
+	// Setting one member of a struct and then reading another is undefined
+	// behaviour, but works as intended in nearly any (embedded) compiler
+	v.i = get_uint64();
+	return v.d;
+}
+
+uint32_t XDRReader::get_opaque_length()
+{
+	return get_uint32();
+}
+
+char *XDRReader::get_opaque(uint32_t length)
+{
+	char *ret = data + pos;
+	pos += length;
+	if (length % 4)
+	{
+		pos += 4 - (length % 4);
+	}
+	return ret;
+}
+
+void XDRReader::get_string(char *target)
+{
+	uint16_t length = get_opaque_length();
+	uint16_t i;
+	for (i = 0; i < length; i++)
+	{
+		target[i] = data[pos + i];
+	}
+	target[i] = 0;
+	pos += length;
+	if (length % 4)
+	{
+		pos += 4 - (length % 4);
+	}
+}