| Andrew Scull | b4b6d4a | 2019-01-02 15:54:55 +0000 | [diff] [blame] | 1 | /* SPDX-License-Identifier: GPL-2.0 */ |
| 2 | #ifndef _LINUX_UNALIGNED_GENERIC_H |
| 3 | #define _LINUX_UNALIGNED_GENERIC_H |
| 4 | |
| Olivier Deprez | 157378f | 2022-04-04 15:47:50 +0200 | [diff] [blame^] | 5 | #include <linux/types.h> |
| 6 | |
| Andrew Scull | b4b6d4a | 2019-01-02 15:54:55 +0000 | [diff] [blame] | 7 | /* |
| 8 | * Cause a link-time error if we try an unaligned access other than |
| 9 | * 1,2,4 or 8 bytes long |
| 10 | */ |
| 11 | extern void __bad_unaligned_access_size(void); |
| 12 | |
| 13 | #define __get_unaligned_le(ptr) ((__force typeof(*(ptr)))({ \ |
| 14 | __builtin_choose_expr(sizeof(*(ptr)) == 1, *(ptr), \ |
| 15 | __builtin_choose_expr(sizeof(*(ptr)) == 2, get_unaligned_le16((ptr)), \ |
| 16 | __builtin_choose_expr(sizeof(*(ptr)) == 4, get_unaligned_le32((ptr)), \ |
| 17 | __builtin_choose_expr(sizeof(*(ptr)) == 8, get_unaligned_le64((ptr)), \ |
| 18 | __bad_unaligned_access_size())))); \ |
| 19 | })) |
| 20 | |
| 21 | #define __get_unaligned_be(ptr) ((__force typeof(*(ptr)))({ \ |
| 22 | __builtin_choose_expr(sizeof(*(ptr)) == 1, *(ptr), \ |
| 23 | __builtin_choose_expr(sizeof(*(ptr)) == 2, get_unaligned_be16((ptr)), \ |
| 24 | __builtin_choose_expr(sizeof(*(ptr)) == 4, get_unaligned_be32((ptr)), \ |
| 25 | __builtin_choose_expr(sizeof(*(ptr)) == 8, get_unaligned_be64((ptr)), \ |
| 26 | __bad_unaligned_access_size())))); \ |
| 27 | })) |
| 28 | |
| 29 | #define __put_unaligned_le(val, ptr) ({ \ |
| 30 | void *__gu_p = (ptr); \ |
| 31 | switch (sizeof(*(ptr))) { \ |
| 32 | case 1: \ |
| 33 | *(u8 *)__gu_p = (__force u8)(val); \ |
| 34 | break; \ |
| 35 | case 2: \ |
| 36 | put_unaligned_le16((__force u16)(val), __gu_p); \ |
| 37 | break; \ |
| 38 | case 4: \ |
| 39 | put_unaligned_le32((__force u32)(val), __gu_p); \ |
| 40 | break; \ |
| 41 | case 8: \ |
| 42 | put_unaligned_le64((__force u64)(val), __gu_p); \ |
| 43 | break; \ |
| 44 | default: \ |
| 45 | __bad_unaligned_access_size(); \ |
| 46 | break; \ |
| 47 | } \ |
| 48 | (void)0; }) |
| 49 | |
| 50 | #define __put_unaligned_be(val, ptr) ({ \ |
| 51 | void *__gu_p = (ptr); \ |
| 52 | switch (sizeof(*(ptr))) { \ |
| 53 | case 1: \ |
| 54 | *(u8 *)__gu_p = (__force u8)(val); \ |
| 55 | break; \ |
| 56 | case 2: \ |
| 57 | put_unaligned_be16((__force u16)(val), __gu_p); \ |
| 58 | break; \ |
| 59 | case 4: \ |
| 60 | put_unaligned_be32((__force u32)(val), __gu_p); \ |
| 61 | break; \ |
| 62 | case 8: \ |
| 63 | put_unaligned_be64((__force u64)(val), __gu_p); \ |
| 64 | break; \ |
| 65 | default: \ |
| 66 | __bad_unaligned_access_size(); \ |
| 67 | break; \ |
| 68 | } \ |
| 69 | (void)0; }) |
| 70 | |
| Olivier Deprez | 157378f | 2022-04-04 15:47:50 +0200 | [diff] [blame^] | 71 | static inline u32 __get_unaligned_be24(const u8 *p) |
| 72 | { |
| 73 | return p[0] << 16 | p[1] << 8 | p[2]; |
| 74 | } |
| 75 | |
| 76 | static inline u32 get_unaligned_be24(const void *p) |
| 77 | { |
| 78 | return __get_unaligned_be24(p); |
| 79 | } |
| 80 | |
| 81 | static inline u32 __get_unaligned_le24(const u8 *p) |
| 82 | { |
| 83 | return p[0] | p[1] << 8 | p[2] << 16; |
| 84 | } |
| 85 | |
| 86 | static inline u32 get_unaligned_le24(const void *p) |
| 87 | { |
| 88 | return __get_unaligned_le24(p); |
| 89 | } |
| 90 | |
| 91 | static inline void __put_unaligned_be24(const u32 val, u8 *p) |
| 92 | { |
| 93 | *p++ = val >> 16; |
| 94 | *p++ = val >> 8; |
| 95 | *p++ = val; |
| 96 | } |
| 97 | |
| 98 | static inline void put_unaligned_be24(const u32 val, void *p) |
| 99 | { |
| 100 | __put_unaligned_be24(val, p); |
| 101 | } |
| 102 | |
| 103 | static inline void __put_unaligned_le24(const u32 val, u8 *p) |
| 104 | { |
| 105 | *p++ = val; |
| 106 | *p++ = val >> 8; |
| 107 | *p++ = val >> 16; |
| 108 | } |
| 109 | |
| 110 | static inline void put_unaligned_le24(const u32 val, void *p) |
| 111 | { |
| 112 | __put_unaligned_le24(val, p); |
| 113 | } |
| 114 | |
| Andrew Scull | b4b6d4a | 2019-01-02 15:54:55 +0000 | [diff] [blame] | 115 | #endif /* _LINUX_UNALIGNED_GENERIC_H */ |