arch/arm/kernel/swp_emulate.c

   1 /*
   2  *  linux/arch/arm/kernel/swp_emulate.c
   3  *
   4  *  Copyright (C) 2009 ARM Limited
   5  *  __user_* functions adapted from include/asm/uaccess.h
   6  *
   7  * This program is free software; you can redistribute it and/or modify
   8  * it under the terms of the GNU General Public License version 2 as
   9  * published by the Free Software Foundation.
  10  *
  11  *  Implements emulation of the SWP/SWPB instructions using load-exclusive and
  12  *  store-exclusive for processors that have them disabled (or future ones that
  13  *  might not implement them).
  14  *
  15  *  Syntax of SWP{B} instruction: SWP{B}<c> <Rt>, <Rt2>, [<Rn>]
  16  *  Where: Rt  = destination
  17  *         Rt2 = source
  18  *         Rn  = address
  19  */
  20
  21 #include <linux/init.h>
  22 #include <linux/kernel.h>
  23 #include <linux/proc_fs.h>
  24 #include <linux/sched.h>
  25 #include <linux/syscalls.h>
  26 #include <linux/perf_event.h>
  27
  28 #include <asm/traps.h>
  29 #include <asm/uaccess.h>
  30
  31 /*
  32  * Error-checking SWP macros implemented using ldrex{b}/strex{b}
  33  */
  34 #define __user_swpX_asm(data, addr, res, temp, B)               \
  35         __asm__ __volatile__(                                   \
  36         "       mov             %2, %1\n"                       \
  37         "0:     ldrex"B"        %1, [%3]\n"                     \
  38         "1:     strex"B"        %0, %2, [%3]\n"                 \
  39         "       cmp             %0, #0\n"                       \
  40         "       movne           %0, %4\n"                       \
  41         "2:\n"                                                  \
  42         "       .section         .fixup,\"ax\"\n"               \
  43         "       .align          2\n"                            \
  44         "3:     mov             %0, %5\n"                       \
  45         "       b               2b\n"                           \
  46         "       .previous\n"                                    \
  47         "       .section         __ex_table,\"a\"\n"            \
  48         "       .align          3\n"                            \
  49         "       .long           0b, 3b\n"                       \
  50         "       .long           1b, 3b\n"                       \
  51         "       .previous"                                      \
  52         : "=&r" (res), "+r" (data), "=&r" (temp)                \
  53         : "r" (addr), "i" (-EAGAIN), "i" (-EFAULT)              \
  54         : "cc", "memory")
  55
  56 #define __user_swp_asm(data, addr, res, temp) \
  57         __user_swpX_asm(data, addr, res, temp, "")
  58 #define __user_swpb_asm(data, addr, res, temp) \
  59         __user_swpX_asm(data, addr, res, temp, "b")
  60
  61 /*
  62  * Macros/defines for extracting register numbers from instruction.
  63  */
  64 #define EXTRACT_REG_NUM(instruction, offset) \
  65         (((instruction) & (0xf << (offset))) >> (offset))
  66 #define RN_OFFSET  16
  67 #define RT_OFFSET  12
  68 #define RT2_OFFSET  0
  69 /*
  70  * Bit 22 of the instruction encoding distinguishes between
  71  * the SWP and SWPB variants (bit set means SWPB).
  72  */
  73 #define TYPE_SWPB (1 << 22)
  74
  75 static unsigned long swpcounter;
  76 static unsigned long swpbcounter;
  77 static unsigned long abtcounter;
  78 static pid_t         previous_pid;
  79
  80 #ifdef CONFIG_PROC_FS
  81 static int proc_read_status(char *page, char **start, off_t off, int count,
  82                             int *eof, void *data)
  83 {
  84         char *p = page;
  85         int len;
  86
  87         p += sprintf(p, "Emulated SWP:\t\t%lu\n", swpcounter);
  88         p += sprintf(p, "Emulated SWPB:\t\t%lu\n", swpbcounter);
  89         p += sprintf(p, "Aborted SWP{B}:\t\t%lu\n", abtcounter);
  90         if (previous_pid != 0)
  91                 p += sprintf(p, "Last process:\t\t%d\n", previous_pid);
  92
  93         len = (p - page) - off;
  94         if (len < 0)
  95                 len = 0;
  96
  97         *eof = (len <= count) ? 1 : 0;
  98         *start = page + off;
  99
 100         return len;
 101 }
 102 #endif
 103
 104 /*
 105  * Set up process info to signal segmentation fault - called on access error.
 106  */
 107 static void set_segfault(struct pt_regs *regs, unsigned long addr)
 108 {
 109         siginfo_t info;
 110
 111         down_read(&current->mm->mmap_sem);
 112         if (find_vma(current->mm, addr) == NULL)
 113                 info.si_code = SEGV_MAPERR;
 114         else
 115                 info.si_code = SEGV_ACCERR;
 116         up_read(&current->mm->mmap_sem);
 117
 118         info.si_signo = SIGSEGV;
 119         info.si_errno = 0;
 120         info.si_addr  = (void *) instruction_pointer(regs);
 121
 122         pr_debug("SWP{B} emulation: access caused memory abort!\n");
 123         arm_notify_die("Illegal memory access", regs, &info, 0, 0);
 124
 125         abtcounter++;
 126 }
 127
 128 static int emulate_swpX(unsigned int address, unsigned int *data,
 129                         unsigned int type)
 130 {
 131         unsigned int res = 0;
 132
 133         if ((type != TYPE_SWPB) && (address & 0x3)) {
 134                 /* SWP to unaligned address not permitted */
 135                 pr_debug("SWP instruction on unaligned pointer!\n");
 136                 return -EFAULT;
 137         }
 138
 139         while (1) {
 140                 unsigned long temp;
 141
 142                 /*
 143                  * Barrier required between accessing protected resource and
 144                  * releasing a lock for it. Legacy code might not have done
 145                  * this, and we cannot determine that this is not the case
 146                  * being emulated, so insert always.
 147                  */
 148                 smp_mb();
 149
 150                 if (type == TYPE_SWPB)
 151                         __user_swpb_asm(*data, address, res, temp);
 152                 else
 153                         __user_swp_asm(*data, address, res, temp);
 154
 155                 if (likely(res != -EAGAIN) || signal_pending(current))
 156                         break;
 157
 158                 cond_resched();
 159         }
 160
 161         if (res == 0) {
 162                 /*
 163                  * Barrier also required between acquiring a lock for a
 164                  * protected resource and accessing the resource. Inserted for
 165                  * same reason as above.
 166                  */
 167                 smp_mb();
 168
 169                 if (type == TYPE_SWPB)
 170                         swpbcounter++;
 171                 else
 172                         swpcounter++;
 173         }
 174
 175         return res;
 176 }
 177
 178 /*
 179  * swp_handler logs the id of calling process, dissects the instruction, sanity
 180  * checks the memory location, calls emulate_swpX for the actual operation and
 181  * deals with fixup/error handling before returning
 182  */
 183 static int swp_handler(struct pt_regs *regs, unsigned int instr)
 184 {
 185         unsigned int address, destreg, data, type;
 186         unsigned int res = 0;
 187
 188         perf_sw_event(PERF_COUNT_SW_EMULATION_FAULTS, 1, regs, regs->ARM_pc);
 189
 190         if (current->pid != previous_pid) {
 191                 pr_debug("\"%s\" (%ld) uses deprecated SWP{B} instruction\n",
 192                          current->comm, (unsigned long)current->pid);
 193                 previous_pid = current->pid;
 194         }
 195
 196         address = regs->uregs[EXTRACT_REG_NUM(instr, RN_OFFSET)];
 197         data    = regs->uregs[EXTRACT_REG_NUM(instr, RT2_OFFSET)];
 198         destreg = EXTRACT_REG_NUM(instr, RT_OFFSET);
 199
 200         type = instr & TYPE_SWPB;
 201
 202         pr_debug("addr in r%d->0x%08x, dest is r%d, source in r%d->0x%08x)\n",
 203                  EXTRACT_REG_NUM(instr, RN_OFFSET), address,
 204                  destreg, EXTRACT_REG_NUM(instr, RT2_OFFSET), data);
 205
 206         /* Check access in reasonable access range for both SWP and SWPB */
 207         if (!access_ok(VERIFY_WRITE, (address & ~3), 4)) {
 208                 pr_debug("SWP{B} emulation: access to %p not allowed!\n",
 209                          (void *)address);
 210                 res = -EFAULT;
 211         } else {
 212                 res = emulate_swpX(address, &data, type);
 213         }
 214
 215         if (res == 0) {
 216                 /*
 217                  * On successful emulation, revert the adjustment to the PC
 218                  * made in kernel/traps.c in order to resume execution at the
 219                  * instruction following the SWP{B}.
 220                  */
 221                 regs->ARM_pc += 4;
 222                 regs->uregs[destreg] = data;
 223         } else if (res == -EFAULT) {
 224                 /*
 225                  * Memory errors do not mean emulation failed.
 226                  * Set up signal info to return SEGV, then return OK
 227                  */
 228                 set_segfault(regs, address);
 229         }
 230
 231         return 0;
 232 }
 233
 234 /*
 235  * Only emulate SWP/SWPB executed in ARM state/User mode.
 236  * The kernel must be SWP free and SWP{B} does not exist in Thumb/ThumbEE.
 237  */
 238 static struct undef_hook swp_hook = {
 239         .instr_mask = 0x0fb00ff0,
 240         .instr_val  = 0x01000090,
 241         .cpsr_mask  = MODE_MASK | PSR_T_BIT | PSR_J_BIT,
 242         .cpsr_val   = USR_MODE,
 243         .fn         = swp_handler
 244 };
 245
 246 /*
 247  * Register handler and create status file in /proc/cpu
 248  * Invoked as late_initcall, since not needed before init spawned.
 249  */
 250 static int __init swp_emulation_init(void)
 251 {
 252 #ifdef CONFIG_PROC_FS
 253         struct proc_dir_entry *res;
 254
 255         res = create_proc_entry("cpu/swp_emulation", S_IRUGO, NULL);
 256
 257         if (!res)
 258                 return -ENOMEM;
 259
 260         res->read_proc = proc_read_status;
 261 #endif /* CONFIG_PROC_FS */
 262
 263         printk(KERN_NOTICE "Registering SWP/SWPB emulation handler\n");
 264         register_undef_hook(&swp_hook);
 265
 266         return 0;
 267 }
 268
 269 late_initcall(swp_emulation_init);