1
2
3
4
5
6
7
8
9
10
11
12#include <linux/errno.h>
13#include <linux/mm.h>
14#include <linux/uaccess.h>
15#include <asm/futex.h>
16#include "uaccess.h"
17
18#ifndef __s390x__
19#define AHI "ahi"
20#define ALR "alr"
21#define CLR "clr"
22#define LHI "lhi"
23#define SLR "slr"
24#else
25#define AHI "aghi"
26#define ALR "algr"
27#define CLR "clgr"
28#define LHI "lghi"
29#define SLR "slgr"
30#endif
31
32size_t copy_from_user_std(size_t size, const void __user *ptr, void *x)
33{
34 unsigned long tmp1, tmp2;
35
36 tmp1 = -256UL;
37 asm volatile(
38 "0: mvcp 0(%0,%2),0(%1),%3\n"
39 "10:jz 8f\n"
40 "1:"ALR" %0,%3\n"
41 " la %1,256(%1)\n"
42 " la %2,256(%2)\n"
43 "2: mvcp 0(%0,%2),0(%1),%3\n"
44 "11:jnz 1b\n"
45 " j 8f\n"
46 "3: la %4,255(%1)\n"
47 " "LHI" %3,-4096\n"
48 " nr %4,%3\n"
49 " "SLR" %4,%1\n"
50 " "CLR" %0,%4\n"
51 " jnh 5f\n"
52 "4: mvcp 0(%4,%2),0(%1),%3\n"
53 "12:"SLR" %0,%4\n"
54 " "ALR" %2,%4\n"
55 "5:"LHI" %4,-1\n"
56 " "ALR" %4,%0\n"
57 " bras %3,7f\n"
58 " xc 0(1,%2),0(%2)\n"
59 "6: xc 0(256,%2),0(%2)\n"
60 " la %2,256(%2)\n"
61 "7:"AHI" %4,-256\n"
62 " jnm 6b\n"
63 " ex %4,0(%3)\n"
64 " j 9f\n"
65 "8:"SLR" %0,%0\n"
66 "9: \n"
67 EX_TABLE(0b,3b) EX_TABLE(2b,3b) EX_TABLE(4b,5b)
68 EX_TABLE(10b,3b) EX_TABLE(11b,3b) EX_TABLE(12b,5b)
69 : "+a" (size), "+a" (ptr), "+a" (x), "+a" (tmp1), "=a" (tmp2)
70 : : "cc", "memory");
71 return size;
72}
73
74static size_t copy_from_user_std_check(size_t size, const void __user *ptr,
75 void *x)
76{
77 if (size <= 1024)
78 return copy_from_user_std(size, ptr, x);
79 return copy_from_user_pt(size, ptr, x);
80}
81
82size_t copy_to_user_std(size_t size, void __user *ptr, const void *x)
83{
84 unsigned long tmp1, tmp2;
85
86 tmp1 = -256UL;
87 asm volatile(
88 "0: mvcs 0(%0,%1),0(%2),%3\n"
89 "7: jz 5f\n"
90 "1:"ALR" %0,%3\n"
91 " la %1,256(%1)\n"
92 " la %2,256(%2)\n"
93 "2: mvcs 0(%0,%1),0(%2),%3\n"
94 "8: jnz 1b\n"
95 " j 5f\n"
96 "3: la %4,255(%1)\n"
97 " "LHI" %3,-4096\n"
98 " nr %4,%3\n"
99 " "SLR" %4,%1\n"
100 " "CLR" %0,%4\n"
101 " jnh 6f\n"
102 "4: mvcs 0(%4,%1),0(%2),%3\n"
103 "9:"SLR" %0,%4\n"
104 " j 6f\n"
105 "5:"SLR" %0,%0\n"
106 "6: \n"
107 EX_TABLE(0b,3b) EX_TABLE(2b,3b) EX_TABLE(4b,6b)
108 EX_TABLE(7b,3b) EX_TABLE(8b,3b) EX_TABLE(9b,6b)
109 : "+a" (size), "+a" (ptr), "+a" (x), "+a" (tmp1), "=a" (tmp2)
110 : : "cc", "memory");
111 return size;
112}
113
114static size_t copy_to_user_std_check(size_t size, void __user *ptr,
115 const void *x)
116{
117 if (size <= 1024)
118 return copy_to_user_std(size, ptr, x);
119 return copy_to_user_pt(size, ptr, x);
120}
121
122static size_t copy_in_user_std(size_t size, void __user *to,
123 const void __user *from)
124{
125 unsigned long tmp1;
126
127 asm volatile(
128 " "AHI" %0,-1\n"
129 " jo 5f\n"
130 " sacf 256\n"
131 " bras %3,3f\n"
132 "0:"AHI" %0,257\n"
133 "1: mvc 0(1,%1),0(%2)\n"
134 " la %1,1(%1)\n"
135 " la %2,1(%2)\n"
136 " "AHI" %0,-1\n"
137 " jnz 1b\n"
138 " j 5f\n"
139 "2: mvc 0(256,%1),0(%2)\n"
140 " la %1,256(%1)\n"
141 " la %2,256(%2)\n"
142 "3:"AHI" %0,-256\n"
143 " jnm 2b\n"
144 "4: ex %0,1b-0b(%3)\n"
145 " sacf 0\n"
146 "5: "SLR" %0,%0\n"
147 "6:\n"
148 EX_TABLE(1b,6b) EX_TABLE(2b,0b) EX_TABLE(4b,0b)
149 : "+a" (size), "+a" (to), "+a" (from), "=a" (tmp1)
150 : : "cc", "memory");
151 return size;
152}
153
154static size_t clear_user_std(size_t size, void __user *to)
155{
156 unsigned long tmp1, tmp2;
157
158 asm volatile(
159 " "AHI" %0,-1\n"
160 " jo 5f\n"
161 " sacf 256\n"
162 " bras %3,3f\n"
163 " xc 0(1,%1),0(%1)\n"
164 "0:"AHI" %0,257\n"
165 " la %2,255(%1)\n"
166 " srl %2,12\n"
167 " sll %2,12\n"
168 " "SLR" %2,%1\n"
169 " "CLR" %0,%2\n"
170 " jnh 5f\n"
171 " "AHI" %2,-1\n"
172 "1: ex %2,0(%3)\n"
173 " "AHI" %2,1\n"
174 " "SLR" %0,%2\n"
175 " j 5f\n"
176 "2: xc 0(256,%1),0(%1)\n"
177 " la %1,256(%1)\n"
178 "3:"AHI" %0,-256\n"
179 " jnm 2b\n"
180 "4: ex %0,0(%3)\n"
181 " sacf 0\n"
182 "5: "SLR" %0,%0\n"
183 "6:\n"
184 EX_TABLE(1b,6b) EX_TABLE(2b,0b) EX_TABLE(4b,0b)
185 : "+a" (size), "+a" (to), "=a" (tmp1), "=a" (tmp2)
186 : : "cc", "memory");
187 return size;
188}
189
190size_t strnlen_user_std(size_t size, const char __user *src)
191{
192 register unsigned long reg0 asm("0") = 0UL;
193 unsigned long tmp1, tmp2;
194
195 asm volatile(
196 " la %2,0(%1)\n"
197 " la %3,0(%0,%1)\n"
198 " "SLR" %0,%0\n"
199 " sacf 256\n"
200 "0: srst %3,%2\n"
201 " jo 0b\n"
202 " la %0,1(%3)\n"
203 " "SLR" %0,%1\n"
204 "1: sacf 0\n"
205 EX_TABLE(0b,1b)
206 : "+a" (size), "+a" (src), "=a" (tmp1), "=a" (tmp2)
207 : "d" (reg0) : "cc", "memory");
208 return size;
209}
210
211size_t strncpy_from_user_std(size_t size, const char __user *src, char *dst)
212{
213 register unsigned long reg0 asm("0") = 0UL;
214 unsigned long tmp1, tmp2;
215
216 asm volatile(
217 " la %3,0(%1)\n"
218 " la %4,0(%0,%1)\n"
219 " sacf 256\n"
220 "0: srst %4,%3\n"
221 " jo 0b\n"
222 " sacf 0\n"
223 " la %0,0(%4)\n"
224 " jh 1f\n"
225 " "AHI" %4,1\n"
226 "1:"SLR" %0,%1\n"
227 " "SLR" %4,%1\n"
228 "2: mvcp 0(%4,%2),0(%1),%5\n"
229 " jz 9f\n"
230 "3:"AHI" %4,-256\n"
231 " la %1,256(%1)\n"
232 " la %2,256(%2)\n"
233 "4: mvcp 0(%4,%2),0(%1),%5\n"
234 " jnz 3b\n"
235 " j 9f\n"
236 "7: sacf 0\n"
237 "8:"LHI" %0,%6\n"
238 "9:\n"
239 EX_TABLE(0b,7b) EX_TABLE(2b,8b) EX_TABLE(4b,8b)
240 : "+a" (size), "+a" (src), "+d" (dst), "=a" (tmp1), "=a" (tmp2)
241 : "d" (reg0), "K" (-EFAULT) : "cc", "memory");
242 return size;
243}
244
245#define __futex_atomic_op(insn, ret, oldval, newval, uaddr, oparg) \
246 asm volatile( \
247 " sacf 256\n" \
248 "0: l %1,0(%6)\n" \
249 "1:"insn \
250 "2: cs %1,%2,0(%6)\n" \
251 "3: jl 1b\n" \
252 " lhi %0,0\n" \
253 "4: sacf 0\n" \
254 EX_TABLE(0b,4b) EX_TABLE(2b,4b) EX_TABLE(3b,4b) \
255 : "=d" (ret), "=&d" (oldval), "=&d" (newval), \
256 "=m" (*uaddr) \
257 : "0" (-EFAULT), "d" (oparg), "a" (uaddr), \
258 "m" (*uaddr) : "cc");
259
260int futex_atomic_op_std(int op, int __user *uaddr, int oparg, int *old)
261{
262 int oldval = 0, newval, ret;
263
264 switch (op) {
265 case FUTEX_OP_SET:
266 __futex_atomic_op("lr %2,%5\n",
267 ret, oldval, newval, uaddr, oparg);
268 break;
269 case FUTEX_OP_ADD:
270 __futex_atomic_op("lr %2,%1\nar %2,%5\n",
271 ret, oldval, newval, uaddr, oparg);
272 break;
273 case FUTEX_OP_OR:
274 __futex_atomic_op("lr %2,%1\nor %2,%5\n",
275 ret, oldval, newval, uaddr, oparg);
276 break;
277 case FUTEX_OP_ANDN:
278 __futex_atomic_op("lr %2,%1\nnr %2,%5\n",
279 ret, oldval, newval, uaddr, oparg);
280 break;
281 case FUTEX_OP_XOR:
282 __futex_atomic_op("lr %2,%1\nxr %2,%5\n",
283 ret, oldval, newval, uaddr, oparg);
284 break;
285 default:
286 ret = -ENOSYS;
287 }
288 *old = oldval;
289 return ret;
290}
291
292int futex_atomic_cmpxchg_std(int __user *uaddr, int oldval, int newval)
293{
294 int ret;
295
296 asm volatile(
297 " sacf 256\n"
298 "0: cs %1,%4,0(%5)\n"
299 "1: lr %0,%1\n"
300 "2: sacf 0\n"
301 EX_TABLE(0b,2b) EX_TABLE(1b,2b)
302 : "=d" (ret), "+d" (oldval), "=m" (*uaddr)
303 : "0" (-EFAULT), "d" (newval), "a" (uaddr), "m" (*uaddr)
304 : "cc", "memory" );
305 return ret;
306}
307
308struct uaccess_ops uaccess_std = {
309 .copy_from_user = copy_from_user_std_check,
310 .copy_from_user_small = copy_from_user_std,
311 .copy_to_user = copy_to_user_std_check,
312 .copy_to_user_small = copy_to_user_std,
313 .copy_in_user = copy_in_user_std,
314 .clear_user = clear_user_std,
315 .strnlen_user = strnlen_user_std,
316 .strncpy_from_user = strncpy_from_user_std,
317 .futex_atomic_op = futex_atomic_op_std,
318 .futex_atomic_cmpxchg = futex_atomic_cmpxchg_std,
319};
320
