|
|
| version 1.1, 2013/06/28 08:39:41 | version 1.2, 2013/06/30 22:10:27 |
|---|---|
| Line 0 | Line 1 |
| #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 |