File:  [ELWIX - Embedded LightWeight unIX -] / libelwix / inc / elwix / apack.h
Revision 1.3: download - view: text, annotated - select for diffs - revision graph
Tue Jul 9 00:18:19 2013 UTC (11 years, 4 months ago) by misho
Branches: MAIN
CVS tags: elwix2_6, elwix2_5, elwix2_4, elwix2_3, elwix2_2, elwix2_1, HEAD, ELWIX2_5, ELWIX2_4, ELWIX2_3, ELWIX2_2, ELWIX2_1, ELWIX2_0
version 2.0

#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_INITIALIZER	{ .r_len = 0, .r_buf = NULL, .r_next = NULL }
#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

FreeBSD-CVSweb <freebsd-cvsweb@FreeBSD.org>