1
2#ifndef __ASM_SH_UNALIGNED_SH4A_H
3#define __ASM_SH_UNALIGNED_SH4A_H
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22#include <linux/unaligned/packed_struct.h>
23#include <linux/types.h>
24#include <asm/byteorder.h>
25
26static inline u16 sh4a_get_unaligned_cpu16(const u8 *p)
27{
28#ifdef __LITTLE_ENDIAN
29 return p[0] | p[1] << 8;
30#else
31 return p[0] << 8 | p[1];
32#endif
33}
34
35static __always_inline u32 sh4a_get_unaligned_cpu32(const u8 *p)
36{
37 unsigned long unaligned;
38
39 __asm__ __volatile__ (
40 "movua.l @%1, %0\n\t"
41 : "=z" (unaligned)
42 : "r" (p)
43 );
44
45 return unaligned;
46}
47
48
49
50
51
52
53static inline u64 sh4a_get_unaligned_cpu64(const u8 *p)
54{
55#ifdef __LITTLE_ENDIAN
56 return (u64)sh4a_get_unaligned_cpu32(p + 4) << 32 |
57 sh4a_get_unaligned_cpu32(p);
58#else
59 return (u64)sh4a_get_unaligned_cpu32(p) << 32 |
60 sh4a_get_unaligned_cpu32(p + 4);
61#endif
62}
63
64static inline u16 get_unaligned_le16(const void *p)
65{
66 return le16_to_cpu(sh4a_get_unaligned_cpu16(p));
67}
68
69static inline u32 get_unaligned_le32(const void *p)
70{
71 return le32_to_cpu(sh4a_get_unaligned_cpu32(p));
72}
73
74static inline u64 get_unaligned_le64(const void *p)
75{
76 return le64_to_cpu(sh4a_get_unaligned_cpu64(p));
77}
78
79static inline u16 get_unaligned_be16(const void *p)
80{
81 return be16_to_cpu(sh4a_get_unaligned_cpu16(p));
82}
83
84static inline u32 get_unaligned_be32(const void *p)
85{
86 return be32_to_cpu(sh4a_get_unaligned_cpu32(p));
87}
88
89static inline u64 get_unaligned_be64(const void *p)
90{
91 return be64_to_cpu(sh4a_get_unaligned_cpu64(p));
92}
93
94static inline void nonnative_put_le16(u16 val, u8 *p)
95{
96 *p++ = val;
97 *p++ = val >> 8;
98}
99
100static inline void nonnative_put_le32(u32 val, u8 *p)
101{
102 nonnative_put_le16(val, p);
103 nonnative_put_le16(val >> 16, p + 2);
104}
105
106static inline void nonnative_put_le64(u64 val, u8 *p)
107{
108 nonnative_put_le32(val, p);
109 nonnative_put_le32(val >> 32, p + 4);
110}
111
112static inline void nonnative_put_be16(u16 val, u8 *p)
113{
114 *p++ = val >> 8;
115 *p++ = val;
116}
117
118static inline void nonnative_put_be32(u32 val, u8 *p)
119{
120 nonnative_put_be16(val >> 16, p);
121 nonnative_put_be16(val, p + 2);
122}
123
124static inline void nonnative_put_be64(u64 val, u8 *p)
125{
126 nonnative_put_be32(val >> 32, p);
127 nonnative_put_be32(val, p + 4);
128}
129
130static inline void put_unaligned_le16(u16 val, void *p)
131{
132#ifdef __LITTLE_ENDIAN
133 __put_unaligned_cpu16(val, p);
134#else
135 nonnative_put_le16(val, p);
136#endif
137}
138
139static inline void put_unaligned_le32(u32 val, void *p)
140{
141#ifdef __LITTLE_ENDIAN
142 __put_unaligned_cpu32(val, p);
143#else
144 nonnative_put_le32(val, p);
145#endif
146}
147
148static inline void put_unaligned_le64(u64 val, void *p)
149{
150#ifdef __LITTLE_ENDIAN
151 __put_unaligned_cpu64(val, p);
152#else
153 nonnative_put_le64(val, p);
154#endif
155}
156
157static inline void put_unaligned_be16(u16 val, void *p)
158{
159#ifdef __BIG_ENDIAN
160 __put_unaligned_cpu16(val, p);
161#else
162 nonnative_put_be16(val, p);
163#endif
164}
165
166static inline void put_unaligned_be32(u32 val, void *p)
167{
168#ifdef __BIG_ENDIAN
169 __put_unaligned_cpu32(val, p);
170#else
171 nonnative_put_be32(val, p);
172#endif
173}
174
175static inline void put_unaligned_be64(u64 val, void *p)
176{
177#ifdef __BIG_ENDIAN
178 __put_unaligned_cpu64(val, p);
179#else
180 nonnative_put_be64(val, p);
181#endif
182}
183
184
185
186
187
188
189#include <linux/unaligned/generic.h>
190
191#ifdef __LITTLE_ENDIAN
192# define get_unaligned __get_unaligned_le
193# define put_unaligned __put_unaligned_le
194#else
195# define get_unaligned __get_unaligned_be
196# define put_unaligned __put_unaligned_be
197#endif
198
199#endif
200