Loading...
1// SPDX-License-Identifier: GPL-2.0
2/*
3 * Standard user space access functions based on mvcp/mvcs and doing
4 * interesting things in the secondary space mode.
5 *
6 * Copyright IBM Corp. 2006,2014
7 * Author(s): Martin Schwidefsky (schwidefsky@de.ibm.com),
8 * Gerald Schaefer (gerald.schaefer@de.ibm.com)
9 */
10
11#include <linux/jump_label.h>
12#include <linux/uaccess.h>
13#include <linux/export.h>
14#include <linux/errno.h>
15#include <linux/mm.h>
16#include <asm/mmu_context.h>
17#include <asm/facility.h>
18
19#ifndef CONFIG_HAVE_MARCH_Z10_FEATURES
20static DEFINE_STATIC_KEY_FALSE(have_mvcos);
21
22static int __init uaccess_init(void)
23{
24 if (test_facility(27))
25 static_branch_enable(&have_mvcos);
26 return 0;
27}
28early_initcall(uaccess_init);
29
30static inline int copy_with_mvcos(void)
31{
32 if (static_branch_likely(&have_mvcos))
33 return 1;
34 return 0;
35}
36#else
37static inline int copy_with_mvcos(void)
38{
39 return 1;
40}
41#endif
42
43void set_fs(mm_segment_t fs)
44{
45 current->thread.mm_segment = fs;
46 if (fs == USER_DS) {
47 __ctl_load(S390_lowcore.user_asce, 1, 1);
48 clear_cpu_flag(CIF_ASCE_PRIMARY);
49 } else {
50 __ctl_load(S390_lowcore.kernel_asce, 1, 1);
51 set_cpu_flag(CIF_ASCE_PRIMARY);
52 }
53 if (fs & 1) {
54 if (fs == USER_DS_SACF)
55 __ctl_load(S390_lowcore.user_asce, 7, 7);
56 else
57 __ctl_load(S390_lowcore.kernel_asce, 7, 7);
58 set_cpu_flag(CIF_ASCE_SECONDARY);
59 }
60}
61EXPORT_SYMBOL(set_fs);
62
63mm_segment_t enable_sacf_uaccess(void)
64{
65 mm_segment_t old_fs;
66 unsigned long asce, cr;
67
68 old_fs = current->thread.mm_segment;
69 if (old_fs & 1)
70 return old_fs;
71 current->thread.mm_segment |= 1;
72 asce = S390_lowcore.kernel_asce;
73 if (likely(old_fs == USER_DS)) {
74 __ctl_store(cr, 1, 1);
75 if (cr != S390_lowcore.kernel_asce) {
76 __ctl_load(S390_lowcore.kernel_asce, 1, 1);
77 set_cpu_flag(CIF_ASCE_PRIMARY);
78 }
79 asce = S390_lowcore.user_asce;
80 }
81 __ctl_store(cr, 7, 7);
82 if (cr != asce) {
83 __ctl_load(asce, 7, 7);
84 set_cpu_flag(CIF_ASCE_SECONDARY);
85 }
86 return old_fs;
87}
88EXPORT_SYMBOL(enable_sacf_uaccess);
89
90void disable_sacf_uaccess(mm_segment_t old_fs)
91{
92 current->thread.mm_segment = old_fs;
93 if (old_fs == USER_DS && test_facility(27)) {
94 __ctl_load(S390_lowcore.user_asce, 1, 1);
95 clear_cpu_flag(CIF_ASCE_PRIMARY);
96 }
97}
98EXPORT_SYMBOL(disable_sacf_uaccess);
99
100static inline unsigned long copy_from_user_mvcos(void *x, const void __user *ptr,
101 unsigned long size)
102{
103 register unsigned long reg0 asm("0") = 0x01UL;
104 unsigned long tmp1, tmp2;
105
106 tmp1 = -4096UL;
107 asm volatile(
108 "0: .insn ss,0xc80000000000,0(%0,%2),0(%1),0\n"
109 "6: jz 4f\n"
110 "1: algr %0,%3\n"
111 " slgr %1,%3\n"
112 " slgr %2,%3\n"
113 " j 0b\n"
114 "2: la %4,4095(%1)\n"/* %4 = ptr + 4095 */
115 " nr %4,%3\n" /* %4 = (ptr + 4095) & -4096 */
116 " slgr %4,%1\n"
117 " clgr %0,%4\n" /* copy crosses next page boundary? */
118 " jnh 5f\n"
119 "3: .insn ss,0xc80000000000,0(%4,%2),0(%1),0\n"
120 "7: slgr %0,%4\n"
121 " j 5f\n"
122 "4: slgr %0,%0\n"
123 "5:\n"
124 EX_TABLE(0b,2b) EX_TABLE(3b,5b) EX_TABLE(6b,2b) EX_TABLE(7b,5b)
125 : "+a" (size), "+a" (ptr), "+a" (x), "+a" (tmp1), "=a" (tmp2)
126 : "d" (reg0) : "cc", "memory");
127 return size;
128}
129
130static inline unsigned long copy_from_user_mvcp(void *x, const void __user *ptr,
131 unsigned long size)
132{
133 unsigned long tmp1, tmp2;
134 mm_segment_t old_fs;
135
136 old_fs = enable_sacf_uaccess();
137 tmp1 = -256UL;
138 asm volatile(
139 " sacf 0\n"
140 "0: mvcp 0(%0,%2),0(%1),%3\n"
141 "7: jz 5f\n"
142 "1: algr %0,%3\n"
143 " la %1,256(%1)\n"
144 " la %2,256(%2)\n"
145 "2: mvcp 0(%0,%2),0(%1),%3\n"
146 "8: jnz 1b\n"
147 " j 5f\n"
148 "3: la %4,255(%1)\n" /* %4 = ptr + 255 */
149 " lghi %3,-4096\n"
150 " nr %4,%3\n" /* %4 = (ptr + 255) & -4096 */
151 " slgr %4,%1\n"
152 " clgr %0,%4\n" /* copy crosses next page boundary? */
153 " jnh 6f\n"
154 "4: mvcp 0(%4,%2),0(%1),%3\n"
155 "9: slgr %0,%4\n"
156 " j 6f\n"
157 "5: slgr %0,%0\n"
158 "6: sacf 768\n"
159 EX_TABLE(0b,3b) EX_TABLE(2b,3b) EX_TABLE(4b,6b)
160 EX_TABLE(7b,3b) EX_TABLE(8b,3b) EX_TABLE(9b,6b)
161 : "+a" (size), "+a" (ptr), "+a" (x), "+a" (tmp1), "=a" (tmp2)
162 : : "cc", "memory");
163 disable_sacf_uaccess(old_fs);
164 return size;
165}
166
167unsigned long raw_copy_from_user(void *to, const void __user *from, unsigned long n)
168{
169 if (copy_with_mvcos())
170 return copy_from_user_mvcos(to, from, n);
171 return copy_from_user_mvcp(to, from, n);
172}
173EXPORT_SYMBOL(raw_copy_from_user);
174
175static inline unsigned long copy_to_user_mvcos(void __user *ptr, const void *x,
176 unsigned long size)
177{
178 register unsigned long reg0 asm("0") = 0x010000UL;
179 unsigned long tmp1, tmp2;
180
181 tmp1 = -4096UL;
182 asm volatile(
183 "0: .insn ss,0xc80000000000,0(%0,%1),0(%2),0\n"
184 "6: jz 4f\n"
185 "1: algr %0,%3\n"
186 " slgr %1,%3\n"
187 " slgr %2,%3\n"
188 " j 0b\n"
189 "2: la %4,4095(%1)\n"/* %4 = ptr + 4095 */
190 " nr %4,%3\n" /* %4 = (ptr + 4095) & -4096 */
191 " slgr %4,%1\n"
192 " clgr %0,%4\n" /* copy crosses next page boundary? */
193 " jnh 5f\n"
194 "3: .insn ss,0xc80000000000,0(%4,%1),0(%2),0\n"
195 "7: slgr %0,%4\n"
196 " j 5f\n"
197 "4: slgr %0,%0\n"
198 "5:\n"
199 EX_TABLE(0b,2b) EX_TABLE(3b,5b) EX_TABLE(6b,2b) EX_TABLE(7b,5b)
200 : "+a" (size), "+a" (ptr), "+a" (x), "+a" (tmp1), "=a" (tmp2)
201 : "d" (reg0) : "cc", "memory");
202 return size;
203}
204
205static inline unsigned long copy_to_user_mvcs(void __user *ptr, const void *x,
206 unsigned long size)
207{
208 unsigned long tmp1, tmp2;
209 mm_segment_t old_fs;
210
211 old_fs = enable_sacf_uaccess();
212 tmp1 = -256UL;
213 asm volatile(
214 " sacf 0\n"
215 "0: mvcs 0(%0,%1),0(%2),%3\n"
216 "7: jz 5f\n"
217 "1: algr %0,%3\n"
218 " la %1,256(%1)\n"
219 " la %2,256(%2)\n"
220 "2: mvcs 0(%0,%1),0(%2),%3\n"
221 "8: jnz 1b\n"
222 " j 5f\n"
223 "3: la %4,255(%1)\n" /* %4 = ptr + 255 */
224 " lghi %3,-4096\n"
225 " nr %4,%3\n" /* %4 = (ptr + 255) & -4096 */
226 " slgr %4,%1\n"
227 " clgr %0,%4\n" /* copy crosses next page boundary? */
228 " jnh 6f\n"
229 "4: mvcs 0(%4,%1),0(%2),%3\n"
230 "9: slgr %0,%4\n"
231 " j 6f\n"
232 "5: slgr %0,%0\n"
233 "6: sacf 768\n"
234 EX_TABLE(0b,3b) EX_TABLE(2b,3b) EX_TABLE(4b,6b)
235 EX_TABLE(7b,3b) EX_TABLE(8b,3b) EX_TABLE(9b,6b)
236 : "+a" (size), "+a" (ptr), "+a" (x), "+a" (tmp1), "=a" (tmp2)
237 : : "cc", "memory");
238 disable_sacf_uaccess(old_fs);
239 return size;
240}
241
242unsigned long raw_copy_to_user(void __user *to, const void *from, unsigned long n)
243{
244 if (copy_with_mvcos())
245 return copy_to_user_mvcos(to, from, n);
246 return copy_to_user_mvcs(to, from, n);
247}
248EXPORT_SYMBOL(raw_copy_to_user);
249
250static inline unsigned long copy_in_user_mvcos(void __user *to, const void __user *from,
251 unsigned long size)
252{
253 register unsigned long reg0 asm("0") = 0x010001UL;
254 unsigned long tmp1, tmp2;
255
256 tmp1 = -4096UL;
257 /* FIXME: copy with reduced length. */
258 asm volatile(
259 "0: .insn ss,0xc80000000000,0(%0,%1),0(%2),0\n"
260 " jz 2f\n"
261 "1: algr %0,%3\n"
262 " slgr %1,%3\n"
263 " slgr %2,%3\n"
264 " j 0b\n"
265 "2:slgr %0,%0\n"
266 "3: \n"
267 EX_TABLE(0b,3b)
268 : "+a" (size), "+a" (to), "+a" (from), "+a" (tmp1), "=a" (tmp2)
269 : "d" (reg0) : "cc", "memory");
270 return size;
271}
272
273static inline unsigned long copy_in_user_mvc(void __user *to, const void __user *from,
274 unsigned long size)
275{
276 mm_segment_t old_fs;
277 unsigned long tmp1;
278
279 old_fs = enable_sacf_uaccess();
280 asm volatile(
281 " sacf 256\n"
282 " aghi %0,-1\n"
283 " jo 5f\n"
284 " bras %3,3f\n"
285 "0: aghi %0,257\n"
286 "1: mvc 0(1,%1),0(%2)\n"
287 " la %1,1(%1)\n"
288 " la %2,1(%2)\n"
289 " aghi %0,-1\n"
290 " jnz 1b\n"
291 " j 5f\n"
292 "2: mvc 0(256,%1),0(%2)\n"
293 " la %1,256(%1)\n"
294 " la %2,256(%2)\n"
295 "3: aghi %0,-256\n"
296 " jnm 2b\n"
297 "4: ex %0,1b-0b(%3)\n"
298 "5: slgr %0,%0\n"
299 "6: sacf 768\n"
300 EX_TABLE(1b,6b) EX_TABLE(2b,0b) EX_TABLE(4b,0b)
301 : "+a" (size), "+a" (to), "+a" (from), "=a" (tmp1)
302 : : "cc", "memory");
303 disable_sacf_uaccess(old_fs);
304 return size;
305}
306
307unsigned long raw_copy_in_user(void __user *to, const void __user *from, unsigned long n)
308{
309 if (copy_with_mvcos())
310 return copy_in_user_mvcos(to, from, n);
311 return copy_in_user_mvc(to, from, n);
312}
313EXPORT_SYMBOL(raw_copy_in_user);
314
315static inline unsigned long clear_user_mvcos(void __user *to, unsigned long size)
316{
317 register unsigned long reg0 asm("0") = 0x010000UL;
318 unsigned long tmp1, tmp2;
319
320 tmp1 = -4096UL;
321 asm volatile(
322 "0: .insn ss,0xc80000000000,0(%0,%1),0(%4),0\n"
323 " jz 4f\n"
324 "1: algr %0,%2\n"
325 " slgr %1,%2\n"
326 " j 0b\n"
327 "2: la %3,4095(%1)\n"/* %4 = to + 4095 */
328 " nr %3,%2\n" /* %4 = (to + 4095) & -4096 */
329 " slgr %3,%1\n"
330 " clgr %0,%3\n" /* copy crosses next page boundary? */
331 " jnh 5f\n"
332 "3: .insn ss,0xc80000000000,0(%3,%1),0(%4),0\n"
333 " slgr %0,%3\n"
334 " j 5f\n"
335 "4: slgr %0,%0\n"
336 "5:\n"
337 EX_TABLE(0b,2b) EX_TABLE(3b,5b)
338 : "+a" (size), "+a" (to), "+a" (tmp1), "=a" (tmp2)
339 : "a" (empty_zero_page), "d" (reg0) : "cc", "memory");
340 return size;
341}
342
343static inline unsigned long clear_user_xc(void __user *to, unsigned long size)
344{
345 mm_segment_t old_fs;
346 unsigned long tmp1, tmp2;
347
348 old_fs = enable_sacf_uaccess();
349 asm volatile(
350 " sacf 256\n"
351 " aghi %0,-1\n"
352 " jo 5f\n"
353 " bras %3,3f\n"
354 " xc 0(1,%1),0(%1)\n"
355 "0: aghi %0,257\n"
356 " la %2,255(%1)\n" /* %2 = ptr + 255 */
357 " srl %2,12\n"
358 " sll %2,12\n" /* %2 = (ptr + 255) & -4096 */
359 " slgr %2,%1\n"
360 " clgr %0,%2\n" /* clear crosses next page boundary? */
361 " jnh 5f\n"
362 " aghi %2,-1\n"
363 "1: ex %2,0(%3)\n"
364 " aghi %2,1\n"
365 " slgr %0,%2\n"
366 " j 5f\n"
367 "2: xc 0(256,%1),0(%1)\n"
368 " la %1,256(%1)\n"
369 "3: aghi %0,-256\n"
370 " jnm 2b\n"
371 "4: ex %0,0(%3)\n"
372 "5: slgr %0,%0\n"
373 "6: sacf 768\n"
374 EX_TABLE(1b,6b) EX_TABLE(2b,0b) EX_TABLE(4b,0b)
375 : "+a" (size), "+a" (to), "=a" (tmp1), "=a" (tmp2)
376 : : "cc", "memory");
377 disable_sacf_uaccess(old_fs);
378 return size;
379}
380
381unsigned long __clear_user(void __user *to, unsigned long size)
382{
383 if (copy_with_mvcos())
384 return clear_user_mvcos(to, size);
385 return clear_user_xc(to, size);
386}
387EXPORT_SYMBOL(__clear_user);
388
389static inline unsigned long strnlen_user_srst(const char __user *src,
390 unsigned long size)
391{
392 register unsigned long reg0 asm("0") = 0;
393 unsigned long tmp1, tmp2;
394
395 asm volatile(
396 " la %2,0(%1)\n"
397 " la %3,0(%0,%1)\n"
398 " slgr %0,%0\n"
399 " sacf 256\n"
400 "0: srst %3,%2\n"
401 " jo 0b\n"
402 " la %0,1(%3)\n" /* strnlen_user results includes \0 */
403 " slgr %0,%1\n"
404 "1: sacf 768\n"
405 EX_TABLE(0b,1b)
406 : "+a" (size), "+a" (src), "=a" (tmp1), "=a" (tmp2)
407 : "d" (reg0) : "cc", "memory");
408 return size;
409}
410
411unsigned long __strnlen_user(const char __user *src, unsigned long size)
412{
413 mm_segment_t old_fs;
414 unsigned long len;
415
416 if (unlikely(!size))
417 return 0;
418 old_fs = enable_sacf_uaccess();
419 len = strnlen_user_srst(src, size);
420 disable_sacf_uaccess(old_fs);
421 return len;
422}
423EXPORT_SYMBOL(__strnlen_user);
424
425long __strncpy_from_user(char *dst, const char __user *src, long size)
426{
427 size_t done, len, offset, len_str;
428
429 if (unlikely(size <= 0))
430 return 0;
431 done = 0;
432 do {
433 offset = (size_t)src & (L1_CACHE_BYTES - 1);
434 len = min(size - done, L1_CACHE_BYTES - offset);
435 if (copy_from_user(dst, src, len))
436 return -EFAULT;
437 len_str = strnlen(dst, len);
438 done += len_str;
439 src += len_str;
440 dst += len_str;
441 } while ((len_str == len) && (done < size));
442 return done;
443}
444EXPORT_SYMBOL(__strncpy_from_user);
1// SPDX-License-Identifier: GPL-2.0
2/*
3 * Standard user space access functions based on mvcp/mvcs and doing
4 * interesting things in the secondary space mode.
5 *
6 * Copyright IBM Corp. 2006,2014
7 * Author(s): Martin Schwidefsky (schwidefsky@de.ibm.com),
8 * Gerald Schaefer (gerald.schaefer@de.ibm.com)
9 */
10
11#include <linux/jump_label.h>
12#include <linux/uaccess.h>
13#include <linux/export.h>
14#include <linux/errno.h>
15#include <linux/mm.h>
16#include <asm/mmu_context.h>
17#include <asm/facility.h>
18
19#ifndef CONFIG_HAVE_MARCH_Z10_FEATURES
20static DEFINE_STATIC_KEY_FALSE(have_mvcos);
21
22static int __init uaccess_init(void)
23{
24 if (test_facility(27))
25 static_branch_enable(&have_mvcos);
26 return 0;
27}
28early_initcall(uaccess_init);
29
30static inline int copy_with_mvcos(void)
31{
32 if (static_branch_likely(&have_mvcos))
33 return 1;
34 return 0;
35}
36#else
37static inline int copy_with_mvcos(void)
38{
39 return 1;
40}
41#endif
42
43void set_fs(mm_segment_t fs)
44{
45 current->thread.mm_segment = fs;
46 if (fs == USER_DS) {
47 __ctl_load(S390_lowcore.user_asce, 1, 1);
48 clear_cpu_flag(CIF_ASCE_PRIMARY);
49 } else {
50 __ctl_load(S390_lowcore.kernel_asce, 1, 1);
51 set_cpu_flag(CIF_ASCE_PRIMARY);
52 }
53 if (fs & 1) {
54 if (fs == USER_DS_SACF)
55 __ctl_load(S390_lowcore.user_asce, 7, 7);
56 else
57 __ctl_load(S390_lowcore.kernel_asce, 7, 7);
58 set_cpu_flag(CIF_ASCE_SECONDARY);
59 }
60}
61EXPORT_SYMBOL(set_fs);
62
63mm_segment_t enable_sacf_uaccess(void)
64{
65 mm_segment_t old_fs;
66 unsigned long asce, cr;
67 unsigned long flags;
68
69 old_fs = current->thread.mm_segment;
70 if (old_fs & 1)
71 return old_fs;
72 /* protect against a concurrent page table upgrade */
73 local_irq_save(flags);
74 current->thread.mm_segment |= 1;
75 asce = S390_lowcore.kernel_asce;
76 if (likely(old_fs == USER_DS)) {
77 __ctl_store(cr, 1, 1);
78 if (cr != S390_lowcore.kernel_asce) {
79 __ctl_load(S390_lowcore.kernel_asce, 1, 1);
80 set_cpu_flag(CIF_ASCE_PRIMARY);
81 }
82 asce = S390_lowcore.user_asce;
83 }
84 __ctl_store(cr, 7, 7);
85 if (cr != asce) {
86 __ctl_load(asce, 7, 7);
87 set_cpu_flag(CIF_ASCE_SECONDARY);
88 }
89 local_irq_restore(flags);
90 return old_fs;
91}
92EXPORT_SYMBOL(enable_sacf_uaccess);
93
94void disable_sacf_uaccess(mm_segment_t old_fs)
95{
96 current->thread.mm_segment = old_fs;
97 if (old_fs == USER_DS && test_facility(27)) {
98 __ctl_load(S390_lowcore.user_asce, 1, 1);
99 clear_cpu_flag(CIF_ASCE_PRIMARY);
100 }
101}
102EXPORT_SYMBOL(disable_sacf_uaccess);
103
104static inline unsigned long copy_from_user_mvcos(void *x, const void __user *ptr,
105 unsigned long size)
106{
107 register unsigned long reg0 asm("0") = 0x01UL;
108 unsigned long tmp1, tmp2;
109
110 tmp1 = -4096UL;
111 asm volatile(
112 "0: .insn ss,0xc80000000000,0(%0,%2),0(%1),0\n"
113 "6: jz 4f\n"
114 "1: algr %0,%3\n"
115 " slgr %1,%3\n"
116 " slgr %2,%3\n"
117 " j 0b\n"
118 "2: la %4,4095(%1)\n"/* %4 = ptr + 4095 */
119 " nr %4,%3\n" /* %4 = (ptr + 4095) & -4096 */
120 " slgr %4,%1\n"
121 " clgr %0,%4\n" /* copy crosses next page boundary? */
122 " jnh 5f\n"
123 "3: .insn ss,0xc80000000000,0(%4,%2),0(%1),0\n"
124 "7: slgr %0,%4\n"
125 " j 5f\n"
126 "4: slgr %0,%0\n"
127 "5:\n"
128 EX_TABLE(0b,2b) EX_TABLE(3b,5b) EX_TABLE(6b,2b) EX_TABLE(7b,5b)
129 : "+a" (size), "+a" (ptr), "+a" (x), "+a" (tmp1), "=a" (tmp2)
130 : "d" (reg0) : "cc", "memory");
131 return size;
132}
133
134static inline unsigned long copy_from_user_mvcp(void *x, const void __user *ptr,
135 unsigned long size)
136{
137 unsigned long tmp1, tmp2;
138 mm_segment_t old_fs;
139
140 old_fs = enable_sacf_uaccess();
141 tmp1 = -256UL;
142 asm volatile(
143 " sacf 0\n"
144 "0: mvcp 0(%0,%2),0(%1),%3\n"
145 "7: jz 5f\n"
146 "1: algr %0,%3\n"
147 " la %1,256(%1)\n"
148 " la %2,256(%2)\n"
149 "2: mvcp 0(%0,%2),0(%1),%3\n"
150 "8: jnz 1b\n"
151 " j 5f\n"
152 "3: la %4,255(%1)\n" /* %4 = ptr + 255 */
153 " lghi %3,-4096\n"
154 " nr %4,%3\n" /* %4 = (ptr + 255) & -4096 */
155 " slgr %4,%1\n"
156 " clgr %0,%4\n" /* copy crosses next page boundary? */
157 " jnh 6f\n"
158 "4: mvcp 0(%4,%2),0(%1),%3\n"
159 "9: slgr %0,%4\n"
160 " j 6f\n"
161 "5: slgr %0,%0\n"
162 "6: sacf 768\n"
163 EX_TABLE(0b,3b) EX_TABLE(2b,3b) EX_TABLE(4b,6b)
164 EX_TABLE(7b,3b) EX_TABLE(8b,3b) EX_TABLE(9b,6b)
165 : "+a" (size), "+a" (ptr), "+a" (x), "+a" (tmp1), "=a" (tmp2)
166 : : "cc", "memory");
167 disable_sacf_uaccess(old_fs);
168 return size;
169}
170
171unsigned long raw_copy_from_user(void *to, const void __user *from, unsigned long n)
172{
173 if (copy_with_mvcos())
174 return copy_from_user_mvcos(to, from, n);
175 return copy_from_user_mvcp(to, from, n);
176}
177EXPORT_SYMBOL(raw_copy_from_user);
178
179static inline unsigned long copy_to_user_mvcos(void __user *ptr, const void *x,
180 unsigned long size)
181{
182 register unsigned long reg0 asm("0") = 0x010000UL;
183 unsigned long tmp1, tmp2;
184
185 tmp1 = -4096UL;
186 asm volatile(
187 "0: .insn ss,0xc80000000000,0(%0,%1),0(%2),0\n"
188 "6: jz 4f\n"
189 "1: algr %0,%3\n"
190 " slgr %1,%3\n"
191 " slgr %2,%3\n"
192 " j 0b\n"
193 "2: la %4,4095(%1)\n"/* %4 = ptr + 4095 */
194 " nr %4,%3\n" /* %4 = (ptr + 4095) & -4096 */
195 " slgr %4,%1\n"
196 " clgr %0,%4\n" /* copy crosses next page boundary? */
197 " jnh 5f\n"
198 "3: .insn ss,0xc80000000000,0(%4,%1),0(%2),0\n"
199 "7: slgr %0,%4\n"
200 " j 5f\n"
201 "4: slgr %0,%0\n"
202 "5:\n"
203 EX_TABLE(0b,2b) EX_TABLE(3b,5b) EX_TABLE(6b,2b) EX_TABLE(7b,5b)
204 : "+a" (size), "+a" (ptr), "+a" (x), "+a" (tmp1), "=a" (tmp2)
205 : "d" (reg0) : "cc", "memory");
206 return size;
207}
208
209static inline unsigned long copy_to_user_mvcs(void __user *ptr, const void *x,
210 unsigned long size)
211{
212 unsigned long tmp1, tmp2;
213 mm_segment_t old_fs;
214
215 old_fs = enable_sacf_uaccess();
216 tmp1 = -256UL;
217 asm volatile(
218 " sacf 0\n"
219 "0: mvcs 0(%0,%1),0(%2),%3\n"
220 "7: jz 5f\n"
221 "1: algr %0,%3\n"
222 " la %1,256(%1)\n"
223 " la %2,256(%2)\n"
224 "2: mvcs 0(%0,%1),0(%2),%3\n"
225 "8: jnz 1b\n"
226 " j 5f\n"
227 "3: la %4,255(%1)\n" /* %4 = ptr + 255 */
228 " lghi %3,-4096\n"
229 " nr %4,%3\n" /* %4 = (ptr + 255) & -4096 */
230 " slgr %4,%1\n"
231 " clgr %0,%4\n" /* copy crosses next page boundary? */
232 " jnh 6f\n"
233 "4: mvcs 0(%4,%1),0(%2),%3\n"
234 "9: slgr %0,%4\n"
235 " j 6f\n"
236 "5: slgr %0,%0\n"
237 "6: sacf 768\n"
238 EX_TABLE(0b,3b) EX_TABLE(2b,3b) EX_TABLE(4b,6b)
239 EX_TABLE(7b,3b) EX_TABLE(8b,3b) EX_TABLE(9b,6b)
240 : "+a" (size), "+a" (ptr), "+a" (x), "+a" (tmp1), "=a" (tmp2)
241 : : "cc", "memory");
242 disable_sacf_uaccess(old_fs);
243 return size;
244}
245
246unsigned long raw_copy_to_user(void __user *to, const void *from, unsigned long n)
247{
248 if (copy_with_mvcos())
249 return copy_to_user_mvcos(to, from, n);
250 return copy_to_user_mvcs(to, from, n);
251}
252EXPORT_SYMBOL(raw_copy_to_user);
253
254static inline unsigned long copy_in_user_mvcos(void __user *to, const void __user *from,
255 unsigned long size)
256{
257 register unsigned long reg0 asm("0") = 0x010001UL;
258 unsigned long tmp1, tmp2;
259
260 tmp1 = -4096UL;
261 /* FIXME: copy with reduced length. */
262 asm volatile(
263 "0: .insn ss,0xc80000000000,0(%0,%1),0(%2),0\n"
264 " jz 2f\n"
265 "1: algr %0,%3\n"
266 " slgr %1,%3\n"
267 " slgr %2,%3\n"
268 " j 0b\n"
269 "2:slgr %0,%0\n"
270 "3: \n"
271 EX_TABLE(0b,3b)
272 : "+a" (size), "+a" (to), "+a" (from), "+a" (tmp1), "=a" (tmp2)
273 : "d" (reg0) : "cc", "memory");
274 return size;
275}
276
277static inline unsigned long copy_in_user_mvc(void __user *to, const void __user *from,
278 unsigned long size)
279{
280 mm_segment_t old_fs;
281 unsigned long tmp1;
282
283 old_fs = enable_sacf_uaccess();
284 asm volatile(
285 " sacf 256\n"
286 " aghi %0,-1\n"
287 " jo 5f\n"
288 " bras %3,3f\n"
289 "0: aghi %0,257\n"
290 "1: mvc 0(1,%1),0(%2)\n"
291 " la %1,1(%1)\n"
292 " la %2,1(%2)\n"
293 " aghi %0,-1\n"
294 " jnz 1b\n"
295 " j 5f\n"
296 "2: mvc 0(256,%1),0(%2)\n"
297 " la %1,256(%1)\n"
298 " la %2,256(%2)\n"
299 "3: aghi %0,-256\n"
300 " jnm 2b\n"
301 "4: ex %0,1b-0b(%3)\n"
302 "5: slgr %0,%0\n"
303 "6: sacf 768\n"
304 EX_TABLE(1b,6b) EX_TABLE(2b,0b) EX_TABLE(4b,0b)
305 : "+a" (size), "+a" (to), "+a" (from), "=a" (tmp1)
306 : : "cc", "memory");
307 disable_sacf_uaccess(old_fs);
308 return size;
309}
310
311unsigned long raw_copy_in_user(void __user *to, const void __user *from, unsigned long n)
312{
313 if (copy_with_mvcos())
314 return copy_in_user_mvcos(to, from, n);
315 return copy_in_user_mvc(to, from, n);
316}
317EXPORT_SYMBOL(raw_copy_in_user);
318
319static inline unsigned long clear_user_mvcos(void __user *to, unsigned long size)
320{
321 register unsigned long reg0 asm("0") = 0x010000UL;
322 unsigned long tmp1, tmp2;
323
324 tmp1 = -4096UL;
325 asm volatile(
326 "0: .insn ss,0xc80000000000,0(%0,%1),0(%4),0\n"
327 " jz 4f\n"
328 "1: algr %0,%2\n"
329 " slgr %1,%2\n"
330 " j 0b\n"
331 "2: la %3,4095(%1)\n"/* %4 = to + 4095 */
332 " nr %3,%2\n" /* %4 = (to + 4095) & -4096 */
333 " slgr %3,%1\n"
334 " clgr %0,%3\n" /* copy crosses next page boundary? */
335 " jnh 5f\n"
336 "3: .insn ss,0xc80000000000,0(%3,%1),0(%4),0\n"
337 " slgr %0,%3\n"
338 " j 5f\n"
339 "4: slgr %0,%0\n"
340 "5:\n"
341 EX_TABLE(0b,2b) EX_TABLE(3b,5b)
342 : "+a" (size), "+a" (to), "+a" (tmp1), "=a" (tmp2)
343 : "a" (empty_zero_page), "d" (reg0) : "cc", "memory");
344 return size;
345}
346
347static inline unsigned long clear_user_xc(void __user *to, unsigned long size)
348{
349 mm_segment_t old_fs;
350 unsigned long tmp1, tmp2;
351
352 old_fs = enable_sacf_uaccess();
353 asm volatile(
354 " sacf 256\n"
355 " aghi %0,-1\n"
356 " jo 5f\n"
357 " bras %3,3f\n"
358 " xc 0(1,%1),0(%1)\n"
359 "0: aghi %0,257\n"
360 " la %2,255(%1)\n" /* %2 = ptr + 255 */
361 " srl %2,12\n"
362 " sll %2,12\n" /* %2 = (ptr + 255) & -4096 */
363 " slgr %2,%1\n"
364 " clgr %0,%2\n" /* clear crosses next page boundary? */
365 " jnh 5f\n"
366 " aghi %2,-1\n"
367 "1: ex %2,0(%3)\n"
368 " aghi %2,1\n"
369 " slgr %0,%2\n"
370 " j 5f\n"
371 "2: xc 0(256,%1),0(%1)\n"
372 " la %1,256(%1)\n"
373 "3: aghi %0,-256\n"
374 " jnm 2b\n"
375 "4: ex %0,0(%3)\n"
376 "5: slgr %0,%0\n"
377 "6: sacf 768\n"
378 EX_TABLE(1b,6b) EX_TABLE(2b,0b) EX_TABLE(4b,0b)
379 : "+a" (size), "+a" (to), "=a" (tmp1), "=a" (tmp2)
380 : : "cc", "memory");
381 disable_sacf_uaccess(old_fs);
382 return size;
383}
384
385unsigned long __clear_user(void __user *to, unsigned long size)
386{
387 if (copy_with_mvcos())
388 return clear_user_mvcos(to, size);
389 return clear_user_xc(to, size);
390}
391EXPORT_SYMBOL(__clear_user);
392
393static inline unsigned long strnlen_user_srst(const char __user *src,
394 unsigned long size)
395{
396 register unsigned long reg0 asm("0") = 0;
397 unsigned long tmp1, tmp2;
398
399 asm volatile(
400 " la %2,0(%1)\n"
401 " la %3,0(%0,%1)\n"
402 " slgr %0,%0\n"
403 " sacf 256\n"
404 "0: srst %3,%2\n"
405 " jo 0b\n"
406 " la %0,1(%3)\n" /* strnlen_user results includes \0 */
407 " slgr %0,%1\n"
408 "1: sacf 768\n"
409 EX_TABLE(0b,1b)
410 : "+a" (size), "+a" (src), "=a" (tmp1), "=a" (tmp2)
411 : "d" (reg0) : "cc", "memory");
412 return size;
413}
414
415unsigned long __strnlen_user(const char __user *src, unsigned long size)
416{
417 mm_segment_t old_fs;
418 unsigned long len;
419
420 if (unlikely(!size))
421 return 0;
422 old_fs = enable_sacf_uaccess();
423 len = strnlen_user_srst(src, size);
424 disable_sacf_uaccess(old_fs);
425 return len;
426}
427EXPORT_SYMBOL(__strnlen_user);
428
429long __strncpy_from_user(char *dst, const char __user *src, long size)
430{
431 size_t done, len, offset, len_str;
432
433 if (unlikely(size <= 0))
434 return 0;
435 done = 0;
436 do {
437 offset = (size_t)src & (L1_CACHE_BYTES - 1);
438 len = min(size - done, L1_CACHE_BYTES - offset);
439 if (copy_from_user(dst, src, len))
440 return -EFAULT;
441 len_str = strnlen(dst, len);
442 done += len_str;
443 src += len_str;
444 dst += len_str;
445 } while ((len_str == len) && (done < size));
446 return done;
447}
448EXPORT_SYMBOL(__strncpy_from_user);