#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 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);
#endif
FreeBSD-CVSweb <freebsd-cvsweb@FreeBSD.org>