--- libelwix/inc/elwix/apack.h	2013/06/28 08:39:41	1.1
+++ libelwix/inc/elwix/apack.h	2013/06/30 22:10:27	1.2
@@ -0,0 +1,169 @@
+#ifndef __APACK_H
+#define __APACK_H
+
+
+typedef struct tagRawPacket {
+	size_t	r_len;
+	uint8_t	*r_buf;
+	uint8_t	*r_next;
+} rpack_t;
+
+#define RPACK_FREE(x)		(assert((x)), memset((x), 0, sizeof(rpack_t)))
+#define RPACK_INIT(x, b, l)	do { assert((x)); RPACK_FREE(x); \
+					(x)->r_buf = (b); \
+       					(x)->r_len = (l); \
+					(x)->r_next = (x)->r_buf; \
+				} while (0)
+#define RPACK_SANITY(x)		((x) && (x)->r_buf && (x)->r_next && (x)->r_next >= (x)->r_buf)
+#define RPACK_LEN(x)		(assert((x)), (x)->r_len)
+#define RPACK_REWIND(x)		(assert((x)), (x)->r_next = (x)->r_buf)
+
+#define RPACK_SET_16(x, n)	do { assert((x)); \
+					*((uint8_t *) (x) + 1) = *((const uint8_t *) (n) + 1); \
+					*((uint8_t *) (x) + 0) = *((const uint8_t *) (n) + 0); \
+				} while (0)
+#define RPACK_SET_24(x, n)	do { assert((x)); \
+					*((uint8_t *) (x) + 2) = *((const uint8_t *) (n) + 2); \
+					*((uint8_t *) (x) + 1) = *((const uint8_t *) (n) + 1); \
+					*((uint8_t *) (x) + 0) = *((const uint8_t *) (n) + 0); \
+				} while (0)
+#define RPACK_SET_32(x, n)	do { assert((x)); \
+					*((uint8_t *) (x) + 3) = *((const uint8_t *) (n) + 3); \
+					*((uint8_t *) (x) + 2) = *((const uint8_t *) (n) + 2); \
+					*((uint8_t *) (x) + 1) = *((const uint8_t *) (n) + 1); \
+					*((uint8_t *) (x) + 0) = *((const uint8_t *) (n) + 0); \
+				} while (0)
+#define RPACK_SET_64(x, n)	do { assert((x)); \
+					*((uint8_t *) (x) + 7) = *((const uint8_t *) (n) + 7); \
+					*((uint8_t *) (x) + 6) = *((const uint8_t *) (n) + 6); \
+					*((uint8_t *) (x) + 5) = *((const uint8_t *) (n) + 5); \
+					*((uint8_t *) (x) + 4) = *((const uint8_t *) (n) + 4); \
+					*((uint8_t *) (x) + 3) = *((const uint8_t *) (n) + 3); \
+					*((uint8_t *) (x) + 2) = *((const uint8_t *) (n) + 2); \
+					*((uint8_t *) (x) + 1) = *((const uint8_t *) (n) + 1); \
+					*((uint8_t *) (x) + 0) = *((const uint8_t *) (n) + 0); \
+				} while (0)
+
+#define EXTRACT_LE_8(x)		(assert((x)), *(x))
+#define EXTRACT_LE_16(x)	(assert((x)), (u_int16_t) ( \
+					(uint16_t) *((const uint8_t *) (x) + 1) << 8 | \
+					(uint16_t) *((const uint8_t *) (x) + 0) \
+				))
+#define EXTRACT_LE_24(x)	(assert((x)), (u_int32_t) ( \
+					(uint32_t) *((const uint8_t *) (x) + 2) << 16 | \
+					(uint32_t) *((const uint8_t *) (x) + 1) << 8 | \
+					(uint32_t) *((const uint8_t *) (x) + 0) \
+				))
+#define EXTRACT_LE_32(x)	(assert((x)), (u_int32_t) ( \
+					(uint32_t) *((const uint8_t *) (x) + 3) << 24 | \
+					(uint32_t) *((const uint8_t *) (x) + 2) << 16 | \
+					(uint32_t) *((const uint8_t *) (x) + 1) << 8 | \
+					(uint32_t) *((const uint8_t *) (x) + 0) \
+				))
+#define EXTRACT_LE_64(x)	(assert((x)), (u_int64_t) ( \
+					(uint64_t) *((const uint8_t *) (x) + 7) << 56 | \
+					(uint64_t) *((const uint8_t *) (x) + 6) << 48 | \
+					(uint64_t) *((const uint8_t *) (x) + 5) << 40 | \
+					(uint64_t) *((const uint8_t *) (x) + 4) << 32 | \
+					(uint64_t) *((const uint8_t *) (x) + 3) << 24 | \
+					(uint64_t) *((const uint8_t *) (x) + 2) << 16 | \
+					(uint64_t) *((const uint8_t *) (x) + 1) << 8 | \
+					(uint64_t) *((const uint8_t *) (x) + 0) \
+				))
+
+#define EXTRACT_BE_8(x)		(assert((x)), *(x))
+#define EXTRACT_BE_16(x)	(assert((x)), (u_int16_t) ( \
+					(uint16_t) *((const uint8_t *) (x) + 0) << 8 | \
+					(uint16_t) *((const uint8_t *) (x) + 1) \
+				))
+#define EXTRACT_BE_24(x)	(assert((x)), (u_int32_t) ( \
+					(uint32_t) *((const uint8_t *) (x) + 0) << 16 | \
+					(uint32_t) *((const uint8_t *) (x) + 1) << 8 | \
+					(uint32_t) *((const uint8_t *) (x) + 2) \
+				))
+#define EXTRACT_BE_32(x)	(assert((x)), (u_int32_t) ( \
+					(uint32_t) *((const uint8_t *) (x) + 0) << 24 | \
+					(uint32_t) *((const uint8_t *) (x) + 1) << 16 | \
+					(uint32_t) *((const uint8_t *) (x) + 2) << 8 | \
+					(uint32_t) *((const uint8_t *) (x) + 3) \
+				))
+#define EXTRACT_BE_64(x)	(assert((x)), (u_int64_t) ( \
+					(uint64_t) *((const uint8_t *) (x) + 0) << 56 | \
+					(uint64_t) *((const uint8_t *) (x) + 1) << 48 | \
+					(uint64_t) *((const uint8_t *) (x) + 2) << 40 | \
+					(uint64_t) *((const uint8_t *) (x) + 3) << 32 | \
+					(uint64_t) *((const uint8_t *) (x) + 4) << 24 | \
+					(uint64_t) *((const uint8_t *) (x) + 5) << 16 | \
+					(uint64_t) *((const uint8_t *) (x) + 6) << 8 | \
+					(uint64_t) *((const uint8_t *) (x) + 7) \
+				))
+
+
+/*
+ * rpack_align_and_reserve() - Align & reserve space
+ *
+ * @rp = raw buffer
+ * @siz = need size
+ * return: NULL error or not enough space, !=NULL next position
+ */
+uint8_t *rpack_align_and_reserve(rpack_t * __restrict rp, size_t siz);
+
+/*
+ * rpack_create() - Allocate & init raw packet structure
+ *
+ * @buf = buffer
+ * @buflen = length of buffer
+ * return: NULL error or !=NULL raw packet, should be freed by rpack_destroy()
+ */
+rpack_t *rpack_create(void * __restrict buf, size_t buflen);
+/*
+ * rpack_destroy() - Release & free raw packet structure
+ *
+ * @rp = raw packet
+ * return: none
+ */
+void rpack_destroy(rpack_t ** __restrict rp);
+
+/*
+ * rpack_uint8() - Pack/Unpack 8bit value
+ *
+ * @rp = raw buffer
+ * @n = set value if !=NULL
+ * return: -1 error or get value
+ */
+uint8_t rpack_uint8(rpack_t * __restrict rp, uint8_t * __restrict n);
+/*
+ * rpack_uint16() - Pack/Unpack 16bit value
+ *
+ * @rp = raw buffer
+ * @n = set value if !=NULL
+ * return: -1 error or get value
+ */
+uint16_t rpack_uint16(rpack_t * __restrict rp, uint16_t * __restrict n);
+/*
+ * rpack_uint24() - Pack/Unpack 24bit value
+ *
+ * @rp = raw buffer
+ * @n = set value if !=NULL
+ * return: -1 error or get value
+ */
+uint32_t rpack_uint24(rpack_t * __restrict rp, uint32_t * __restrict n);
+/*
+ * rpack_uint32() - Pack/Unpack 32bit value
+ *
+ * @rp = raw buffer
+ * @n = set value if !=NULL
+ * return: -1 error or get value
+ */
+uint32_t rpack_uint32(rpack_t * __restrict rp, uint32_t * __restrict n);
+/*
+ * rpack_uint64() - Pack/Unpack 64bit value
+ *
+ * @rp = raw buffer
+ * @n = set value if !=NULL
+ * return: -1 error or get value
+ */
+uint64_t rpack_uint64(rpack_t * __restrict rp, uint64_t * __restrict n);
+
+
+#endif