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);