1
2
3
4
5
6
7
8
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
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"
119 " nr %4,%3\n"
120 " slgr %4,%1\n"
121 " clgr %0,%4\n"
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"
153 " lghi %3,-4096\n"
154 " nr %4,%3\n"
155 " slgr %4,%1\n"
156 " clgr %0,%4\n"
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"
194 " nr %4,%3\n"
195 " slgr %4,%1\n"
196 " clgr %0,%4\n"
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"
228 " lghi %3,-4096\n"
229 " nr %4,%3\n"
230 " slgr %4,%1\n"
231 " clgr %0,%4\n"
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
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"
332 " nr %3,%2\n"
333 " slgr %3,%1\n"
334 " clgr %0,%3\n"
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"
361 " srl %2,12\n"
362 " sll %2,12\n"
363 " slgr %2,%1\n"
364 " clgr %0,%2\n"
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"
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);
449