include/apos/unaligned.h


1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67

#ifndef APOS_UNALIGNED_H
#define APOS_UNALIGNED_H

#include <apos/types.h>
#include <apos/attrs.h>

#define get_unaligned(ptr)                                                     \
	_Generic(*(ptr), uint8_t                                               \
	         : __get_unaligned_uint8_t, uint16_t                           \
	         : __get_unaligned_uint16_t, uint32_t                          \
	         : __get_unaligned_uint32_t, uint64_t                          \
	         : __get_unaligned_uint64_t, int8_t                            \
	         : __get_unaligned_int8_t, int16_t                             \
	         : __get_unaligned_int16_t, int32_t                            \
	         : __get_unaligned_int32_t, int64_t                            \
	         : __get_unaligned_int64_t)((void *)ptr)

#define put_unaligned(val, ptr)                                                \
	_Generic(*(ptr), uint8_t                                               \
	         : __put_unaligned_uint8_t, uint16_t                           \
	         : __put_unaligned_uint16_t, uint32_t                          \
	         : __put_unaligned_uint32_t, uint64_t                          \
	         : __put_unaligned_uint64_t, int8_t                            \
	         : __put_unaligned_int8_t, int16_t                             \
	         : __put_unaligned_int16_t, int32_t                            \
	         : __put_unaligned_int32_t, int64_t                            \
	         : __put_unaligned_int64_t)(val, (void *)ptr)

#define DEFINE_GET(type)                                                       \
	static inline type __get_unaligned_##type(void *ptr)                   \
	{                                                                      \
		const struct __packed {                                        \
			type x;                                                \
		} *__pptr = ptr;                                               \
		return __pptr->x;                                              \
	}

DEFINE_GET(uint8_t);
DEFINE_GET(uint16_t);
DEFINE_GET(uint32_t);
DEFINE_GET(uint64_t);
DEFINE_GET(int8_t);
DEFINE_GET(int16_t);
DEFINE_GET(int32_t);
DEFINE_GET(int64_t);

#undef DEFINE_GET

#define DEFINE_PUT(type)                                                       \
	static inline void __put_unaligned_##type(type val, void *ptr)         \
	{                                                                      \
		struct __packed {                                              \
			type x;                                                \
		} *__pptr = ptr;                                               \
		__pptr->x = val;                                               \
	}

DEFINE_PUT(uint8_t);
DEFINE_PUT(uint16_t);
DEFINE_PUT(uint32_t);
DEFINE_PUT(uint64_t);
DEFINE_PUT(int8_t);
DEFINE_PUT(int16_t);
DEFINE_PUT(int32_t);
DEFINE_PUT(int64_t);

#endif /* APOS_UNALIGNED_H */