1 /* SPDX-License-Identifier: GPL-2.0 */
2 #ifndef __ASM_GENERIC_UNALIGNED_H
3 #define __ASM_GENERIC_UNALIGNED_H
4 
5 /*
6  * This is the most generic implementation of unaligned accesses
7  * and should work almost anywhere.
8  */
9 #include <linux/unaligned/packed_struct.h>
10 #include <asm/byteorder.h>
11 
12 #define __get_unaligned_t(type, ptr) ({						\
13 	const struct { type x; } __packed *__pptr = (typeof(__pptr))(ptr);	\
14 	__pptr->x;								\
15 })
16 
17 #define __put_unaligned_t(type, val, ptr) do {					\
18 	struct { type x; } __packed *__pptr = (typeof(__pptr))(ptr);		\
19 	__pptr->x = (val);							\
20 } while (0)
21 
22 #define get_unaligned(ptr)	__get_unaligned_t(typeof(*(ptr)), (ptr))
23 #define put_unaligned(val, ptr) __put_unaligned_t(typeof(*(ptr)), (val), (ptr))
24 
get_unaligned_le16(const void * p)25 static inline u16 get_unaligned_le16(const void *p)
26 {
27 	return le16_to_cpu(__get_unaligned_t(__le16, p));
28 }
29 
get_unaligned_le32(const void * p)30 static inline u32 get_unaligned_le32(const void *p)
31 {
32 	return le32_to_cpu(__get_unaligned_t(__le32, p));
33 }
34 
get_unaligned_le64(const void * p)35 static inline u64 get_unaligned_le64(const void *p)
36 {
37 	return le64_to_cpu(__get_unaligned_t(__le64, p));
38 }
39 
put_unaligned_le16(u16 val,void * p)40 static inline void put_unaligned_le16(u16 val, void *p)
41 {
42 	__put_unaligned_t(__le16, cpu_to_le16(val), p);
43 }
44 
put_unaligned_le32(u32 val,void * p)45 static inline void put_unaligned_le32(u32 val, void *p)
46 {
47 	__put_unaligned_t(__le32, cpu_to_le32(val), p);
48 }
49 
put_unaligned_le64(u64 val,void * p)50 static inline void put_unaligned_le64(u64 val, void *p)
51 {
52 	__put_unaligned_t(__le64, cpu_to_le64(val), p);
53 }
54 
get_unaligned_be16(const void * p)55 static inline u16 get_unaligned_be16(const void *p)
56 {
57 	return be16_to_cpu(__get_unaligned_t(__be16, p));
58 }
59 
get_unaligned_be32(const void * p)60 static inline u32 get_unaligned_be32(const void *p)
61 {
62 	return be32_to_cpu(__get_unaligned_t(__be32, p));
63 }
64 
get_unaligned_be64(const void * p)65 static inline u64 get_unaligned_be64(const void *p)
66 {
67 	return be64_to_cpu(__get_unaligned_t(__be64, p));
68 }
69 
put_unaligned_be16(u16 val,void * p)70 static inline void put_unaligned_be16(u16 val, void *p)
71 {
72 	__put_unaligned_t(__be16, cpu_to_be16(val), p);
73 }
74 
put_unaligned_be32(u32 val,void * p)75 static inline void put_unaligned_be32(u32 val, void *p)
76 {
77 	__put_unaligned_t(__be32, cpu_to_be32(val), p);
78 }
79 
put_unaligned_be64(u64 val,void * p)80 static inline void put_unaligned_be64(u64 val, void *p)
81 {
82 	__put_unaligned_t(__be64, cpu_to_be64(val), p);
83 }
84 
__get_unaligned_be24(const u8 * p)85 static inline u32 __get_unaligned_be24(const u8 *p)
86 {
87 	return p[0] << 16 | p[1] << 8 | p[2];
88 }
89 
get_unaligned_be24(const void * p)90 static inline u32 get_unaligned_be24(const void *p)
91 {
92 	return __get_unaligned_be24(p);
93 }
94 
__get_unaligned_le24(const u8 * p)95 static inline u32 __get_unaligned_le24(const u8 *p)
96 {
97 	return p[0] | p[1] << 8 | p[2] << 16;
98 }
99 
get_unaligned_le24(const void * p)100 static inline u32 get_unaligned_le24(const void *p)
101 {
102 	return __get_unaligned_le24(p);
103 }
104 
__put_unaligned_be24(const u32 val,u8 * p)105 static inline void __put_unaligned_be24(const u32 val, u8 *p)
106 {
107 	*p++ = val >> 16;
108 	*p++ = val >> 8;
109 	*p++ = val;
110 }
111 
put_unaligned_be24(const u32 val,void * p)112 static inline void put_unaligned_be24(const u32 val, void *p)
113 {
114 	__put_unaligned_be24(val, p);
115 }
116 
__put_unaligned_le24(const u32 val,u8 * p)117 static inline void __put_unaligned_le24(const u32 val, u8 *p)
118 {
119 	*p++ = val;
120 	*p++ = val >> 8;
121 	*p++ = val >> 16;
122 }
123 
put_unaligned_le24(const u32 val,void * p)124 static inline void put_unaligned_le24(const u32 val, void *p)
125 {
126 	__put_unaligned_le24(val, p);
127 }
128 
__put_unaligned_be48(const u64 val,u8 * p)129 static inline void __put_unaligned_be48(const u64 val, u8 *p)
130 {
131 	*p++ = val >> 40;
132 	*p++ = val >> 32;
133 	*p++ = val >> 24;
134 	*p++ = val >> 16;
135 	*p++ = val >> 8;
136 	*p++ = val;
137 }
138 
put_unaligned_be48(const u64 val,void * p)139 static inline void put_unaligned_be48(const u64 val, void *p)
140 {
141 	__put_unaligned_be48(val, p);
142 }
143 
__get_unaligned_be48(const u8 * p)144 static inline u64 __get_unaligned_be48(const u8 *p)
145 {
146 	return (u64)p[0] << 40 | (u64)p[1] << 32 | (u64)p[2] << 24 |
147 		p[3] << 16 | p[4] << 8 | p[5];
148 }
149 
get_unaligned_be48(const void * p)150 static inline u64 get_unaligned_be48(const void *p)
151 {
152 	return __get_unaligned_be48(p);
153 }
154 
155 #endif /* __ASM_GENERIC_UNALIGNED_H */
156