--- libelwix/inc/elwix/apack.h 2013/06/28 15:30:46 1.1.2.3 +++ libelwix/inc/elwix/apack.h 2013/07/09 00:18:19 1.3 @@ -8,6 +8,7 @@ typedef struct tagRawPacket { 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); \ @@ -18,6 +19,32 @@ typedef struct tagRawPacket { #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 | \ @@ -114,6 +141,30 @@ uint8_t rpack_uint8(rpack_t * __restrict rp, uint8_t * * 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