]> git.proxmox.com Git - mirror_ubuntu-bionic-kernel.git/blob - arch/s390/lib/uaccess.c
ASoC: sti: fix missing clk_disable_unprepare() on error in uni_player_start()
[mirror_ubuntu-bionic-kernel.git] / arch / s390 / lib / uaccess.c
1 /*
2 * Standard user space access functions based on mvcp/mvcs and doing
3 * interesting things in the secondary space mode.
4 *
5 * Copyright IBM Corp. 2006,2014
6 * Author(s): Martin Schwidefsky (schwidefsky@de.ibm.com),
7 * Gerald Schaefer (gerald.schaefer@de.ibm.com)
8 */
9
10 #include <linux/jump_label.h>
11 #include <linux/uaccess.h>
12 #include <linux/export.h>
13 #include <linux/errno.h>
14 #include <linux/mm.h>
15 #include <asm/mmu_context.h>
16 #include <asm/facility.h>
17
18 static DEFINE_STATIC_KEY_FALSE(have_mvcos);
19
20 static inline unsigned long copy_from_user_mvcos(void *x, const void __user *ptr,
21 unsigned long size)
22 {
23 register unsigned long reg0 asm("0") = 0x81UL;
24 unsigned long tmp1, tmp2;
25
26 tmp1 = -4096UL;
27 asm volatile(
28 "0: .insn ss,0xc80000000000,0(%0,%2),0(%1),0\n"
29 "9: jz 7f\n"
30 "1: algr %0,%3\n"
31 " slgr %1,%3\n"
32 " slgr %2,%3\n"
33 " j 0b\n"
34 "2: la %4,4095(%1)\n"/* %4 = ptr + 4095 */
35 " nr %4,%3\n" /* %4 = (ptr + 4095) & -4096 */
36 " slgr %4,%1\n"
37 " clgr %0,%4\n" /* copy crosses next page boundary? */
38 " jnh 4f\n"
39 "3: .insn ss,0xc80000000000,0(%4,%2),0(%1),0\n"
40 "10:slgr %0,%4\n"
41 " algr %2,%4\n"
42 "4: lghi %4,-1\n"
43 " algr %4,%0\n" /* copy remaining size, subtract 1 */
44 " bras %3,6f\n" /* memset loop */
45 " xc 0(1,%2),0(%2)\n"
46 "5: xc 0(256,%2),0(%2)\n"
47 " la %2,256(%2)\n"
48 "6: aghi %4,-256\n"
49 " jnm 5b\n"
50 " ex %4,0(%3)\n"
51 " j 8f\n"
52 "7: slgr %0,%0\n"
53 "8:\n"
54 EX_TABLE(0b,2b) EX_TABLE(3b,4b) EX_TABLE(9b,2b) EX_TABLE(10b,4b)
55 : "+a" (size), "+a" (ptr), "+a" (x), "+a" (tmp1), "=a" (tmp2)
56 : "d" (reg0) : "cc", "memory");
57 return size;
58 }
59
60 static inline unsigned long copy_from_user_mvcp(void *x, const void __user *ptr,
61 unsigned long size)
62 {
63 unsigned long tmp1, tmp2;
64
65 load_kernel_asce();
66 tmp1 = -256UL;
67 asm volatile(
68 " sacf 0\n"
69 "0: mvcp 0(%0,%2),0(%1),%3\n"
70 "10:jz 8f\n"
71 "1: algr %0,%3\n"
72 " la %1,256(%1)\n"
73 " la %2,256(%2)\n"
74 "2: mvcp 0(%0,%2),0(%1),%3\n"
75 "11:jnz 1b\n"
76 " j 8f\n"
77 "3: la %4,255(%1)\n" /* %4 = ptr + 255 */
78 " lghi %3,-4096\n"
79 " nr %4,%3\n" /* %4 = (ptr + 255) & -4096 */
80 " slgr %4,%1\n"
81 " clgr %0,%4\n" /* copy crosses next page boundary? */
82 " jnh 5f\n"
83 "4: mvcp 0(%4,%2),0(%1),%3\n"
84 "12:slgr %0,%4\n"
85 " algr %2,%4\n"
86 "5: lghi %4,-1\n"
87 " algr %4,%0\n" /* copy remaining size, subtract 1 */
88 " bras %3,7f\n" /* memset loop */
89 " xc 0(1,%2),0(%2)\n"
90 "6: xc 0(256,%2),0(%2)\n"
91 " la %2,256(%2)\n"
92 "7: aghi %4,-256\n"
93 " jnm 6b\n"
94 " ex %4,0(%3)\n"
95 " j 9f\n"
96 "8: slgr %0,%0\n"
97 "9: sacf 768\n"
98 EX_TABLE(0b,3b) EX_TABLE(2b,3b) EX_TABLE(4b,5b)
99 EX_TABLE(10b,3b) EX_TABLE(11b,3b) EX_TABLE(12b,5b)
100 : "+a" (size), "+a" (ptr), "+a" (x), "+a" (tmp1), "=a" (tmp2)
101 : : "cc", "memory");
102 return size;
103 }
104
105 unsigned long __copy_from_user(void *to, const void __user *from, unsigned long n)
106 {
107 if (static_branch_likely(&have_mvcos))
108 return copy_from_user_mvcos(to, from, n);
109 return copy_from_user_mvcp(to, from, n);
110 }
111 EXPORT_SYMBOL(__copy_from_user);
112
113 static inline unsigned long copy_to_user_mvcos(void __user *ptr, const void *x,
114 unsigned long size)
115 {
116 register unsigned long reg0 asm("0") = 0x810000UL;
117 unsigned long tmp1, tmp2;
118
119 tmp1 = -4096UL;
120 asm volatile(
121 "0: .insn ss,0xc80000000000,0(%0,%1),0(%2),0\n"
122 "6: jz 4f\n"
123 "1: algr %0,%3\n"
124 " slgr %1,%3\n"
125 " slgr %2,%3\n"
126 " j 0b\n"
127 "2: la %4,4095(%1)\n"/* %4 = ptr + 4095 */
128 " nr %4,%3\n" /* %4 = (ptr + 4095) & -4096 */
129 " slgr %4,%1\n"
130 " clgr %0,%4\n" /* copy crosses next page boundary? */
131 " jnh 5f\n"
132 "3: .insn ss,0xc80000000000,0(%4,%1),0(%2),0\n"
133 "7: slgr %0,%4\n"
134 " j 5f\n"
135 "4: slgr %0,%0\n"
136 "5:\n"
137 EX_TABLE(0b,2b) EX_TABLE(3b,5b) EX_TABLE(6b,2b) EX_TABLE(7b,5b)
138 : "+a" (size), "+a" (ptr), "+a" (x), "+a" (tmp1), "=a" (tmp2)
139 : "d" (reg0) : "cc", "memory");
140 return size;
141 }
142
143 static inline unsigned long copy_to_user_mvcs(void __user *ptr, const void *x,
144 unsigned long size)
145 {
146 unsigned long tmp1, tmp2;
147
148 load_kernel_asce();
149 tmp1 = -256UL;
150 asm volatile(
151 " sacf 0\n"
152 "0: mvcs 0(%0,%1),0(%2),%3\n"
153 "7: jz 5f\n"
154 "1: algr %0,%3\n"
155 " la %1,256(%1)\n"
156 " la %2,256(%2)\n"
157 "2: mvcs 0(%0,%1),0(%2),%3\n"
158 "8: jnz 1b\n"
159 " j 5f\n"
160 "3: la %4,255(%1)\n" /* %4 = ptr + 255 */
161 " lghi %3,-4096\n"
162 " nr %4,%3\n" /* %4 = (ptr + 255) & -4096 */
163 " slgr %4,%1\n"
164 " clgr %0,%4\n" /* copy crosses next page boundary? */
165 " jnh 6f\n"
166 "4: mvcs 0(%4,%1),0(%2),%3\n"
167 "9: slgr %0,%4\n"
168 " j 6f\n"
169 "5: slgr %0,%0\n"
170 "6: sacf 768\n"
171 EX_TABLE(0b,3b) EX_TABLE(2b,3b) EX_TABLE(4b,6b)
172 EX_TABLE(7b,3b) EX_TABLE(8b,3b) EX_TABLE(9b,6b)
173 : "+a" (size), "+a" (ptr), "+a" (x), "+a" (tmp1), "=a" (tmp2)
174 : : "cc", "memory");
175 return size;
176 }
177
178 unsigned long __copy_to_user(void __user *to, const void *from, unsigned long n)
179 {
180 if (static_branch_likely(&have_mvcos))
181 return copy_to_user_mvcos(to, from, n);
182 return copy_to_user_mvcs(to, from, n);
183 }
184 EXPORT_SYMBOL(__copy_to_user);
185
186 static inline unsigned long copy_in_user_mvcos(void __user *to, const void __user *from,
187 unsigned long size)
188 {
189 register unsigned long reg0 asm("0") = 0x810081UL;
190 unsigned long tmp1, tmp2;
191
192 tmp1 = -4096UL;
193 /* FIXME: copy with reduced length. */
194 asm volatile(
195 "0: .insn ss,0xc80000000000,0(%0,%1),0(%2),0\n"
196 " jz 2f\n"
197 "1: algr %0,%3\n"
198 " slgr %1,%3\n"
199 " slgr %2,%3\n"
200 " j 0b\n"
201 "2:slgr %0,%0\n"
202 "3: \n"
203 EX_TABLE(0b,3b)
204 : "+a" (size), "+a" (to), "+a" (from), "+a" (tmp1), "=a" (tmp2)
205 : "d" (reg0) : "cc", "memory");
206 return size;
207 }
208
209 static inline unsigned long copy_in_user_mvc(void __user *to, const void __user *from,
210 unsigned long size)
211 {
212 unsigned long tmp1;
213
214 load_kernel_asce();
215 asm volatile(
216 " sacf 256\n"
217 " aghi %0,-1\n"
218 " jo 5f\n"
219 " bras %3,3f\n"
220 "0: aghi %0,257\n"
221 "1: mvc 0(1,%1),0(%2)\n"
222 " la %1,1(%1)\n"
223 " la %2,1(%2)\n"
224 " aghi %0,-1\n"
225 " jnz 1b\n"
226 " j 5f\n"
227 "2: mvc 0(256,%1),0(%2)\n"
228 " la %1,256(%1)\n"
229 " la %2,256(%2)\n"
230 "3: aghi %0,-256\n"
231 " jnm 2b\n"
232 "4: ex %0,1b-0b(%3)\n"
233 "5: slgr %0,%0\n"
234 "6: sacf 768\n"
235 EX_TABLE(1b,6b) EX_TABLE(2b,0b) EX_TABLE(4b,0b)
236 : "+a" (size), "+a" (to), "+a" (from), "=a" (tmp1)
237 : : "cc", "memory");
238 return size;
239 }
240
241 unsigned long __copy_in_user(void __user *to, const void __user *from, unsigned long n)
242 {
243 if (static_branch_likely(&have_mvcos))
244 return copy_in_user_mvcos(to, from, n);
245 return copy_in_user_mvc(to, from, n);
246 }
247 EXPORT_SYMBOL(__copy_in_user);
248
249 static inline unsigned long clear_user_mvcos(void __user *to, unsigned long size)
250 {
251 register unsigned long reg0 asm("0") = 0x810000UL;
252 unsigned long tmp1, tmp2;
253
254 tmp1 = -4096UL;
255 asm volatile(
256 "0: .insn ss,0xc80000000000,0(%0,%1),0(%4),0\n"
257 " jz 4f\n"
258 "1: algr %0,%2\n"
259 " slgr %1,%2\n"
260 " j 0b\n"
261 "2: la %3,4095(%1)\n"/* %4 = to + 4095 */
262 " nr %3,%2\n" /* %4 = (to + 4095) & -4096 */
263 " slgr %3,%1\n"
264 " clgr %0,%3\n" /* copy crosses next page boundary? */
265 " jnh 5f\n"
266 "3: .insn ss,0xc80000000000,0(%3,%1),0(%4),0\n"
267 " slgr %0,%3\n"
268 " j 5f\n"
269 "4: slgr %0,%0\n"
270 "5:\n"
271 EX_TABLE(0b,2b) EX_TABLE(3b,5b)
272 : "+a" (size), "+a" (to), "+a" (tmp1), "=a" (tmp2)
273 : "a" (empty_zero_page), "d" (reg0) : "cc", "memory");
274 return size;
275 }
276
277 static inline unsigned long clear_user_xc(void __user *to, unsigned long size)
278 {
279 unsigned long tmp1, tmp2;
280
281 load_kernel_asce();
282 asm volatile(
283 " sacf 256\n"
284 " aghi %0,-1\n"
285 " jo 5f\n"
286 " bras %3,3f\n"
287 " xc 0(1,%1),0(%1)\n"
288 "0: aghi %0,257\n"
289 " la %2,255(%1)\n" /* %2 = ptr + 255 */
290 " srl %2,12\n"
291 " sll %2,12\n" /* %2 = (ptr + 255) & -4096 */
292 " slgr %2,%1\n"
293 " clgr %0,%2\n" /* clear crosses next page boundary? */
294 " jnh 5f\n"
295 " aghi %2,-1\n"
296 "1: ex %2,0(%3)\n"
297 " aghi %2,1\n"
298 " slgr %0,%2\n"
299 " j 5f\n"
300 "2: xc 0(256,%1),0(%1)\n"
301 " la %1,256(%1)\n"
302 "3: aghi %0,-256\n"
303 " jnm 2b\n"
304 "4: ex %0,0(%3)\n"
305 "5: slgr %0,%0\n"
306 "6: sacf 768\n"
307 EX_TABLE(1b,6b) EX_TABLE(2b,0b) EX_TABLE(4b,0b)
308 : "+a" (size), "+a" (to), "=a" (tmp1), "=a" (tmp2)
309 : : "cc", "memory");
310 return size;
311 }
312
313 unsigned long __clear_user(void __user *to, unsigned long size)
314 {
315 if (static_branch_likely(&have_mvcos))
316 return clear_user_mvcos(to, size);
317 return clear_user_xc(to, size);
318 }
319 EXPORT_SYMBOL(__clear_user);
320
321 static inline unsigned long strnlen_user_srst(const char __user *src,
322 unsigned long size)
323 {
324 register unsigned long reg0 asm("0") = 0;
325 unsigned long tmp1, tmp2;
326
327 asm volatile(
328 " la %2,0(%1)\n"
329 " la %3,0(%0,%1)\n"
330 " slgr %0,%0\n"
331 " sacf 256\n"
332 "0: srst %3,%2\n"
333 " jo 0b\n"
334 " la %0,1(%3)\n" /* strnlen_user results includes \0 */
335 " slgr %0,%1\n"
336 "1: sacf 768\n"
337 EX_TABLE(0b,1b)
338 : "+a" (size), "+a" (src), "=a" (tmp1), "=a" (tmp2)
339 : "d" (reg0) : "cc", "memory");
340 return size;
341 }
342
343 unsigned long __strnlen_user(const char __user *src, unsigned long size)
344 {
345 if (unlikely(!size))
346 return 0;
347 load_kernel_asce();
348 return strnlen_user_srst(src, size);
349 }
350 EXPORT_SYMBOL(__strnlen_user);
351
352 long __strncpy_from_user(char *dst, const char __user *src, long size)
353 {
354 size_t done, len, offset, len_str;
355
356 if (unlikely(size <= 0))
357 return 0;
358 done = 0;
359 do {
360 offset = (size_t)src & ~PAGE_MASK;
361 len = min(size - done, PAGE_SIZE - offset);
362 if (copy_from_user(dst, src, len))
363 return -EFAULT;
364 len_str = strnlen(dst, len);
365 done += len_str;
366 src += len_str;
367 dst += len_str;
368 } while ((len_str == len) && (done < size));
369 return done;
370 }
371 EXPORT_SYMBOL(__strncpy_from_user);
372
373 static int __init uaccess_init(void)
374 {
375 if (test_facility(27))
376 static_branch_enable(&have_mvcos);
377 return 0;
378 }
379 early_initcall(uaccess_init);