1a5f4374aSIngo Molnar /* 2a5f4374aSIngo Molnar * User-space Probes (UProbes) 3a5f4374aSIngo Molnar * 4a5f4374aSIngo Molnar * This program is free software; you can redistribute it and/or modify 5a5f4374aSIngo Molnar * it under the terms of the GNU General Public License as published by 6a5f4374aSIngo Molnar * the Free Software Foundation; either version 2 of the License, or 7a5f4374aSIngo Molnar * (at your option) any later version. 8a5f4374aSIngo Molnar * 9a5f4374aSIngo Molnar * This program is distributed in the hope that it will be useful, 10a5f4374aSIngo Molnar * but WITHOUT ANY WARRANTY; without even the implied warranty of 11a5f4374aSIngo Molnar * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the 12a5f4374aSIngo Molnar * GNU General Public License for more details. 13a5f4374aSIngo Molnar * 14a5f4374aSIngo Molnar * You should have received a copy of the GNU General Public License 15a5f4374aSIngo Molnar * along with this program; if not, write to the Free Software 16a5f4374aSIngo Molnar * Foundation, Inc., 59 Temple Place - Suite 330, Boston, MA 02111-1307, USA. 17a5f4374aSIngo Molnar * 1835aa621bSIngo Molnar * Copyright (C) IBM Corporation, 2008-2012 19a5f4374aSIngo Molnar * Authors: 20a5f4374aSIngo Molnar * Srikar Dronamraju 21a5f4374aSIngo Molnar * Jim Keniston 2235aa621bSIngo Molnar * Copyright (C) 2011-2012 Red Hat, Inc., Peter Zijlstra <pzijlstr@redhat.com> 23a5f4374aSIngo Molnar */ 24a5f4374aSIngo Molnar 25a5f4374aSIngo Molnar #include <linux/kernel.h> 26a5f4374aSIngo Molnar #include <linux/highmem.h> 27a5f4374aSIngo Molnar #include <linux/pagemap.h> /* read_mapping_page */ 28a5f4374aSIngo Molnar #include <linux/slab.h> 29a5f4374aSIngo Molnar #include <linux/sched.h> 30e8440c14SJosh Stone #include <linux/export.h> 31a5f4374aSIngo Molnar #include <linux/rmap.h> /* anon_vma_prepare */ 32a5f4374aSIngo Molnar #include <linux/mmu_notifier.h> /* set_pte_at_notify */ 33a5f4374aSIngo Molnar #include <linux/swap.h> /* try_to_free_swap */ 340326f5a9SSrikar Dronamraju #include <linux/ptrace.h> /* user_enable_single_step */ 350326f5a9SSrikar Dronamraju #include <linux/kdebug.h> /* notifier mechanism */ 36194f8dcbSOleg Nesterov #include "../../mm/internal.h" /* munlock_vma_page */ 3732cdba1eSOleg Nesterov #include <linux/percpu-rwsem.h> 38a5f4374aSIngo Molnar 39a5f4374aSIngo Molnar #include <linux/uprobes.h> 40a5f4374aSIngo Molnar 41d4b3b638SSrikar Dronamraju #define UINSNS_PER_PAGE (PAGE_SIZE/UPROBE_XOL_SLOT_BYTES) 42d4b3b638SSrikar Dronamraju #define MAX_UPROBE_XOL_SLOTS UINSNS_PER_PAGE 43d4b3b638SSrikar Dronamraju 44a5f4374aSIngo Molnar static struct rb_root uprobes_tree = RB_ROOT; 45441f1eb7SOleg Nesterov /* 46441f1eb7SOleg Nesterov * allows us to skip the uprobe_mmap if there are no uprobe events active 47441f1eb7SOleg Nesterov * at this time. Probably a fine grained per inode count is better? 48441f1eb7SOleg Nesterov */ 49441f1eb7SOleg Nesterov #define no_uprobe_events() RB_EMPTY_ROOT(&uprobes_tree) 50a5f4374aSIngo Molnar 51a5f4374aSIngo Molnar static DEFINE_SPINLOCK(uprobes_treelock); /* serialize rbtree access */ 52a5f4374aSIngo Molnar 53a5f4374aSIngo Molnar #define UPROBES_HASH_SZ 13 54a5f4374aSIngo Molnar /* serialize uprobe->pending_list */ 55a5f4374aSIngo Molnar static struct mutex uprobes_mmap_mutex[UPROBES_HASH_SZ]; 56a5f4374aSIngo Molnar #define uprobes_mmap_hash(v) (&uprobes_mmap_mutex[((unsigned long)(v)) % UPROBES_HASH_SZ]) 57a5f4374aSIngo Molnar 5832cdba1eSOleg Nesterov static struct percpu_rw_semaphore dup_mmap_sem; 5932cdba1eSOleg Nesterov 60cb9a19feSOleg Nesterov /* Have a copy of original instruction */ 6171434f2fSOleg Nesterov #define UPROBE_COPY_INSN 0 62cb9a19feSOleg Nesterov /* Can skip singlestep */ 63bb929284SOleg Nesterov #define UPROBE_SKIP_SSTEP 1 64cb9a19feSOleg Nesterov 653ff54efdSSrikar Dronamraju struct uprobe { 663ff54efdSSrikar Dronamraju struct rb_node rb_node; /* node in the rb tree */ 673ff54efdSSrikar Dronamraju atomic_t ref; 68e591c8d7SOleg Nesterov struct rw_semaphore register_rwsem; 693ff54efdSSrikar Dronamraju struct rw_semaphore consumer_rwsem; 703ff54efdSSrikar Dronamraju struct list_head pending_list; 713ff54efdSSrikar Dronamraju struct uprobe_consumer *consumers; 723ff54efdSSrikar Dronamraju struct inode *inode; /* Also hold a ref to inode */ 733ff54efdSSrikar Dronamraju loff_t offset; 7471434f2fSOleg Nesterov unsigned long flags; 753ff54efdSSrikar Dronamraju struct arch_uprobe arch; 763ff54efdSSrikar Dronamraju }; 773ff54efdSSrikar Dronamraju 78a5f4374aSIngo Molnar /* 79a5f4374aSIngo Molnar * valid_vma: Verify if the specified vma is an executable vma 80a5f4374aSIngo Molnar * Relax restrictions while unregistering: vm_flags might have 81a5f4374aSIngo Molnar * changed after breakpoint was inserted. 82a5f4374aSIngo Molnar * - is_register: indicates if we are in register context. 83a5f4374aSIngo Molnar * - Return 1 if the specified virtual address is in an 84a5f4374aSIngo Molnar * executable vma. 85a5f4374aSIngo Molnar */ 86a5f4374aSIngo Molnar static bool valid_vma(struct vm_area_struct *vma, bool is_register) 87a5f4374aSIngo Molnar { 88e40cfce6SOleg Nesterov vm_flags_t flags = VM_HUGETLB | VM_MAYEXEC | VM_SHARED; 89a5f4374aSIngo Molnar 90e40cfce6SOleg Nesterov if (is_register) 91e40cfce6SOleg Nesterov flags |= VM_WRITE; 92a5f4374aSIngo Molnar 93e40cfce6SOleg Nesterov return vma->vm_file && (vma->vm_flags & flags) == VM_MAYEXEC; 94a5f4374aSIngo Molnar } 95a5f4374aSIngo Molnar 9657683f72SOleg Nesterov static unsigned long offset_to_vaddr(struct vm_area_struct *vma, loff_t offset) 97a5f4374aSIngo Molnar { 9857683f72SOleg Nesterov return vma->vm_start + offset - ((loff_t)vma->vm_pgoff << PAGE_SHIFT); 99a5f4374aSIngo Molnar } 100a5f4374aSIngo Molnar 101cb113b47SOleg Nesterov static loff_t vaddr_to_offset(struct vm_area_struct *vma, unsigned long vaddr) 102cb113b47SOleg Nesterov { 103cb113b47SOleg Nesterov return ((loff_t)vma->vm_pgoff << PAGE_SHIFT) + (vaddr - vma->vm_start); 104cb113b47SOleg Nesterov } 105cb113b47SOleg Nesterov 106a5f4374aSIngo Molnar /** 107a5f4374aSIngo Molnar * __replace_page - replace page in vma by new page. 108a5f4374aSIngo Molnar * based on replace_page in mm/ksm.c 109a5f4374aSIngo Molnar * 110a5f4374aSIngo Molnar * @vma: vma that holds the pte pointing to page 111c517ee74SOleg Nesterov * @addr: address the old @page is mapped at 112a5f4374aSIngo Molnar * @page: the cowed page we are replacing by kpage 113a5f4374aSIngo Molnar * @kpage: the modified page we replace page by 114a5f4374aSIngo Molnar * 115a5f4374aSIngo Molnar * Returns 0 on success, -EFAULT on failure. 116a5f4374aSIngo Molnar */ 117c517ee74SOleg Nesterov static int __replace_page(struct vm_area_struct *vma, unsigned long addr, 118c517ee74SOleg Nesterov struct page *page, struct page *kpage) 119a5f4374aSIngo Molnar { 120a5f4374aSIngo Molnar struct mm_struct *mm = vma->vm_mm; 1215323ce71SOleg Nesterov spinlock_t *ptl; 1225323ce71SOleg Nesterov pte_t *ptep; 1239f92448cSOleg Nesterov int err; 1246bdb913fSHaggai Eran /* For mmu_notifiers */ 1256bdb913fSHaggai Eran const unsigned long mmun_start = addr; 1266bdb913fSHaggai Eran const unsigned long mmun_end = addr + PAGE_SIZE; 127a5f4374aSIngo Molnar 128194f8dcbSOleg Nesterov /* For try_to_free_swap() and munlock_vma_page() below */ 1299f92448cSOleg Nesterov lock_page(page); 1309f92448cSOleg Nesterov 1316bdb913fSHaggai Eran mmu_notifier_invalidate_range_start(mm, mmun_start, mmun_end); 1329f92448cSOleg Nesterov err = -EAGAIN; 1335323ce71SOleg Nesterov ptep = page_check_address(page, mm, addr, &ptl, 0); 134a5f4374aSIngo Molnar if (!ptep) 1359f92448cSOleg Nesterov goto unlock; 136a5f4374aSIngo Molnar 137a5f4374aSIngo Molnar get_page(kpage); 138a5f4374aSIngo Molnar page_add_new_anon_rmap(kpage, vma, addr); 139a5f4374aSIngo Molnar 1407396fa81SSrikar Dronamraju if (!PageAnon(page)) { 1417396fa81SSrikar Dronamraju dec_mm_counter(mm, MM_FILEPAGES); 1427396fa81SSrikar Dronamraju inc_mm_counter(mm, MM_ANONPAGES); 1437396fa81SSrikar Dronamraju } 1447396fa81SSrikar Dronamraju 145a5f4374aSIngo Molnar flush_cache_page(vma, addr, pte_pfn(*ptep)); 146a5f4374aSIngo Molnar ptep_clear_flush(vma, addr, ptep); 147a5f4374aSIngo Molnar set_pte_at_notify(mm, addr, ptep, mk_pte(kpage, vma->vm_page_prot)); 148a5f4374aSIngo Molnar 149a5f4374aSIngo Molnar page_remove_rmap(page); 150a5f4374aSIngo Molnar if (!page_mapped(page)) 151a5f4374aSIngo Molnar try_to_free_swap(page); 152a5f4374aSIngo Molnar pte_unmap_unlock(ptep, ptl); 153a5f4374aSIngo Molnar 154194f8dcbSOleg Nesterov if (vma->vm_flags & VM_LOCKED) 155194f8dcbSOleg Nesterov munlock_vma_page(page); 156194f8dcbSOleg Nesterov put_page(page); 157194f8dcbSOleg Nesterov 1589f92448cSOleg Nesterov err = 0; 1599f92448cSOleg Nesterov unlock: 1606bdb913fSHaggai Eran mmu_notifier_invalidate_range_end(mm, mmun_start, mmun_end); 1619f92448cSOleg Nesterov unlock_page(page); 1629f92448cSOleg Nesterov return err; 163a5f4374aSIngo Molnar } 164a5f4374aSIngo Molnar 165a5f4374aSIngo Molnar /** 1665cb4ac3aSSrikar Dronamraju * is_swbp_insn - check if instruction is breakpoint instruction. 167a5f4374aSIngo Molnar * @insn: instruction to be checked. 1685cb4ac3aSSrikar Dronamraju * Default implementation of is_swbp_insn 169a5f4374aSIngo Molnar * Returns true if @insn is a breakpoint instruction. 170a5f4374aSIngo Molnar */ 1715cb4ac3aSSrikar Dronamraju bool __weak is_swbp_insn(uprobe_opcode_t *insn) 172a5f4374aSIngo Molnar { 1735cb4ac3aSSrikar Dronamraju return *insn == UPROBE_SWBP_INSN; 174a5f4374aSIngo Molnar } 175a5f4374aSIngo Molnar 1760908ad6eSAnanth N Mavinakayanahalli /** 1770908ad6eSAnanth N Mavinakayanahalli * is_trap_insn - check if instruction is breakpoint instruction. 1780908ad6eSAnanth N Mavinakayanahalli * @insn: instruction to be checked. 1790908ad6eSAnanth N Mavinakayanahalli * Default implementation of is_trap_insn 1800908ad6eSAnanth N Mavinakayanahalli * Returns true if @insn is a breakpoint instruction. 1810908ad6eSAnanth N Mavinakayanahalli * 1820908ad6eSAnanth N Mavinakayanahalli * This function is needed for the case where an architecture has multiple 1830908ad6eSAnanth N Mavinakayanahalli * trap instructions (like powerpc). 1840908ad6eSAnanth N Mavinakayanahalli */ 1850908ad6eSAnanth N Mavinakayanahalli bool __weak is_trap_insn(uprobe_opcode_t *insn) 1860908ad6eSAnanth N Mavinakayanahalli { 1870908ad6eSAnanth N Mavinakayanahalli return is_swbp_insn(insn); 1880908ad6eSAnanth N Mavinakayanahalli } 1890908ad6eSAnanth N Mavinakayanahalli 190ab0d805cSOleg Nesterov static void copy_from_page(struct page *page, unsigned long vaddr, void *dst, int len) 191cceb55aaSOleg Nesterov { 192cceb55aaSOleg Nesterov void *kaddr = kmap_atomic(page); 193ab0d805cSOleg Nesterov memcpy(dst, kaddr + (vaddr & ~PAGE_MASK), len); 194cceb55aaSOleg Nesterov kunmap_atomic(kaddr); 195cceb55aaSOleg Nesterov } 196cceb55aaSOleg Nesterov 197ed6f6a50SOleg Nesterov static int verify_opcode(struct page *page, unsigned long vaddr, uprobe_opcode_t *new_opcode) 198ed6f6a50SOleg Nesterov { 199ed6f6a50SOleg Nesterov uprobe_opcode_t old_opcode; 200ed6f6a50SOleg Nesterov bool is_swbp; 201ed6f6a50SOleg Nesterov 2020908ad6eSAnanth N Mavinakayanahalli /* 2030908ad6eSAnanth N Mavinakayanahalli * Note: We only check if the old_opcode is UPROBE_SWBP_INSN here. 2040908ad6eSAnanth N Mavinakayanahalli * We do not check if it is any other 'trap variant' which could 2050908ad6eSAnanth N Mavinakayanahalli * be conditional trap instruction such as the one powerpc supports. 2060908ad6eSAnanth N Mavinakayanahalli * 2070908ad6eSAnanth N Mavinakayanahalli * The logic is that we do not care if the underlying instruction 2080908ad6eSAnanth N Mavinakayanahalli * is a trap variant; uprobes always wins over any other (gdb) 2090908ad6eSAnanth N Mavinakayanahalli * breakpoint. 2100908ad6eSAnanth N Mavinakayanahalli */ 211ab0d805cSOleg Nesterov copy_from_page(page, vaddr, &old_opcode, UPROBE_SWBP_INSN_SIZE); 212ed6f6a50SOleg Nesterov is_swbp = is_swbp_insn(&old_opcode); 213ed6f6a50SOleg Nesterov 214ed6f6a50SOleg Nesterov if (is_swbp_insn(new_opcode)) { 215ed6f6a50SOleg Nesterov if (is_swbp) /* register: already installed? */ 216ed6f6a50SOleg Nesterov return 0; 217ed6f6a50SOleg Nesterov } else { 218ed6f6a50SOleg Nesterov if (!is_swbp) /* unregister: was it changed by us? */ 219076a365bSOleg Nesterov return 0; 220ed6f6a50SOleg Nesterov } 221ed6f6a50SOleg Nesterov 222ed6f6a50SOleg Nesterov return 1; 223ed6f6a50SOleg Nesterov } 224ed6f6a50SOleg Nesterov 225a5f4374aSIngo Molnar /* 226a5f4374aSIngo Molnar * NOTE: 227a5f4374aSIngo Molnar * Expect the breakpoint instruction to be the smallest size instruction for 228a5f4374aSIngo Molnar * the architecture. If an arch has variable length instruction and the 229a5f4374aSIngo Molnar * breakpoint instruction is not of the smallest length instruction 2300908ad6eSAnanth N Mavinakayanahalli * supported by that architecture then we need to modify is_trap_at_addr and 231a5f4374aSIngo Molnar * write_opcode accordingly. This would never be a problem for archs that 232a5f4374aSIngo Molnar * have fixed length instructions. 233a5f4374aSIngo Molnar */ 234a5f4374aSIngo Molnar 235a5f4374aSIngo Molnar /* 236a5f4374aSIngo Molnar * write_opcode - write the opcode at a given virtual address. 237a5f4374aSIngo Molnar * @mm: the probed process address space. 238a5f4374aSIngo Molnar * @vaddr: the virtual address to store the opcode. 239a5f4374aSIngo Molnar * @opcode: opcode to be written at @vaddr. 240a5f4374aSIngo Molnar * 241a5f4374aSIngo Molnar * Called with mm->mmap_sem held (for read and with a reference to 242a5f4374aSIngo Molnar * mm). 243a5f4374aSIngo Molnar * 244a5f4374aSIngo Molnar * For mm @mm, write the opcode at @vaddr. 245a5f4374aSIngo Molnar * Return 0 (success) or a negative errno. 246a5f4374aSIngo Molnar */ 247cceb55aaSOleg Nesterov static int write_opcode(struct mm_struct *mm, unsigned long vaddr, 248cceb55aaSOleg Nesterov uprobe_opcode_t opcode) 249a5f4374aSIngo Molnar { 250a5f4374aSIngo Molnar struct page *old_page, *new_page; 251a5f4374aSIngo Molnar void *vaddr_old, *vaddr_new; 252a5f4374aSIngo Molnar struct vm_area_struct *vma; 253a5f4374aSIngo Molnar int ret; 254f403072cSOleg Nesterov 2555323ce71SOleg Nesterov retry: 256a5f4374aSIngo Molnar /* Read the page with vaddr into memory */ 25775ed82eaSOleg Nesterov ret = get_user_pages(NULL, mm, vaddr, 1, 0, 1, &old_page, &vma); 258a5f4374aSIngo Molnar if (ret <= 0) 259a5f4374aSIngo Molnar return ret; 260a5f4374aSIngo Molnar 261ed6f6a50SOleg Nesterov ret = verify_opcode(old_page, vaddr, &opcode); 262ed6f6a50SOleg Nesterov if (ret <= 0) 263ed6f6a50SOleg Nesterov goto put_old; 264ed6f6a50SOleg Nesterov 265a5f4374aSIngo Molnar ret = -ENOMEM; 266a5f4374aSIngo Molnar new_page = alloc_page_vma(GFP_HIGHUSER_MOVABLE, vma, vaddr); 267a5f4374aSIngo Molnar if (!new_page) 2689f92448cSOleg Nesterov goto put_old; 269a5f4374aSIngo Molnar 270a5f4374aSIngo Molnar __SetPageUptodate(new_page); 271a5f4374aSIngo Molnar 272a5f4374aSIngo Molnar /* copy the page now that we've got it stable */ 273a5f4374aSIngo Molnar vaddr_old = kmap_atomic(old_page); 274a5f4374aSIngo Molnar vaddr_new = kmap_atomic(new_page); 275a5f4374aSIngo Molnar 276a5f4374aSIngo Molnar memcpy(vaddr_new, vaddr_old, PAGE_SIZE); 277d9c4a30eSOleg Nesterov memcpy(vaddr_new + (vaddr & ~PAGE_MASK), &opcode, UPROBE_SWBP_INSN_SIZE); 278a5f4374aSIngo Molnar 279a5f4374aSIngo Molnar kunmap_atomic(vaddr_new); 280a5f4374aSIngo Molnar kunmap_atomic(vaddr_old); 281a5f4374aSIngo Molnar 282a5f4374aSIngo Molnar ret = anon_vma_prepare(vma); 283a5f4374aSIngo Molnar if (ret) 2849f92448cSOleg Nesterov goto put_new; 285a5f4374aSIngo Molnar 286c517ee74SOleg Nesterov ret = __replace_page(vma, vaddr, old_page, new_page); 287a5f4374aSIngo Molnar 2889f92448cSOleg Nesterov put_new: 289a5f4374aSIngo Molnar page_cache_release(new_page); 2909f92448cSOleg Nesterov put_old: 291a5f4374aSIngo Molnar put_page(old_page); 292a5f4374aSIngo Molnar 2935323ce71SOleg Nesterov if (unlikely(ret == -EAGAIN)) 2945323ce71SOleg Nesterov goto retry; 295a5f4374aSIngo Molnar return ret; 296a5f4374aSIngo Molnar } 297a5f4374aSIngo Molnar 298a5f4374aSIngo Molnar /** 2995cb4ac3aSSrikar Dronamraju * set_swbp - store breakpoint at a given address. 300e3343e6aSSrikar Dronamraju * @auprobe: arch specific probepoint information. 301a5f4374aSIngo Molnar * @mm: the probed process address space. 302a5f4374aSIngo Molnar * @vaddr: the virtual address to insert the opcode. 303a5f4374aSIngo Molnar * 304a5f4374aSIngo Molnar * For mm @mm, store the breakpoint instruction at @vaddr. 305a5f4374aSIngo Molnar * Return 0 (success) or a negative errno. 306a5f4374aSIngo Molnar */ 3075cb4ac3aSSrikar Dronamraju int __weak set_swbp(struct arch_uprobe *auprobe, struct mm_struct *mm, unsigned long vaddr) 308a5f4374aSIngo Molnar { 309cceb55aaSOleg Nesterov return write_opcode(mm, vaddr, UPROBE_SWBP_INSN); 310a5f4374aSIngo Molnar } 311a5f4374aSIngo Molnar 312a5f4374aSIngo Molnar /** 313a5f4374aSIngo Molnar * set_orig_insn - Restore the original instruction. 314a5f4374aSIngo Molnar * @mm: the probed process address space. 315e3343e6aSSrikar Dronamraju * @auprobe: arch specific probepoint information. 316a5f4374aSIngo Molnar * @vaddr: the virtual address to insert the opcode. 317a5f4374aSIngo Molnar * 318a5f4374aSIngo Molnar * For mm @mm, restore the original opcode (opcode) at @vaddr. 319a5f4374aSIngo Molnar * Return 0 (success) or a negative errno. 320a5f4374aSIngo Molnar */ 321a5f4374aSIngo Molnar int __weak 322ded86e7cSOleg Nesterov set_orig_insn(struct arch_uprobe *auprobe, struct mm_struct *mm, unsigned long vaddr) 323a5f4374aSIngo Molnar { 324cceb55aaSOleg Nesterov return write_opcode(mm, vaddr, *(uprobe_opcode_t *)auprobe->insn); 325a5f4374aSIngo Molnar } 326a5f4374aSIngo Molnar 327a5f4374aSIngo Molnar static int match_uprobe(struct uprobe *l, struct uprobe *r) 328a5f4374aSIngo Molnar { 329a5f4374aSIngo Molnar if (l->inode < r->inode) 330a5f4374aSIngo Molnar return -1; 331a5f4374aSIngo Molnar 332a5f4374aSIngo Molnar if (l->inode > r->inode) 333a5f4374aSIngo Molnar return 1; 334a5f4374aSIngo Molnar 335a5f4374aSIngo Molnar if (l->offset < r->offset) 336a5f4374aSIngo Molnar return -1; 337a5f4374aSIngo Molnar 338a5f4374aSIngo Molnar if (l->offset > r->offset) 339a5f4374aSIngo Molnar return 1; 340a5f4374aSIngo Molnar 341a5f4374aSIngo Molnar return 0; 342a5f4374aSIngo Molnar } 343a5f4374aSIngo Molnar 344a5f4374aSIngo Molnar static struct uprobe *__find_uprobe(struct inode *inode, loff_t offset) 345a5f4374aSIngo Molnar { 346a5f4374aSIngo Molnar struct uprobe u = { .inode = inode, .offset = offset }; 347a5f4374aSIngo Molnar struct rb_node *n = uprobes_tree.rb_node; 348a5f4374aSIngo Molnar struct uprobe *uprobe; 349a5f4374aSIngo Molnar int match; 350a5f4374aSIngo Molnar 351a5f4374aSIngo Molnar while (n) { 352a5f4374aSIngo Molnar uprobe = rb_entry(n, struct uprobe, rb_node); 353a5f4374aSIngo Molnar match = match_uprobe(&u, uprobe); 354a5f4374aSIngo Molnar if (!match) { 355a5f4374aSIngo Molnar atomic_inc(&uprobe->ref); 356a5f4374aSIngo Molnar return uprobe; 357a5f4374aSIngo Molnar } 358a5f4374aSIngo Molnar 359a5f4374aSIngo Molnar if (match < 0) 360a5f4374aSIngo Molnar n = n->rb_left; 361a5f4374aSIngo Molnar else 362a5f4374aSIngo Molnar n = n->rb_right; 363a5f4374aSIngo Molnar } 364a5f4374aSIngo Molnar return NULL; 365a5f4374aSIngo Molnar } 366a5f4374aSIngo Molnar 367a5f4374aSIngo Molnar /* 368a5f4374aSIngo Molnar * Find a uprobe corresponding to a given inode:offset 369a5f4374aSIngo Molnar * Acquires uprobes_treelock 370a5f4374aSIngo Molnar */ 371a5f4374aSIngo Molnar static struct uprobe *find_uprobe(struct inode *inode, loff_t offset) 372a5f4374aSIngo Molnar { 373a5f4374aSIngo Molnar struct uprobe *uprobe; 374a5f4374aSIngo Molnar 3756f47caa0SOleg Nesterov spin_lock(&uprobes_treelock); 376a5f4374aSIngo Molnar uprobe = __find_uprobe(inode, offset); 3776f47caa0SOleg Nesterov spin_unlock(&uprobes_treelock); 378a5f4374aSIngo Molnar 379a5f4374aSIngo Molnar return uprobe; 380a5f4374aSIngo Molnar } 381a5f4374aSIngo Molnar 382a5f4374aSIngo Molnar static struct uprobe *__insert_uprobe(struct uprobe *uprobe) 383a5f4374aSIngo Molnar { 384a5f4374aSIngo Molnar struct rb_node **p = &uprobes_tree.rb_node; 385a5f4374aSIngo Molnar struct rb_node *parent = NULL; 386a5f4374aSIngo Molnar struct uprobe *u; 387a5f4374aSIngo Molnar int match; 388a5f4374aSIngo Molnar 389a5f4374aSIngo Molnar while (*p) { 390a5f4374aSIngo Molnar parent = *p; 391a5f4374aSIngo Molnar u = rb_entry(parent, struct uprobe, rb_node); 392a5f4374aSIngo Molnar match = match_uprobe(uprobe, u); 393a5f4374aSIngo Molnar if (!match) { 394a5f4374aSIngo Molnar atomic_inc(&u->ref); 395a5f4374aSIngo Molnar return u; 396a5f4374aSIngo Molnar } 397a5f4374aSIngo Molnar 398a5f4374aSIngo Molnar if (match < 0) 399a5f4374aSIngo Molnar p = &parent->rb_left; 400a5f4374aSIngo Molnar else 401a5f4374aSIngo Molnar p = &parent->rb_right; 402a5f4374aSIngo Molnar 403a5f4374aSIngo Molnar } 404a5f4374aSIngo Molnar 405a5f4374aSIngo Molnar u = NULL; 406a5f4374aSIngo Molnar rb_link_node(&uprobe->rb_node, parent, p); 407a5f4374aSIngo Molnar rb_insert_color(&uprobe->rb_node, &uprobes_tree); 408a5f4374aSIngo Molnar /* get access + creation ref */ 409a5f4374aSIngo Molnar atomic_set(&uprobe->ref, 2); 410a5f4374aSIngo Molnar 411a5f4374aSIngo Molnar return u; 412a5f4374aSIngo Molnar } 413a5f4374aSIngo Molnar 414a5f4374aSIngo Molnar /* 415a5f4374aSIngo Molnar * Acquire uprobes_treelock. 416a5f4374aSIngo Molnar * Matching uprobe already exists in rbtree; 417a5f4374aSIngo Molnar * increment (access refcount) and return the matching uprobe. 418a5f4374aSIngo Molnar * 419a5f4374aSIngo Molnar * No matching uprobe; insert the uprobe in rb_tree; 420a5f4374aSIngo Molnar * get a double refcount (access + creation) and return NULL. 421a5f4374aSIngo Molnar */ 422a5f4374aSIngo Molnar static struct uprobe *insert_uprobe(struct uprobe *uprobe) 423a5f4374aSIngo Molnar { 424a5f4374aSIngo Molnar struct uprobe *u; 425a5f4374aSIngo Molnar 4266f47caa0SOleg Nesterov spin_lock(&uprobes_treelock); 427a5f4374aSIngo Molnar u = __insert_uprobe(uprobe); 4286f47caa0SOleg Nesterov spin_unlock(&uprobes_treelock); 429a5f4374aSIngo Molnar 430a5f4374aSIngo Molnar return u; 431a5f4374aSIngo Molnar } 432a5f4374aSIngo Molnar 433a5f4374aSIngo Molnar static void put_uprobe(struct uprobe *uprobe) 434a5f4374aSIngo Molnar { 435a5f4374aSIngo Molnar if (atomic_dec_and_test(&uprobe->ref)) 436a5f4374aSIngo Molnar kfree(uprobe); 437a5f4374aSIngo Molnar } 438a5f4374aSIngo Molnar 439a5f4374aSIngo Molnar static struct uprobe *alloc_uprobe(struct inode *inode, loff_t offset) 440a5f4374aSIngo Molnar { 441a5f4374aSIngo Molnar struct uprobe *uprobe, *cur_uprobe; 442a5f4374aSIngo Molnar 443a5f4374aSIngo Molnar uprobe = kzalloc(sizeof(struct uprobe), GFP_KERNEL); 444a5f4374aSIngo Molnar if (!uprobe) 445a5f4374aSIngo Molnar return NULL; 446a5f4374aSIngo Molnar 447a5f4374aSIngo Molnar uprobe->inode = igrab(inode); 448a5f4374aSIngo Molnar uprobe->offset = offset; 449e591c8d7SOleg Nesterov init_rwsem(&uprobe->register_rwsem); 450a5f4374aSIngo Molnar init_rwsem(&uprobe->consumer_rwsem); 451bbc33d05SOleg Nesterov /* For now assume that the instruction need not be single-stepped */ 452bbc33d05SOleg Nesterov __set_bit(UPROBE_SKIP_SSTEP, &uprobe->flags); 453a5f4374aSIngo Molnar 454a5f4374aSIngo Molnar /* add to uprobes_tree, sorted on inode:offset */ 455a5f4374aSIngo Molnar cur_uprobe = insert_uprobe(uprobe); 456a5f4374aSIngo Molnar 457a5f4374aSIngo Molnar /* a uprobe exists for this inode:offset combination */ 458a5f4374aSIngo Molnar if (cur_uprobe) { 459a5f4374aSIngo Molnar kfree(uprobe); 460a5f4374aSIngo Molnar uprobe = cur_uprobe; 461a5f4374aSIngo Molnar iput(inode); 462a5f4374aSIngo Molnar } 463a5f4374aSIngo Molnar 464a5f4374aSIngo Molnar return uprobe; 465a5f4374aSIngo Molnar } 466a5f4374aSIngo Molnar 4679a98e03cSOleg Nesterov static void consumer_add(struct uprobe *uprobe, struct uprobe_consumer *uc) 468a5f4374aSIngo Molnar { 469a5f4374aSIngo Molnar down_write(&uprobe->consumer_rwsem); 470e3343e6aSSrikar Dronamraju uc->next = uprobe->consumers; 471e3343e6aSSrikar Dronamraju uprobe->consumers = uc; 472a5f4374aSIngo Molnar up_write(&uprobe->consumer_rwsem); 473a5f4374aSIngo Molnar } 474a5f4374aSIngo Molnar 475a5f4374aSIngo Molnar /* 476e3343e6aSSrikar Dronamraju * For uprobe @uprobe, delete the consumer @uc. 477e3343e6aSSrikar Dronamraju * Return true if the @uc is deleted successfully 478a5f4374aSIngo Molnar * or return false. 479a5f4374aSIngo Molnar */ 480e3343e6aSSrikar Dronamraju static bool consumer_del(struct uprobe *uprobe, struct uprobe_consumer *uc) 481a5f4374aSIngo Molnar { 482a5f4374aSIngo Molnar struct uprobe_consumer **con; 483a5f4374aSIngo Molnar bool ret = false; 484a5f4374aSIngo Molnar 485a5f4374aSIngo Molnar down_write(&uprobe->consumer_rwsem); 486a5f4374aSIngo Molnar for (con = &uprobe->consumers; *con; con = &(*con)->next) { 487e3343e6aSSrikar Dronamraju if (*con == uc) { 488e3343e6aSSrikar Dronamraju *con = uc->next; 489a5f4374aSIngo Molnar ret = true; 490a5f4374aSIngo Molnar break; 491a5f4374aSIngo Molnar } 492a5f4374aSIngo Molnar } 493a5f4374aSIngo Molnar up_write(&uprobe->consumer_rwsem); 494a5f4374aSIngo Molnar 495a5f4374aSIngo Molnar return ret; 496a5f4374aSIngo Molnar } 497a5f4374aSIngo Molnar 498e3343e6aSSrikar Dronamraju static int 499d436615eSOleg Nesterov __copy_insn(struct address_space *mapping, struct file *filp, char *insn, 500593609a5SOleg Nesterov unsigned long nbytes, loff_t offset) 501a5f4374aSIngo Molnar { 502a5f4374aSIngo Molnar struct page *page; 503a5f4374aSIngo Molnar 504a5f4374aSIngo Molnar if (!filp) 505a5f4374aSIngo Molnar return -EINVAL; 506a5f4374aSIngo Molnar 507cc359d18SOleg Nesterov if (!mapping->a_ops->readpage) 508cc359d18SOleg Nesterov return -EIO; 509a5f4374aSIngo Molnar /* 510a5f4374aSIngo Molnar * Ensure that the page that has the original instruction is 511a5f4374aSIngo Molnar * populated and in page-cache. 512a5f4374aSIngo Molnar */ 513*2edb7b55SOleg Nesterov page = read_mapping_page(mapping, offset >> PAGE_CACHE_SHIFT, filp); 514a5f4374aSIngo Molnar if (IS_ERR(page)) 515a5f4374aSIngo Molnar return PTR_ERR(page); 516a5f4374aSIngo Molnar 517*2edb7b55SOleg Nesterov copy_from_page(page, offset, insn, nbytes); 518a5f4374aSIngo Molnar page_cache_release(page); 519a5f4374aSIngo Molnar 520a5f4374aSIngo Molnar return 0; 521a5f4374aSIngo Molnar } 522a5f4374aSIngo Molnar 523d436615eSOleg Nesterov static int copy_insn(struct uprobe *uprobe, struct file *filp) 524a5f4374aSIngo Molnar { 525a5f4374aSIngo Molnar struct address_space *mapping; 526a5f4374aSIngo Molnar unsigned long nbytes; 527a5f4374aSIngo Molnar int bytes; 528a5f4374aSIngo Molnar 529d436615eSOleg Nesterov nbytes = PAGE_SIZE - (uprobe->offset & ~PAGE_MASK); 530a5f4374aSIngo Molnar mapping = uprobe->inode->i_mapping; 531a5f4374aSIngo Molnar 532a5f4374aSIngo Molnar /* Instruction at end of binary; copy only available bytes */ 533a5f4374aSIngo Molnar if (uprobe->offset + MAX_UINSN_BYTES > uprobe->inode->i_size) 534a5f4374aSIngo Molnar bytes = uprobe->inode->i_size - uprobe->offset; 535a5f4374aSIngo Molnar else 536a5f4374aSIngo Molnar bytes = MAX_UINSN_BYTES; 537a5f4374aSIngo Molnar 538a5f4374aSIngo Molnar /* Instruction at the page-boundary; copy bytes in second page */ 539a5f4374aSIngo Molnar if (nbytes < bytes) { 540fc36f595SOleg Nesterov int err = __copy_insn(mapping, filp, uprobe->arch.insn + nbytes, 541fc36f595SOleg Nesterov bytes - nbytes, uprobe->offset + nbytes); 542fc36f595SOleg Nesterov if (err) 543fc36f595SOleg Nesterov return err; 544a5f4374aSIngo Molnar bytes = nbytes; 545a5f4374aSIngo Molnar } 546d436615eSOleg Nesterov return __copy_insn(mapping, filp, uprobe->arch.insn, bytes, uprobe->offset); 547a5f4374aSIngo Molnar } 548a5f4374aSIngo Molnar 549cb9a19feSOleg Nesterov static int prepare_uprobe(struct uprobe *uprobe, struct file *file, 550cb9a19feSOleg Nesterov struct mm_struct *mm, unsigned long vaddr) 551cb9a19feSOleg Nesterov { 552cb9a19feSOleg Nesterov int ret = 0; 553cb9a19feSOleg Nesterov 55471434f2fSOleg Nesterov if (test_bit(UPROBE_COPY_INSN, &uprobe->flags)) 555cb9a19feSOleg Nesterov return ret; 556cb9a19feSOleg Nesterov 557d4d3ccc6SOleg Nesterov /* TODO: move this into _register, until then we abuse this sem. */ 558d4d3ccc6SOleg Nesterov down_write(&uprobe->consumer_rwsem); 55971434f2fSOleg Nesterov if (test_bit(UPROBE_COPY_INSN, &uprobe->flags)) 5604710f05fSOleg Nesterov goto out; 5614710f05fSOleg Nesterov 562cb9a19feSOleg Nesterov ret = copy_insn(uprobe, file); 563cb9a19feSOleg Nesterov if (ret) 564cb9a19feSOleg Nesterov goto out; 565cb9a19feSOleg Nesterov 566cb9a19feSOleg Nesterov ret = -ENOTSUPP; 5670908ad6eSAnanth N Mavinakayanahalli if (is_trap_insn((uprobe_opcode_t *)uprobe->arch.insn)) 568cb9a19feSOleg Nesterov goto out; 569cb9a19feSOleg Nesterov 570cb9a19feSOleg Nesterov ret = arch_uprobe_analyze_insn(&uprobe->arch, mm, vaddr); 571cb9a19feSOleg Nesterov if (ret) 572cb9a19feSOleg Nesterov goto out; 573cb9a19feSOleg Nesterov 574cb9a19feSOleg Nesterov /* write_opcode() assumes we don't cross page boundary */ 575cb9a19feSOleg Nesterov BUG_ON((uprobe->offset & ~PAGE_MASK) + 576cb9a19feSOleg Nesterov UPROBE_SWBP_INSN_SIZE > PAGE_SIZE); 577cb9a19feSOleg Nesterov 578cb9a19feSOleg Nesterov smp_wmb(); /* pairs with rmb() in find_active_uprobe() */ 57971434f2fSOleg Nesterov set_bit(UPROBE_COPY_INSN, &uprobe->flags); 580cb9a19feSOleg Nesterov 581cb9a19feSOleg Nesterov out: 582d4d3ccc6SOleg Nesterov up_write(&uprobe->consumer_rwsem); 5834710f05fSOleg Nesterov 584cb9a19feSOleg Nesterov return ret; 585cb9a19feSOleg Nesterov } 586cb9a19feSOleg Nesterov 5878a7f2fa0SOleg Nesterov static inline bool consumer_filter(struct uprobe_consumer *uc, 5888a7f2fa0SOleg Nesterov enum uprobe_filter_ctx ctx, struct mm_struct *mm) 589806a98bdSOleg Nesterov { 5908a7f2fa0SOleg Nesterov return !uc->filter || uc->filter(uc, ctx, mm); 591806a98bdSOleg Nesterov } 592806a98bdSOleg Nesterov 5938a7f2fa0SOleg Nesterov static bool filter_chain(struct uprobe *uprobe, 5948a7f2fa0SOleg Nesterov enum uprobe_filter_ctx ctx, struct mm_struct *mm) 59563633cbfSOleg Nesterov { 5961ff6fee5SOleg Nesterov struct uprobe_consumer *uc; 5971ff6fee5SOleg Nesterov bool ret = false; 5981ff6fee5SOleg Nesterov 5991ff6fee5SOleg Nesterov down_read(&uprobe->consumer_rwsem); 6001ff6fee5SOleg Nesterov for (uc = uprobe->consumers; uc; uc = uc->next) { 6018a7f2fa0SOleg Nesterov ret = consumer_filter(uc, ctx, mm); 6021ff6fee5SOleg Nesterov if (ret) 6031ff6fee5SOleg Nesterov break; 6041ff6fee5SOleg Nesterov } 6051ff6fee5SOleg Nesterov up_read(&uprobe->consumer_rwsem); 6061ff6fee5SOleg Nesterov 6071ff6fee5SOleg Nesterov return ret; 60863633cbfSOleg Nesterov } 60963633cbfSOleg Nesterov 610e3343e6aSSrikar Dronamraju static int 611e3343e6aSSrikar Dronamraju install_breakpoint(struct uprobe *uprobe, struct mm_struct *mm, 612816c03fbSOleg Nesterov struct vm_area_struct *vma, unsigned long vaddr) 613a5f4374aSIngo Molnar { 614f8ac4ec9SOleg Nesterov bool first_uprobe; 615a5f4374aSIngo Molnar int ret; 616a5f4374aSIngo Molnar 617cb9a19feSOleg Nesterov ret = prepare_uprobe(uprobe, vma->vm_file, mm, vaddr); 618a5f4374aSIngo Molnar if (ret) 619a5f4374aSIngo Molnar return ret; 620a5f4374aSIngo Molnar 621f8ac4ec9SOleg Nesterov /* 622f8ac4ec9SOleg Nesterov * set MMF_HAS_UPROBES in advance for uprobe_pre_sstep_notifier(), 623f8ac4ec9SOleg Nesterov * the task can hit this breakpoint right after __replace_page(). 624f8ac4ec9SOleg Nesterov */ 625f8ac4ec9SOleg Nesterov first_uprobe = !test_bit(MMF_HAS_UPROBES, &mm->flags); 626f8ac4ec9SOleg Nesterov if (first_uprobe) 627f8ac4ec9SOleg Nesterov set_bit(MMF_HAS_UPROBES, &mm->flags); 628f8ac4ec9SOleg Nesterov 629816c03fbSOleg Nesterov ret = set_swbp(&uprobe->arch, mm, vaddr); 6309f68f672SOleg Nesterov if (!ret) 6319f68f672SOleg Nesterov clear_bit(MMF_RECALC_UPROBES, &mm->flags); 6329f68f672SOleg Nesterov else if (first_uprobe) 633f8ac4ec9SOleg Nesterov clear_bit(MMF_HAS_UPROBES, &mm->flags); 634a5f4374aSIngo Molnar 635a5f4374aSIngo Molnar return ret; 636a5f4374aSIngo Molnar } 637a5f4374aSIngo Molnar 638076a365bSOleg Nesterov static int 639816c03fbSOleg Nesterov remove_breakpoint(struct uprobe *uprobe, struct mm_struct *mm, unsigned long vaddr) 640a5f4374aSIngo Molnar { 6419f68f672SOleg Nesterov set_bit(MMF_RECALC_UPROBES, &mm->flags); 642076a365bSOleg Nesterov return set_orig_insn(&uprobe->arch, mm, vaddr); 643a5f4374aSIngo Molnar } 644a5f4374aSIngo Molnar 64506b7bcd8SOleg Nesterov static inline bool uprobe_is_active(struct uprobe *uprobe) 64606b7bcd8SOleg Nesterov { 64706b7bcd8SOleg Nesterov return !RB_EMPTY_NODE(&uprobe->rb_node); 64806b7bcd8SOleg Nesterov } 6490326f5a9SSrikar Dronamraju /* 650778b032dSOleg Nesterov * There could be threads that have already hit the breakpoint. They 651778b032dSOleg Nesterov * will recheck the current insn and restart if find_uprobe() fails. 652778b032dSOleg Nesterov * See find_active_uprobe(). 6530326f5a9SSrikar Dronamraju */ 654a5f4374aSIngo Molnar static void delete_uprobe(struct uprobe *uprobe) 655a5f4374aSIngo Molnar { 65606b7bcd8SOleg Nesterov if (WARN_ON(!uprobe_is_active(uprobe))) 65706b7bcd8SOleg Nesterov return; 65806b7bcd8SOleg Nesterov 6596f47caa0SOleg Nesterov spin_lock(&uprobes_treelock); 660a5f4374aSIngo Molnar rb_erase(&uprobe->rb_node, &uprobes_tree); 6616f47caa0SOleg Nesterov spin_unlock(&uprobes_treelock); 66206b7bcd8SOleg Nesterov RB_CLEAR_NODE(&uprobe->rb_node); /* for uprobe_is_active() */ 663a5f4374aSIngo Molnar iput(uprobe->inode); 664a5f4374aSIngo Molnar put_uprobe(uprobe); 665a5f4374aSIngo Molnar } 666a5f4374aSIngo Molnar 66726872090SOleg Nesterov struct map_info { 66826872090SOleg Nesterov struct map_info *next; 66926872090SOleg Nesterov struct mm_struct *mm; 670816c03fbSOleg Nesterov unsigned long vaddr; 67126872090SOleg Nesterov }; 67226872090SOleg Nesterov 67326872090SOleg Nesterov static inline struct map_info *free_map_info(struct map_info *info) 674a5f4374aSIngo Molnar { 67526872090SOleg Nesterov struct map_info *next = info->next; 67626872090SOleg Nesterov kfree(info); 67726872090SOleg Nesterov return next; 67826872090SOleg Nesterov } 67926872090SOleg Nesterov 68026872090SOleg Nesterov static struct map_info * 68126872090SOleg Nesterov build_map_info(struct address_space *mapping, loff_t offset, bool is_register) 68226872090SOleg Nesterov { 68326872090SOleg Nesterov unsigned long pgoff = offset >> PAGE_SHIFT; 684a5f4374aSIngo Molnar struct vm_area_struct *vma; 68526872090SOleg Nesterov struct map_info *curr = NULL; 68626872090SOleg Nesterov struct map_info *prev = NULL; 68726872090SOleg Nesterov struct map_info *info; 68826872090SOleg Nesterov int more = 0; 689a5f4374aSIngo Molnar 69026872090SOleg Nesterov again: 69126872090SOleg Nesterov mutex_lock(&mapping->i_mmap_mutex); 6926b2dbba8SMichel Lespinasse vma_interval_tree_foreach(vma, &mapping->i_mmap, pgoff, pgoff) { 693a5f4374aSIngo Molnar if (!valid_vma(vma, is_register)) 694a5f4374aSIngo Molnar continue; 695a5f4374aSIngo Molnar 6967a5bfb66SOleg Nesterov if (!prev && !more) { 6977a5bfb66SOleg Nesterov /* 6987a5bfb66SOleg Nesterov * Needs GFP_NOWAIT to avoid i_mmap_mutex recursion through 6997a5bfb66SOleg Nesterov * reclaim. This is optimistic, no harm done if it fails. 7007a5bfb66SOleg Nesterov */ 7017a5bfb66SOleg Nesterov prev = kmalloc(sizeof(struct map_info), 7027a5bfb66SOleg Nesterov GFP_NOWAIT | __GFP_NOMEMALLOC | __GFP_NOWARN); 7037a5bfb66SOleg Nesterov if (prev) 7047a5bfb66SOleg Nesterov prev->next = NULL; 7057a5bfb66SOleg Nesterov } 70626872090SOleg Nesterov if (!prev) { 70726872090SOleg Nesterov more++; 70826872090SOleg Nesterov continue; 709a5f4374aSIngo Molnar } 710a5f4374aSIngo Molnar 71126872090SOleg Nesterov if (!atomic_inc_not_zero(&vma->vm_mm->mm_users)) 71226872090SOleg Nesterov continue; 713a5f4374aSIngo Molnar 71426872090SOleg Nesterov info = prev; 71526872090SOleg Nesterov prev = prev->next; 71626872090SOleg Nesterov info->next = curr; 71726872090SOleg Nesterov curr = info; 71826872090SOleg Nesterov 71926872090SOleg Nesterov info->mm = vma->vm_mm; 72057683f72SOleg Nesterov info->vaddr = offset_to_vaddr(vma, offset); 721a5f4374aSIngo Molnar } 722a5f4374aSIngo Molnar mutex_unlock(&mapping->i_mmap_mutex); 723a5f4374aSIngo Molnar 72426872090SOleg Nesterov if (!more) 72526872090SOleg Nesterov goto out; 726a5f4374aSIngo Molnar 72726872090SOleg Nesterov prev = curr; 72826872090SOleg Nesterov while (curr) { 72926872090SOleg Nesterov mmput(curr->mm); 73026872090SOleg Nesterov curr = curr->next; 73126872090SOleg Nesterov } 73226872090SOleg Nesterov 73326872090SOleg Nesterov do { 73426872090SOleg Nesterov info = kmalloc(sizeof(struct map_info), GFP_KERNEL); 73526872090SOleg Nesterov if (!info) { 73626872090SOleg Nesterov curr = ERR_PTR(-ENOMEM); 73726872090SOleg Nesterov goto out; 73826872090SOleg Nesterov } 73926872090SOleg Nesterov info->next = prev; 74026872090SOleg Nesterov prev = info; 74126872090SOleg Nesterov } while (--more); 74226872090SOleg Nesterov 74326872090SOleg Nesterov goto again; 74426872090SOleg Nesterov out: 74526872090SOleg Nesterov while (prev) 74626872090SOleg Nesterov prev = free_map_info(prev); 74726872090SOleg Nesterov return curr; 748a5f4374aSIngo Molnar } 749a5f4374aSIngo Molnar 750bdf8647cSOleg Nesterov static int 751bdf8647cSOleg Nesterov register_for_each_vma(struct uprobe *uprobe, struct uprobe_consumer *new) 752a5f4374aSIngo Molnar { 753bdf8647cSOleg Nesterov bool is_register = !!new; 75426872090SOleg Nesterov struct map_info *info; 75526872090SOleg Nesterov int err = 0; 75626872090SOleg Nesterov 75732cdba1eSOleg Nesterov percpu_down_write(&dup_mmap_sem); 75826872090SOleg Nesterov info = build_map_info(uprobe->inode->i_mapping, 75926872090SOleg Nesterov uprobe->offset, is_register); 76032cdba1eSOleg Nesterov if (IS_ERR(info)) { 76132cdba1eSOleg Nesterov err = PTR_ERR(info); 76232cdba1eSOleg Nesterov goto out; 76332cdba1eSOleg Nesterov } 76426872090SOleg Nesterov 76526872090SOleg Nesterov while (info) { 76626872090SOleg Nesterov struct mm_struct *mm = info->mm; 767a5f4374aSIngo Molnar struct vm_area_struct *vma; 768a5f4374aSIngo Molnar 769076a365bSOleg Nesterov if (err && is_register) 77026872090SOleg Nesterov goto free; 771a5f4374aSIngo Molnar 77277fc4af1SOleg Nesterov down_write(&mm->mmap_sem); 773f4d6dfe5SOleg Nesterov vma = find_vma(mm, info->vaddr); 774f4d6dfe5SOleg Nesterov if (!vma || !valid_vma(vma, is_register) || 775f281769eSOleg Nesterov file_inode(vma->vm_file) != uprobe->inode) 77626872090SOleg Nesterov goto unlock; 77726872090SOleg Nesterov 778f4d6dfe5SOleg Nesterov if (vma->vm_start > info->vaddr || 779f4d6dfe5SOleg Nesterov vaddr_to_offset(vma, info->vaddr) != uprobe->offset) 78026872090SOleg Nesterov goto unlock; 781a5f4374aSIngo Molnar 782806a98bdSOleg Nesterov if (is_register) { 783806a98bdSOleg Nesterov /* consult only the "caller", new consumer. */ 784bdf8647cSOleg Nesterov if (consumer_filter(new, 7858a7f2fa0SOleg Nesterov UPROBE_FILTER_REGISTER, mm)) 78626872090SOleg Nesterov err = install_breakpoint(uprobe, mm, vma, info->vaddr); 787806a98bdSOleg Nesterov } else if (test_bit(MMF_HAS_UPROBES, &mm->flags)) { 7888a7f2fa0SOleg Nesterov if (!filter_chain(uprobe, 7898a7f2fa0SOleg Nesterov UPROBE_FILTER_UNREGISTER, mm)) 790076a365bSOleg Nesterov err |= remove_breakpoint(uprobe, mm, info->vaddr); 791806a98bdSOleg Nesterov } 79278f74116SOleg Nesterov 79326872090SOleg Nesterov unlock: 79426872090SOleg Nesterov up_write(&mm->mmap_sem); 79526872090SOleg Nesterov free: 79626872090SOleg Nesterov mmput(mm); 79726872090SOleg Nesterov info = free_map_info(info); 798a5f4374aSIngo Molnar } 79932cdba1eSOleg Nesterov out: 80032cdba1eSOleg Nesterov percpu_up_write(&dup_mmap_sem); 80126872090SOleg Nesterov return err; 802a5f4374aSIngo Molnar } 803a5f4374aSIngo Molnar 8049a98e03cSOleg Nesterov static int __uprobe_register(struct uprobe *uprobe, struct uprobe_consumer *uc) 805a5f4374aSIngo Molnar { 8069a98e03cSOleg Nesterov consumer_add(uprobe, uc); 807bdf8647cSOleg Nesterov return register_for_each_vma(uprobe, uc); 808a5f4374aSIngo Molnar } 809a5f4374aSIngo Molnar 81004aab9b2SOleg Nesterov static void __uprobe_unregister(struct uprobe *uprobe, struct uprobe_consumer *uc) 811a5f4374aSIngo Molnar { 81204aab9b2SOleg Nesterov int err; 813a5f4374aSIngo Molnar 81404aab9b2SOleg Nesterov if (!consumer_del(uprobe, uc)) /* WARN? */ 81504aab9b2SOleg Nesterov return; 81604aab9b2SOleg Nesterov 817bdf8647cSOleg Nesterov err = register_for_each_vma(uprobe, NULL); 818a5f4374aSIngo Molnar /* TODO : cant unregister? schedule a worker thread */ 819bb929284SOleg Nesterov if (!uprobe->consumers && !err) 82004aab9b2SOleg Nesterov delete_uprobe(uprobe); 82104aab9b2SOleg Nesterov } 822a5f4374aSIngo Molnar 823a5f4374aSIngo Molnar /* 824a5f4374aSIngo Molnar * uprobe_register - register a probe 825a5f4374aSIngo Molnar * @inode: the file in which the probe has to be placed. 826a5f4374aSIngo Molnar * @offset: offset from the start of the file. 827e3343e6aSSrikar Dronamraju * @uc: information on howto handle the probe.. 828a5f4374aSIngo Molnar * 829a5f4374aSIngo Molnar * Apart from the access refcount, uprobe_register() takes a creation 830a5f4374aSIngo Molnar * refcount (thro alloc_uprobe) if and only if this @uprobe is getting 831a5f4374aSIngo Molnar * inserted into the rbtree (i.e first consumer for a @inode:@offset 832a5f4374aSIngo Molnar * tuple). Creation refcount stops uprobe_unregister from freeing the 833a5f4374aSIngo Molnar * @uprobe even before the register operation is complete. Creation 834e3343e6aSSrikar Dronamraju * refcount is released when the last @uc for the @uprobe 835a5f4374aSIngo Molnar * unregisters. 836a5f4374aSIngo Molnar * 837a5f4374aSIngo Molnar * Return errno if it cannot successully install probes 838a5f4374aSIngo Molnar * else return 0 (success) 839a5f4374aSIngo Molnar */ 840e3343e6aSSrikar Dronamraju int uprobe_register(struct inode *inode, loff_t offset, struct uprobe_consumer *uc) 841a5f4374aSIngo Molnar { 842a5f4374aSIngo Molnar struct uprobe *uprobe; 843a5f4374aSIngo Molnar int ret; 844a5f4374aSIngo Molnar 845f0744af7SOleg Nesterov /* Racy, just to catch the obvious mistakes */ 846a5f4374aSIngo Molnar if (offset > i_size_read(inode)) 847a5f4374aSIngo Molnar return -EINVAL; 848a5f4374aSIngo Molnar 84966d06dffSOleg Nesterov retry: 850a5f4374aSIngo Molnar uprobe = alloc_uprobe(inode, offset); 85166d06dffSOleg Nesterov if (!uprobe) 85266d06dffSOleg Nesterov return -ENOMEM; 85366d06dffSOleg Nesterov /* 85466d06dffSOleg Nesterov * We can race with uprobe_unregister()->delete_uprobe(). 85566d06dffSOleg Nesterov * Check uprobe_is_active() and retry if it is false. 85666d06dffSOleg Nesterov */ 857e591c8d7SOleg Nesterov down_write(&uprobe->register_rwsem); 85866d06dffSOleg Nesterov ret = -EAGAIN; 85966d06dffSOleg Nesterov if (likely(uprobe_is_active(uprobe))) { 8609a98e03cSOleg Nesterov ret = __uprobe_register(uprobe, uc); 8619a98e03cSOleg Nesterov if (ret) 86204aab9b2SOleg Nesterov __uprobe_unregister(uprobe, uc); 863a5f4374aSIngo Molnar } 86466d06dffSOleg Nesterov up_write(&uprobe->register_rwsem); 865a5f4374aSIngo Molnar put_uprobe(uprobe); 866a5f4374aSIngo Molnar 86766d06dffSOleg Nesterov if (unlikely(ret == -EAGAIN)) 86866d06dffSOleg Nesterov goto retry; 869a5f4374aSIngo Molnar return ret; 870a5f4374aSIngo Molnar } 871e8440c14SJosh Stone EXPORT_SYMBOL_GPL(uprobe_register); 872a5f4374aSIngo Molnar 873a5f4374aSIngo Molnar /* 874bdf8647cSOleg Nesterov * uprobe_apply - unregister a already registered probe. 875bdf8647cSOleg Nesterov * @inode: the file in which the probe has to be removed. 876bdf8647cSOleg Nesterov * @offset: offset from the start of the file. 877bdf8647cSOleg Nesterov * @uc: consumer which wants to add more or remove some breakpoints 878bdf8647cSOleg Nesterov * @add: add or remove the breakpoints 879bdf8647cSOleg Nesterov */ 880bdf8647cSOleg Nesterov int uprobe_apply(struct inode *inode, loff_t offset, 881bdf8647cSOleg Nesterov struct uprobe_consumer *uc, bool add) 882bdf8647cSOleg Nesterov { 883bdf8647cSOleg Nesterov struct uprobe *uprobe; 884bdf8647cSOleg Nesterov struct uprobe_consumer *con; 885bdf8647cSOleg Nesterov int ret = -ENOENT; 886bdf8647cSOleg Nesterov 887bdf8647cSOleg Nesterov uprobe = find_uprobe(inode, offset); 888bdf8647cSOleg Nesterov if (!uprobe) 889bdf8647cSOleg Nesterov return ret; 890bdf8647cSOleg Nesterov 891bdf8647cSOleg Nesterov down_write(&uprobe->register_rwsem); 892bdf8647cSOleg Nesterov for (con = uprobe->consumers; con && con != uc ; con = con->next) 893bdf8647cSOleg Nesterov ; 894bdf8647cSOleg Nesterov if (con) 895bdf8647cSOleg Nesterov ret = register_for_each_vma(uprobe, add ? uc : NULL); 896bdf8647cSOleg Nesterov up_write(&uprobe->register_rwsem); 897bdf8647cSOleg Nesterov put_uprobe(uprobe); 898bdf8647cSOleg Nesterov 899bdf8647cSOleg Nesterov return ret; 900bdf8647cSOleg Nesterov } 901bdf8647cSOleg Nesterov 902bdf8647cSOleg Nesterov /* 903a5f4374aSIngo Molnar * uprobe_unregister - unregister a already registered probe. 904a5f4374aSIngo Molnar * @inode: the file in which the probe has to be removed. 905a5f4374aSIngo Molnar * @offset: offset from the start of the file. 906e3343e6aSSrikar Dronamraju * @uc: identify which probe if multiple probes are colocated. 907a5f4374aSIngo Molnar */ 908e3343e6aSSrikar Dronamraju void uprobe_unregister(struct inode *inode, loff_t offset, struct uprobe_consumer *uc) 909a5f4374aSIngo Molnar { 910a5f4374aSIngo Molnar struct uprobe *uprobe; 911a5f4374aSIngo Molnar 912a5f4374aSIngo Molnar uprobe = find_uprobe(inode, offset); 913a5f4374aSIngo Molnar if (!uprobe) 914a5f4374aSIngo Molnar return; 915a5f4374aSIngo Molnar 916e591c8d7SOleg Nesterov down_write(&uprobe->register_rwsem); 91704aab9b2SOleg Nesterov __uprobe_unregister(uprobe, uc); 918e591c8d7SOleg Nesterov up_write(&uprobe->register_rwsem); 919a5f4374aSIngo Molnar put_uprobe(uprobe); 920a5f4374aSIngo Molnar } 921e8440c14SJosh Stone EXPORT_SYMBOL_GPL(uprobe_unregister); 922a5f4374aSIngo Molnar 923da1816b1SOleg Nesterov static int unapply_uprobe(struct uprobe *uprobe, struct mm_struct *mm) 924da1816b1SOleg Nesterov { 925da1816b1SOleg Nesterov struct vm_area_struct *vma; 926da1816b1SOleg Nesterov int err = 0; 927da1816b1SOleg Nesterov 928da1816b1SOleg Nesterov down_read(&mm->mmap_sem); 929da1816b1SOleg Nesterov for (vma = mm->mmap; vma; vma = vma->vm_next) { 930da1816b1SOleg Nesterov unsigned long vaddr; 931da1816b1SOleg Nesterov loff_t offset; 932da1816b1SOleg Nesterov 933da1816b1SOleg Nesterov if (!valid_vma(vma, false) || 934f281769eSOleg Nesterov file_inode(vma->vm_file) != uprobe->inode) 935da1816b1SOleg Nesterov continue; 936da1816b1SOleg Nesterov 937da1816b1SOleg Nesterov offset = (loff_t)vma->vm_pgoff << PAGE_SHIFT; 938da1816b1SOleg Nesterov if (uprobe->offset < offset || 939da1816b1SOleg Nesterov uprobe->offset >= offset + vma->vm_end - vma->vm_start) 940da1816b1SOleg Nesterov continue; 941da1816b1SOleg Nesterov 942da1816b1SOleg Nesterov vaddr = offset_to_vaddr(vma, uprobe->offset); 943da1816b1SOleg Nesterov err |= remove_breakpoint(uprobe, mm, vaddr); 944da1816b1SOleg Nesterov } 945da1816b1SOleg Nesterov up_read(&mm->mmap_sem); 946da1816b1SOleg Nesterov 947da1816b1SOleg Nesterov return err; 948da1816b1SOleg Nesterov } 949da1816b1SOleg Nesterov 950891c3970SOleg Nesterov static struct rb_node * 951891c3970SOleg Nesterov find_node_in_range(struct inode *inode, loff_t min, loff_t max) 952a5f4374aSIngo Molnar { 953a5f4374aSIngo Molnar struct rb_node *n = uprobes_tree.rb_node; 954a5f4374aSIngo Molnar 955a5f4374aSIngo Molnar while (n) { 956891c3970SOleg Nesterov struct uprobe *u = rb_entry(n, struct uprobe, rb_node); 957a5f4374aSIngo Molnar 958891c3970SOleg Nesterov if (inode < u->inode) { 959a5f4374aSIngo Molnar n = n->rb_left; 960891c3970SOleg Nesterov } else if (inode > u->inode) { 961a5f4374aSIngo Molnar n = n->rb_right; 962891c3970SOleg Nesterov } else { 963891c3970SOleg Nesterov if (max < u->offset) 964891c3970SOleg Nesterov n = n->rb_left; 965891c3970SOleg Nesterov else if (min > u->offset) 966891c3970SOleg Nesterov n = n->rb_right; 967891c3970SOleg Nesterov else 968891c3970SOleg Nesterov break; 969891c3970SOleg Nesterov } 970a5f4374aSIngo Molnar } 971a5f4374aSIngo Molnar 972891c3970SOleg Nesterov return n; 973a5f4374aSIngo Molnar } 974a5f4374aSIngo Molnar 975a5f4374aSIngo Molnar /* 976891c3970SOleg Nesterov * For a given range in vma, build a list of probes that need to be inserted. 977a5f4374aSIngo Molnar */ 978891c3970SOleg Nesterov static void build_probe_list(struct inode *inode, 979891c3970SOleg Nesterov struct vm_area_struct *vma, 980891c3970SOleg Nesterov unsigned long start, unsigned long end, 981891c3970SOleg Nesterov struct list_head *head) 982a5f4374aSIngo Molnar { 983891c3970SOleg Nesterov loff_t min, max; 984891c3970SOleg Nesterov struct rb_node *n, *t; 985891c3970SOleg Nesterov struct uprobe *u; 986891c3970SOleg Nesterov 987891c3970SOleg Nesterov INIT_LIST_HEAD(head); 988cb113b47SOleg Nesterov min = vaddr_to_offset(vma, start); 989891c3970SOleg Nesterov max = min + (end - start) - 1; 990a5f4374aSIngo Molnar 9916f47caa0SOleg Nesterov spin_lock(&uprobes_treelock); 992891c3970SOleg Nesterov n = find_node_in_range(inode, min, max); 993891c3970SOleg Nesterov if (n) { 994891c3970SOleg Nesterov for (t = n; t; t = rb_prev(t)) { 995891c3970SOleg Nesterov u = rb_entry(t, struct uprobe, rb_node); 996891c3970SOleg Nesterov if (u->inode != inode || u->offset < min) 997a5f4374aSIngo Molnar break; 998891c3970SOleg Nesterov list_add(&u->pending_list, head); 999891c3970SOleg Nesterov atomic_inc(&u->ref); 1000a5f4374aSIngo Molnar } 1001891c3970SOleg Nesterov for (t = n; (t = rb_next(t)); ) { 1002891c3970SOleg Nesterov u = rb_entry(t, struct uprobe, rb_node); 1003891c3970SOleg Nesterov if (u->inode != inode || u->offset > max) 1004891c3970SOleg Nesterov break; 1005891c3970SOleg Nesterov list_add(&u->pending_list, head); 1006891c3970SOleg Nesterov atomic_inc(&u->ref); 1007891c3970SOleg Nesterov } 1008891c3970SOleg Nesterov } 10096f47caa0SOleg Nesterov spin_unlock(&uprobes_treelock); 1010a5f4374aSIngo Molnar } 1011a5f4374aSIngo Molnar 1012a5f4374aSIngo Molnar /* 10135e5be71aSOleg Nesterov * Called from mmap_region/vma_adjust with mm->mmap_sem acquired. 1014a5f4374aSIngo Molnar * 10155e5be71aSOleg Nesterov * Currently we ignore all errors and always return 0, the callers 10165e5be71aSOleg Nesterov * can't handle the failure anyway. 1017a5f4374aSIngo Molnar */ 1018a5f4374aSIngo Molnar int uprobe_mmap(struct vm_area_struct *vma) 1019a5f4374aSIngo Molnar { 1020a5f4374aSIngo Molnar struct list_head tmp_list; 1021665605a2SOleg Nesterov struct uprobe *uprobe, *u; 1022a5f4374aSIngo Molnar struct inode *inode; 1023a5f4374aSIngo Molnar 1024441f1eb7SOleg Nesterov if (no_uprobe_events() || !valid_vma(vma, true)) 1025a5f4374aSIngo Molnar return 0; 1026a5f4374aSIngo Molnar 1027f281769eSOleg Nesterov inode = file_inode(vma->vm_file); 1028a5f4374aSIngo Molnar if (!inode) 1029a5f4374aSIngo Molnar return 0; 1030a5f4374aSIngo Molnar 1031a5f4374aSIngo Molnar mutex_lock(uprobes_mmap_hash(inode)); 1032891c3970SOleg Nesterov build_probe_list(inode, vma, vma->vm_start, vma->vm_end, &tmp_list); 1033806a98bdSOleg Nesterov /* 1034806a98bdSOleg Nesterov * We can race with uprobe_unregister(), this uprobe can be already 1035806a98bdSOleg Nesterov * removed. But in this case filter_chain() must return false, all 1036806a98bdSOleg Nesterov * consumers have gone away. 1037806a98bdSOleg Nesterov */ 1038665605a2SOleg Nesterov list_for_each_entry_safe(uprobe, u, &tmp_list, pending_list) { 1039806a98bdSOleg Nesterov if (!fatal_signal_pending(current) && 10408a7f2fa0SOleg Nesterov filter_chain(uprobe, UPROBE_FILTER_MMAP, vma->vm_mm)) { 104157683f72SOleg Nesterov unsigned long vaddr = offset_to_vaddr(vma, uprobe->offset); 10425e5be71aSOleg Nesterov install_breakpoint(uprobe, vma->vm_mm, vma, vaddr); 1043a5f4374aSIngo Molnar } 1044a5f4374aSIngo Molnar put_uprobe(uprobe); 1045a5f4374aSIngo Molnar } 1046a5f4374aSIngo Molnar mutex_unlock(uprobes_mmap_hash(inode)); 1047a5f4374aSIngo Molnar 10485e5be71aSOleg Nesterov return 0; 1049a5f4374aSIngo Molnar } 1050a5f4374aSIngo Molnar 10519f68f672SOleg Nesterov static bool 10529f68f672SOleg Nesterov vma_has_uprobes(struct vm_area_struct *vma, unsigned long start, unsigned long end) 10539f68f672SOleg Nesterov { 10549f68f672SOleg Nesterov loff_t min, max; 10559f68f672SOleg Nesterov struct inode *inode; 10569f68f672SOleg Nesterov struct rb_node *n; 10579f68f672SOleg Nesterov 1058f281769eSOleg Nesterov inode = file_inode(vma->vm_file); 10599f68f672SOleg Nesterov 10609f68f672SOleg Nesterov min = vaddr_to_offset(vma, start); 10619f68f672SOleg Nesterov max = min + (end - start) - 1; 10629f68f672SOleg Nesterov 10639f68f672SOleg Nesterov spin_lock(&uprobes_treelock); 10649f68f672SOleg Nesterov n = find_node_in_range(inode, min, max); 10659f68f672SOleg Nesterov spin_unlock(&uprobes_treelock); 10669f68f672SOleg Nesterov 10679f68f672SOleg Nesterov return !!n; 10689f68f672SOleg Nesterov } 10699f68f672SOleg Nesterov 1070682968e0SSrikar Dronamraju /* 1071682968e0SSrikar Dronamraju * Called in context of a munmap of a vma. 1072682968e0SSrikar Dronamraju */ 1073cbc91f71SSrikar Dronamraju void uprobe_munmap(struct vm_area_struct *vma, unsigned long start, unsigned long end) 1074682968e0SSrikar Dronamraju { 1075441f1eb7SOleg Nesterov if (no_uprobe_events() || !valid_vma(vma, false)) 1076682968e0SSrikar Dronamraju return; 1077682968e0SSrikar Dronamraju 10782fd611a9SOleg Nesterov if (!atomic_read(&vma->vm_mm->mm_users)) /* called by mmput() ? */ 10792fd611a9SOleg Nesterov return; 10802fd611a9SOleg Nesterov 10819f68f672SOleg Nesterov if (!test_bit(MMF_HAS_UPROBES, &vma->vm_mm->flags) || 10829f68f672SOleg Nesterov test_bit(MMF_RECALC_UPROBES, &vma->vm_mm->flags)) 1083f8ac4ec9SOleg Nesterov return; 1084f8ac4ec9SOleg Nesterov 10859f68f672SOleg Nesterov if (vma_has_uprobes(vma, start, end)) 10869f68f672SOleg Nesterov set_bit(MMF_RECALC_UPROBES, &vma->vm_mm->flags); 1087682968e0SSrikar Dronamraju } 1088682968e0SSrikar Dronamraju 1089d4b3b638SSrikar Dronamraju /* Slot allocation for XOL */ 1090d4b3b638SSrikar Dronamraju static int xol_add_vma(struct xol_area *area) 1091d4b3b638SSrikar Dronamraju { 1092c8a82538SOleg Nesterov struct mm_struct *mm = current->mm; 1093c8a82538SOleg Nesterov int ret = -EALREADY; 1094d4b3b638SSrikar Dronamraju 1095d4b3b638SSrikar Dronamraju down_write(&mm->mmap_sem); 1096d4b3b638SSrikar Dronamraju if (mm->uprobes_state.xol_area) 1097d4b3b638SSrikar Dronamraju goto fail; 1098d4b3b638SSrikar Dronamraju 1099d4b3b638SSrikar Dronamraju ret = -ENOMEM; 1100d4b3b638SSrikar Dronamraju /* Try to map as high as possible, this is only a hint. */ 1101d4b3b638SSrikar Dronamraju area->vaddr = get_unmapped_area(NULL, TASK_SIZE - PAGE_SIZE, PAGE_SIZE, 0, 0); 1102d4b3b638SSrikar Dronamraju if (area->vaddr & ~PAGE_MASK) { 1103d4b3b638SSrikar Dronamraju ret = area->vaddr; 1104d4b3b638SSrikar Dronamraju goto fail; 1105d4b3b638SSrikar Dronamraju } 1106d4b3b638SSrikar Dronamraju 1107d4b3b638SSrikar Dronamraju ret = install_special_mapping(mm, area->vaddr, PAGE_SIZE, 1108d4b3b638SSrikar Dronamraju VM_EXEC|VM_MAYEXEC|VM_DONTCOPY|VM_IO, &area->page); 1109d4b3b638SSrikar Dronamraju if (ret) 1110d4b3b638SSrikar Dronamraju goto fail; 1111d4b3b638SSrikar Dronamraju 1112d4b3b638SSrikar Dronamraju smp_wmb(); /* pairs with get_xol_area() */ 1113d4b3b638SSrikar Dronamraju mm->uprobes_state.xol_area = area; 1114d4b3b638SSrikar Dronamraju ret = 0; 1115d4b3b638SSrikar Dronamraju fail: 1116d4b3b638SSrikar Dronamraju up_write(&mm->mmap_sem); 1117d4b3b638SSrikar Dronamraju 1118d4b3b638SSrikar Dronamraju return ret; 1119d4b3b638SSrikar Dronamraju } 1120d4b3b638SSrikar Dronamraju 1121d4b3b638SSrikar Dronamraju /* 11229b545df8SOleg Nesterov * get_xol_area - Allocate process's xol_area if necessary. 11239b545df8SOleg Nesterov * This area will be used for storing instructions for execution out of line. 1124d4b3b638SSrikar Dronamraju * 1125d4b3b638SSrikar Dronamraju * Returns the allocated area or NULL. 1126d4b3b638SSrikar Dronamraju */ 11279b545df8SOleg Nesterov static struct xol_area *get_xol_area(void) 1128d4b3b638SSrikar Dronamraju { 11299b545df8SOleg Nesterov struct mm_struct *mm = current->mm; 1130d4b3b638SSrikar Dronamraju struct xol_area *area; 1131d4b3b638SSrikar Dronamraju 11329b545df8SOleg Nesterov area = mm->uprobes_state.xol_area; 11339b545df8SOleg Nesterov if (area) 11349b545df8SOleg Nesterov goto ret; 11359b545df8SOleg Nesterov 1136d4b3b638SSrikar Dronamraju area = kzalloc(sizeof(*area), GFP_KERNEL); 1137d4b3b638SSrikar Dronamraju if (unlikely(!area)) 1138c8a82538SOleg Nesterov goto out; 1139d4b3b638SSrikar Dronamraju 1140d4b3b638SSrikar Dronamraju area->bitmap = kzalloc(BITS_TO_LONGS(UINSNS_PER_PAGE) * sizeof(long), GFP_KERNEL); 1141d4b3b638SSrikar Dronamraju if (!area->bitmap) 1142c8a82538SOleg Nesterov goto free_area; 1143c8a82538SOleg Nesterov 1144c8a82538SOleg Nesterov area->page = alloc_page(GFP_HIGHUSER); 1145c8a82538SOleg Nesterov if (!area->page) 1146c8a82538SOleg Nesterov goto free_bitmap; 1147d4b3b638SSrikar Dronamraju 1148d4b3b638SSrikar Dronamraju init_waitqueue_head(&area->wq); 1149d4b3b638SSrikar Dronamraju if (!xol_add_vma(area)) 1150d4b3b638SSrikar Dronamraju return area; 1151d4b3b638SSrikar Dronamraju 1152c8a82538SOleg Nesterov __free_page(area->page); 1153c8a82538SOleg Nesterov free_bitmap: 1154d4b3b638SSrikar Dronamraju kfree(area->bitmap); 1155c8a82538SOleg Nesterov free_area: 1156d4b3b638SSrikar Dronamraju kfree(area); 1157c8a82538SOleg Nesterov out: 11589b545df8SOleg Nesterov area = mm->uprobes_state.xol_area; 11599b545df8SOleg Nesterov ret: 11609b545df8SOleg Nesterov smp_read_barrier_depends(); /* pairs with wmb in xol_add_vma() */ 11619b545df8SOleg Nesterov return area; 1162d4b3b638SSrikar Dronamraju } 1163d4b3b638SSrikar Dronamraju 1164d4b3b638SSrikar Dronamraju /* 1165d4b3b638SSrikar Dronamraju * uprobe_clear_state - Free the area allocated for slots. 1166d4b3b638SSrikar Dronamraju */ 1167d4b3b638SSrikar Dronamraju void uprobe_clear_state(struct mm_struct *mm) 1168d4b3b638SSrikar Dronamraju { 1169d4b3b638SSrikar Dronamraju struct xol_area *area = mm->uprobes_state.xol_area; 1170d4b3b638SSrikar Dronamraju 1171d4b3b638SSrikar Dronamraju if (!area) 1172d4b3b638SSrikar Dronamraju return; 1173d4b3b638SSrikar Dronamraju 1174d4b3b638SSrikar Dronamraju put_page(area->page); 1175d4b3b638SSrikar Dronamraju kfree(area->bitmap); 1176d4b3b638SSrikar Dronamraju kfree(area); 1177d4b3b638SSrikar Dronamraju } 1178d4b3b638SSrikar Dronamraju 117932cdba1eSOleg Nesterov void uprobe_start_dup_mmap(void) 118032cdba1eSOleg Nesterov { 118132cdba1eSOleg Nesterov percpu_down_read(&dup_mmap_sem); 118232cdba1eSOleg Nesterov } 118332cdba1eSOleg Nesterov 118432cdba1eSOleg Nesterov void uprobe_end_dup_mmap(void) 118532cdba1eSOleg Nesterov { 118632cdba1eSOleg Nesterov percpu_up_read(&dup_mmap_sem); 118732cdba1eSOleg Nesterov } 118832cdba1eSOleg Nesterov 1189f8ac4ec9SOleg Nesterov void uprobe_dup_mmap(struct mm_struct *oldmm, struct mm_struct *newmm) 1190f8ac4ec9SOleg Nesterov { 119161559a81SOleg Nesterov newmm->uprobes_state.xol_area = NULL; 119261559a81SOleg Nesterov 11939f68f672SOleg Nesterov if (test_bit(MMF_HAS_UPROBES, &oldmm->flags)) { 1194f8ac4ec9SOleg Nesterov set_bit(MMF_HAS_UPROBES, &newmm->flags); 11959f68f672SOleg Nesterov /* unconditionally, dup_mmap() skips VM_DONTCOPY vmas */ 11969f68f672SOleg Nesterov set_bit(MMF_RECALC_UPROBES, &newmm->flags); 11979f68f672SOleg Nesterov } 1198f8ac4ec9SOleg Nesterov } 1199f8ac4ec9SOleg Nesterov 1200d4b3b638SSrikar Dronamraju /* 1201d4b3b638SSrikar Dronamraju * - search for a free slot. 1202d4b3b638SSrikar Dronamraju */ 1203d4b3b638SSrikar Dronamraju static unsigned long xol_take_insn_slot(struct xol_area *area) 1204d4b3b638SSrikar Dronamraju { 1205d4b3b638SSrikar Dronamraju unsigned long slot_addr; 1206d4b3b638SSrikar Dronamraju int slot_nr; 1207d4b3b638SSrikar Dronamraju 1208d4b3b638SSrikar Dronamraju do { 1209d4b3b638SSrikar Dronamraju slot_nr = find_first_zero_bit(area->bitmap, UINSNS_PER_PAGE); 1210d4b3b638SSrikar Dronamraju if (slot_nr < UINSNS_PER_PAGE) { 1211d4b3b638SSrikar Dronamraju if (!test_and_set_bit(slot_nr, area->bitmap)) 1212d4b3b638SSrikar Dronamraju break; 1213d4b3b638SSrikar Dronamraju 1214d4b3b638SSrikar Dronamraju slot_nr = UINSNS_PER_PAGE; 1215d4b3b638SSrikar Dronamraju continue; 1216d4b3b638SSrikar Dronamraju } 1217d4b3b638SSrikar Dronamraju wait_event(area->wq, (atomic_read(&area->slot_count) < UINSNS_PER_PAGE)); 1218d4b3b638SSrikar Dronamraju } while (slot_nr >= UINSNS_PER_PAGE); 1219d4b3b638SSrikar Dronamraju 1220d4b3b638SSrikar Dronamraju slot_addr = area->vaddr + (slot_nr * UPROBE_XOL_SLOT_BYTES); 1221d4b3b638SSrikar Dronamraju atomic_inc(&area->slot_count); 1222d4b3b638SSrikar Dronamraju 1223d4b3b638SSrikar Dronamraju return slot_addr; 1224d4b3b638SSrikar Dronamraju } 1225d4b3b638SSrikar Dronamraju 1226d4b3b638SSrikar Dronamraju /* 1227a6cb3f6dSOleg Nesterov * xol_get_insn_slot - allocate a slot for xol. 1228d4b3b638SSrikar Dronamraju * Returns the allocated slot address or 0. 1229d4b3b638SSrikar Dronamraju */ 1230a6cb3f6dSOleg Nesterov static unsigned long xol_get_insn_slot(struct uprobe *uprobe) 1231d4b3b638SSrikar Dronamraju { 1232d4b3b638SSrikar Dronamraju struct xol_area *area; 1233d4b3b638SSrikar Dronamraju unsigned long offset; 1234a6cb3f6dSOleg Nesterov unsigned long xol_vaddr; 1235d4b3b638SSrikar Dronamraju void *vaddr; 1236d4b3b638SSrikar Dronamraju 12379b545df8SOleg Nesterov area = get_xol_area(); 1238d4b3b638SSrikar Dronamraju if (!area) 1239d4b3b638SSrikar Dronamraju return 0; 1240d4b3b638SSrikar Dronamraju 1241a6cb3f6dSOleg Nesterov xol_vaddr = xol_take_insn_slot(area); 1242a6cb3f6dSOleg Nesterov if (unlikely(!xol_vaddr)) 1243d4b3b638SSrikar Dronamraju return 0; 1244d4b3b638SSrikar Dronamraju 1245a6cb3f6dSOleg Nesterov /* Initialize the slot */ 1246a6cb3f6dSOleg Nesterov offset = xol_vaddr & ~PAGE_MASK; 1247d4b3b638SSrikar Dronamraju vaddr = kmap_atomic(area->page); 1248d4b3b638SSrikar Dronamraju memcpy(vaddr + offset, uprobe->arch.insn, MAX_UINSN_BYTES); 1249d4b3b638SSrikar Dronamraju kunmap_atomic(vaddr); 125065b6ecc0SRabin Vincent /* 125165b6ecc0SRabin Vincent * We probably need flush_icache_user_range() but it needs vma. 125265b6ecc0SRabin Vincent * This should work on supported architectures too. 125365b6ecc0SRabin Vincent */ 125465b6ecc0SRabin Vincent flush_dcache_page(area->page); 1255d4b3b638SSrikar Dronamraju 1256a6cb3f6dSOleg Nesterov return xol_vaddr; 1257d4b3b638SSrikar Dronamraju } 1258d4b3b638SSrikar Dronamraju 1259d4b3b638SSrikar Dronamraju /* 1260d4b3b638SSrikar Dronamraju * xol_free_insn_slot - If slot was earlier allocated by 1261d4b3b638SSrikar Dronamraju * @xol_get_insn_slot(), make the slot available for 1262d4b3b638SSrikar Dronamraju * subsequent requests. 1263d4b3b638SSrikar Dronamraju */ 1264d4b3b638SSrikar Dronamraju static void xol_free_insn_slot(struct task_struct *tsk) 1265d4b3b638SSrikar Dronamraju { 1266d4b3b638SSrikar Dronamraju struct xol_area *area; 1267d4b3b638SSrikar Dronamraju unsigned long vma_end; 1268d4b3b638SSrikar Dronamraju unsigned long slot_addr; 1269d4b3b638SSrikar Dronamraju 1270d4b3b638SSrikar Dronamraju if (!tsk->mm || !tsk->mm->uprobes_state.xol_area || !tsk->utask) 1271d4b3b638SSrikar Dronamraju return; 1272d4b3b638SSrikar Dronamraju 1273d4b3b638SSrikar Dronamraju slot_addr = tsk->utask->xol_vaddr; 1274af4355e9SOleg Nesterov if (unlikely(!slot_addr)) 1275d4b3b638SSrikar Dronamraju return; 1276d4b3b638SSrikar Dronamraju 1277d4b3b638SSrikar Dronamraju area = tsk->mm->uprobes_state.xol_area; 1278d4b3b638SSrikar Dronamraju vma_end = area->vaddr + PAGE_SIZE; 1279d4b3b638SSrikar Dronamraju if (area->vaddr <= slot_addr && slot_addr < vma_end) { 1280d4b3b638SSrikar Dronamraju unsigned long offset; 1281d4b3b638SSrikar Dronamraju int slot_nr; 1282d4b3b638SSrikar Dronamraju 1283d4b3b638SSrikar Dronamraju offset = slot_addr - area->vaddr; 1284d4b3b638SSrikar Dronamraju slot_nr = offset / UPROBE_XOL_SLOT_BYTES; 1285d4b3b638SSrikar Dronamraju if (slot_nr >= UINSNS_PER_PAGE) 1286d4b3b638SSrikar Dronamraju return; 1287d4b3b638SSrikar Dronamraju 1288d4b3b638SSrikar Dronamraju clear_bit(slot_nr, area->bitmap); 1289d4b3b638SSrikar Dronamraju atomic_dec(&area->slot_count); 1290d4b3b638SSrikar Dronamraju if (waitqueue_active(&area->wq)) 1291d4b3b638SSrikar Dronamraju wake_up(&area->wq); 1292d4b3b638SSrikar Dronamraju 1293d4b3b638SSrikar Dronamraju tsk->utask->xol_vaddr = 0; 1294d4b3b638SSrikar Dronamraju } 1295d4b3b638SSrikar Dronamraju } 1296d4b3b638SSrikar Dronamraju 12970326f5a9SSrikar Dronamraju /** 12980326f5a9SSrikar Dronamraju * uprobe_get_swbp_addr - compute address of swbp given post-swbp regs 12990326f5a9SSrikar Dronamraju * @regs: Reflects the saved state of the task after it has hit a breakpoint 13000326f5a9SSrikar Dronamraju * instruction. 13010326f5a9SSrikar Dronamraju * Return the address of the breakpoint instruction. 13020326f5a9SSrikar Dronamraju */ 13030326f5a9SSrikar Dronamraju unsigned long __weak uprobe_get_swbp_addr(struct pt_regs *regs) 13040326f5a9SSrikar Dronamraju { 13050326f5a9SSrikar Dronamraju return instruction_pointer(regs) - UPROBE_SWBP_INSN_SIZE; 13060326f5a9SSrikar Dronamraju } 13070326f5a9SSrikar Dronamraju 13080326f5a9SSrikar Dronamraju /* 13090326f5a9SSrikar Dronamraju * Called with no locks held. 13100326f5a9SSrikar Dronamraju * Called in context of a exiting or a exec-ing thread. 13110326f5a9SSrikar Dronamraju */ 13120326f5a9SSrikar Dronamraju void uprobe_free_utask(struct task_struct *t) 13130326f5a9SSrikar Dronamraju { 13140326f5a9SSrikar Dronamraju struct uprobe_task *utask = t->utask; 13150326f5a9SSrikar Dronamraju 13160326f5a9SSrikar Dronamraju if (!utask) 13170326f5a9SSrikar Dronamraju return; 13180326f5a9SSrikar Dronamraju 13190326f5a9SSrikar Dronamraju if (utask->active_uprobe) 13200326f5a9SSrikar Dronamraju put_uprobe(utask->active_uprobe); 13210326f5a9SSrikar Dronamraju 1322d4b3b638SSrikar Dronamraju xol_free_insn_slot(t); 13230326f5a9SSrikar Dronamraju kfree(utask); 13240326f5a9SSrikar Dronamraju t->utask = NULL; 13250326f5a9SSrikar Dronamraju } 13260326f5a9SSrikar Dronamraju 13270326f5a9SSrikar Dronamraju /* 13280326f5a9SSrikar Dronamraju * Called in context of a new clone/fork from copy_process. 13290326f5a9SSrikar Dronamraju */ 13300326f5a9SSrikar Dronamraju void uprobe_copy_process(struct task_struct *t) 13310326f5a9SSrikar Dronamraju { 13320326f5a9SSrikar Dronamraju t->utask = NULL; 13330326f5a9SSrikar Dronamraju } 13340326f5a9SSrikar Dronamraju 13350326f5a9SSrikar Dronamraju /* 13365a2df662SOleg Nesterov * Allocate a uprobe_task object for the task if if necessary. 13375a2df662SOleg Nesterov * Called when the thread hits a breakpoint. 13380326f5a9SSrikar Dronamraju * 13390326f5a9SSrikar Dronamraju * Returns: 13400326f5a9SSrikar Dronamraju * - pointer to new uprobe_task on success 13410326f5a9SSrikar Dronamraju * - NULL otherwise 13420326f5a9SSrikar Dronamraju */ 13435a2df662SOleg Nesterov static struct uprobe_task *get_utask(void) 13440326f5a9SSrikar Dronamraju { 13455a2df662SOleg Nesterov if (!current->utask) 13465a2df662SOleg Nesterov current->utask = kzalloc(sizeof(struct uprobe_task), GFP_KERNEL); 13475a2df662SOleg Nesterov return current->utask; 13480326f5a9SSrikar Dronamraju } 13490326f5a9SSrikar Dronamraju 13500326f5a9SSrikar Dronamraju /* Prepare to single-step probed instruction out of line. */ 13510326f5a9SSrikar Dronamraju static int 1352a6cb3f6dSOleg Nesterov pre_ssout(struct uprobe *uprobe, struct pt_regs *regs, unsigned long bp_vaddr) 13530326f5a9SSrikar Dronamraju { 1354a6cb3f6dSOleg Nesterov struct uprobe_task *utask; 1355a6cb3f6dSOleg Nesterov unsigned long xol_vaddr; 1356aba51024SOleg Nesterov int err; 1357d4b3b638SSrikar Dronamraju 1358608e7427SOleg Nesterov utask = get_utask(); 1359608e7427SOleg Nesterov if (!utask) 1360608e7427SOleg Nesterov return -ENOMEM; 1361a6cb3f6dSOleg Nesterov 1362a6cb3f6dSOleg Nesterov xol_vaddr = xol_get_insn_slot(uprobe); 1363a6cb3f6dSOleg Nesterov if (!xol_vaddr) 1364a6cb3f6dSOleg Nesterov return -ENOMEM; 1365a6cb3f6dSOleg Nesterov 1366a6cb3f6dSOleg Nesterov utask->xol_vaddr = xol_vaddr; 1367a6cb3f6dSOleg Nesterov utask->vaddr = bp_vaddr; 1368a6cb3f6dSOleg Nesterov 1369aba51024SOleg Nesterov err = arch_uprobe_pre_xol(&uprobe->arch, regs); 1370aba51024SOleg Nesterov if (unlikely(err)) { 1371aba51024SOleg Nesterov xol_free_insn_slot(current); 1372aba51024SOleg Nesterov return err; 1373aba51024SOleg Nesterov } 1374aba51024SOleg Nesterov 1375608e7427SOleg Nesterov utask->active_uprobe = uprobe; 1376608e7427SOleg Nesterov utask->state = UTASK_SSTEP; 1377aba51024SOleg Nesterov return 0; 13780326f5a9SSrikar Dronamraju } 13790326f5a9SSrikar Dronamraju 13800326f5a9SSrikar Dronamraju /* 13810326f5a9SSrikar Dronamraju * If we are singlestepping, then ensure this thread is not connected to 13820326f5a9SSrikar Dronamraju * non-fatal signals until completion of singlestep. When xol insn itself 13830326f5a9SSrikar Dronamraju * triggers the signal, restart the original insn even if the task is 13840326f5a9SSrikar Dronamraju * already SIGKILL'ed (since coredump should report the correct ip). This 13850326f5a9SSrikar Dronamraju * is even more important if the task has a handler for SIGSEGV/etc, The 13860326f5a9SSrikar Dronamraju * _same_ instruction should be repeated again after return from the signal 13870326f5a9SSrikar Dronamraju * handler, and SSTEP can never finish in this case. 13880326f5a9SSrikar Dronamraju */ 13890326f5a9SSrikar Dronamraju bool uprobe_deny_signal(void) 13900326f5a9SSrikar Dronamraju { 13910326f5a9SSrikar Dronamraju struct task_struct *t = current; 13920326f5a9SSrikar Dronamraju struct uprobe_task *utask = t->utask; 13930326f5a9SSrikar Dronamraju 13940326f5a9SSrikar Dronamraju if (likely(!utask || !utask->active_uprobe)) 13950326f5a9SSrikar Dronamraju return false; 13960326f5a9SSrikar Dronamraju 13970326f5a9SSrikar Dronamraju WARN_ON_ONCE(utask->state != UTASK_SSTEP); 13980326f5a9SSrikar Dronamraju 13990326f5a9SSrikar Dronamraju if (signal_pending(t)) { 14000326f5a9SSrikar Dronamraju spin_lock_irq(&t->sighand->siglock); 14010326f5a9SSrikar Dronamraju clear_tsk_thread_flag(t, TIF_SIGPENDING); 14020326f5a9SSrikar Dronamraju spin_unlock_irq(&t->sighand->siglock); 14030326f5a9SSrikar Dronamraju 14040326f5a9SSrikar Dronamraju if (__fatal_signal_pending(t) || arch_uprobe_xol_was_trapped(t)) { 14050326f5a9SSrikar Dronamraju utask->state = UTASK_SSTEP_TRAPPED; 14060326f5a9SSrikar Dronamraju set_tsk_thread_flag(t, TIF_UPROBE); 14070326f5a9SSrikar Dronamraju set_tsk_thread_flag(t, TIF_NOTIFY_RESUME); 14080326f5a9SSrikar Dronamraju } 14090326f5a9SSrikar Dronamraju } 14100326f5a9SSrikar Dronamraju 14110326f5a9SSrikar Dronamraju return true; 14120326f5a9SSrikar Dronamraju } 14130326f5a9SSrikar Dronamraju 14140326f5a9SSrikar Dronamraju /* 14150326f5a9SSrikar Dronamraju * Avoid singlestepping the original instruction if the original instruction 14160326f5a9SSrikar Dronamraju * is a NOP or can be emulated. 14170326f5a9SSrikar Dronamraju */ 14180326f5a9SSrikar Dronamraju static bool can_skip_sstep(struct uprobe *uprobe, struct pt_regs *regs) 14190326f5a9SSrikar Dronamraju { 142071434f2fSOleg Nesterov if (test_bit(UPROBE_SKIP_SSTEP, &uprobe->flags)) { 14210326f5a9SSrikar Dronamraju if (arch_uprobe_skip_sstep(&uprobe->arch, regs)) 14220326f5a9SSrikar Dronamraju return true; 142371434f2fSOleg Nesterov clear_bit(UPROBE_SKIP_SSTEP, &uprobe->flags); 14240578a970SOleg Nesterov } 14250326f5a9SSrikar Dronamraju return false; 14260326f5a9SSrikar Dronamraju } 14270326f5a9SSrikar Dronamraju 1428499a4f3eSOleg Nesterov static void mmf_recalc_uprobes(struct mm_struct *mm) 1429499a4f3eSOleg Nesterov { 1430499a4f3eSOleg Nesterov struct vm_area_struct *vma; 1431499a4f3eSOleg Nesterov 1432499a4f3eSOleg Nesterov for (vma = mm->mmap; vma; vma = vma->vm_next) { 1433499a4f3eSOleg Nesterov if (!valid_vma(vma, false)) 1434499a4f3eSOleg Nesterov continue; 1435499a4f3eSOleg Nesterov /* 1436499a4f3eSOleg Nesterov * This is not strictly accurate, we can race with 1437499a4f3eSOleg Nesterov * uprobe_unregister() and see the already removed 1438499a4f3eSOleg Nesterov * uprobe if delete_uprobe() was not yet called. 143963633cbfSOleg Nesterov * Or this uprobe can be filtered out. 1440499a4f3eSOleg Nesterov */ 1441499a4f3eSOleg Nesterov if (vma_has_uprobes(vma, vma->vm_start, vma->vm_end)) 1442499a4f3eSOleg Nesterov return; 1443499a4f3eSOleg Nesterov } 1444499a4f3eSOleg Nesterov 1445499a4f3eSOleg Nesterov clear_bit(MMF_HAS_UPROBES, &mm->flags); 1446499a4f3eSOleg Nesterov } 1447499a4f3eSOleg Nesterov 14480908ad6eSAnanth N Mavinakayanahalli static int is_trap_at_addr(struct mm_struct *mm, unsigned long vaddr) 1449ec75fba9SOleg Nesterov { 1450ec75fba9SOleg Nesterov struct page *page; 1451ec75fba9SOleg Nesterov uprobe_opcode_t opcode; 1452ec75fba9SOleg Nesterov int result; 1453ec75fba9SOleg Nesterov 1454ec75fba9SOleg Nesterov pagefault_disable(); 1455ec75fba9SOleg Nesterov result = __copy_from_user_inatomic(&opcode, (void __user*)vaddr, 1456ec75fba9SOleg Nesterov sizeof(opcode)); 1457ec75fba9SOleg Nesterov pagefault_enable(); 1458ec75fba9SOleg Nesterov 1459ec75fba9SOleg Nesterov if (likely(result == 0)) 1460ec75fba9SOleg Nesterov goto out; 1461ec75fba9SOleg Nesterov 1462ec75fba9SOleg Nesterov result = get_user_pages(NULL, mm, vaddr, 1, 0, 1, &page, NULL); 1463ec75fba9SOleg Nesterov if (result < 0) 1464ec75fba9SOleg Nesterov return result; 1465ec75fba9SOleg Nesterov 1466ab0d805cSOleg Nesterov copy_from_page(page, vaddr, &opcode, UPROBE_SWBP_INSN_SIZE); 1467ec75fba9SOleg Nesterov put_page(page); 1468ec75fba9SOleg Nesterov out: 14690908ad6eSAnanth N Mavinakayanahalli /* This needs to return true for any variant of the trap insn */ 14700908ad6eSAnanth N Mavinakayanahalli return is_trap_insn(&opcode); 1471ec75fba9SOleg Nesterov } 1472ec75fba9SOleg Nesterov 1473d790d346SOleg Nesterov static struct uprobe *find_active_uprobe(unsigned long bp_vaddr, int *is_swbp) 14740326f5a9SSrikar Dronamraju { 14753a9ea052SOleg Nesterov struct mm_struct *mm = current->mm; 14763a9ea052SOleg Nesterov struct uprobe *uprobe = NULL; 14770326f5a9SSrikar Dronamraju struct vm_area_struct *vma; 14780326f5a9SSrikar Dronamraju 14790326f5a9SSrikar Dronamraju down_read(&mm->mmap_sem); 14800326f5a9SSrikar Dronamraju vma = find_vma(mm, bp_vaddr); 14813a9ea052SOleg Nesterov if (vma && vma->vm_start <= bp_vaddr) { 14823a9ea052SOleg Nesterov if (valid_vma(vma, false)) { 1483f281769eSOleg Nesterov struct inode *inode = file_inode(vma->vm_file); 1484cb113b47SOleg Nesterov loff_t offset = vaddr_to_offset(vma, bp_vaddr); 14850326f5a9SSrikar Dronamraju 14860326f5a9SSrikar Dronamraju uprobe = find_uprobe(inode, offset); 14870326f5a9SSrikar Dronamraju } 1488d790d346SOleg Nesterov 1489d790d346SOleg Nesterov if (!uprobe) 14900908ad6eSAnanth N Mavinakayanahalli *is_swbp = is_trap_at_addr(mm, bp_vaddr); 1491d790d346SOleg Nesterov } else { 1492d790d346SOleg Nesterov *is_swbp = -EFAULT; 14933a9ea052SOleg Nesterov } 1494499a4f3eSOleg Nesterov 1495499a4f3eSOleg Nesterov if (!uprobe && test_and_clear_bit(MMF_RECALC_UPROBES, &mm->flags)) 1496499a4f3eSOleg Nesterov mmf_recalc_uprobes(mm); 14970326f5a9SSrikar Dronamraju up_read(&mm->mmap_sem); 14980326f5a9SSrikar Dronamraju 14993a9ea052SOleg Nesterov return uprobe; 15003a9ea052SOleg Nesterov } 15013a9ea052SOleg Nesterov 1502da1816b1SOleg Nesterov static void handler_chain(struct uprobe *uprobe, struct pt_regs *regs) 1503da1816b1SOleg Nesterov { 1504da1816b1SOleg Nesterov struct uprobe_consumer *uc; 1505da1816b1SOleg Nesterov int remove = UPROBE_HANDLER_REMOVE; 1506da1816b1SOleg Nesterov 1507da1816b1SOleg Nesterov down_read(&uprobe->register_rwsem); 1508da1816b1SOleg Nesterov for (uc = uprobe->consumers; uc; uc = uc->next) { 1509da1816b1SOleg Nesterov int rc = uc->handler(uc, regs); 1510da1816b1SOleg Nesterov 1511da1816b1SOleg Nesterov WARN(rc & ~UPROBE_HANDLER_MASK, 1512da1816b1SOleg Nesterov "bad rc=0x%x from %pf()\n", rc, uc->handler); 1513da1816b1SOleg Nesterov remove &= rc; 1514da1816b1SOleg Nesterov } 1515da1816b1SOleg Nesterov 1516da1816b1SOleg Nesterov if (remove && uprobe->consumers) { 1517da1816b1SOleg Nesterov WARN_ON(!uprobe_is_active(uprobe)); 1518da1816b1SOleg Nesterov unapply_uprobe(uprobe, current->mm); 1519da1816b1SOleg Nesterov } 1520da1816b1SOleg Nesterov up_read(&uprobe->register_rwsem); 1521da1816b1SOleg Nesterov } 1522da1816b1SOleg Nesterov 15233a9ea052SOleg Nesterov /* 15243a9ea052SOleg Nesterov * Run handler and ask thread to singlestep. 15253a9ea052SOleg Nesterov * Ensure all non-fatal signals cannot interrupt thread while it singlesteps. 15263a9ea052SOleg Nesterov */ 15273a9ea052SOleg Nesterov static void handle_swbp(struct pt_regs *regs) 15283a9ea052SOleg Nesterov { 15293a9ea052SOleg Nesterov struct uprobe *uprobe; 15303a9ea052SOleg Nesterov unsigned long bp_vaddr; 153156bb4cf6SOleg Nesterov int uninitialized_var(is_swbp); 15323a9ea052SOleg Nesterov 15333a9ea052SOleg Nesterov bp_vaddr = uprobe_get_swbp_addr(regs); 1534d790d346SOleg Nesterov uprobe = find_active_uprobe(bp_vaddr, &is_swbp); 15353a9ea052SOleg Nesterov 15360326f5a9SSrikar Dronamraju if (!uprobe) { 153756bb4cf6SOleg Nesterov if (is_swbp > 0) { 15380326f5a9SSrikar Dronamraju /* No matching uprobe; signal SIGTRAP. */ 15390326f5a9SSrikar Dronamraju send_sig(SIGTRAP, current, 0); 154056bb4cf6SOleg Nesterov } else { 154156bb4cf6SOleg Nesterov /* 154256bb4cf6SOleg Nesterov * Either we raced with uprobe_unregister() or we can't 154356bb4cf6SOleg Nesterov * access this memory. The latter is only possible if 154456bb4cf6SOleg Nesterov * another thread plays with our ->mm. In both cases 154556bb4cf6SOleg Nesterov * we can simply restart. If this vma was unmapped we 154656bb4cf6SOleg Nesterov * can pretend this insn was not executed yet and get 154756bb4cf6SOleg Nesterov * the (correct) SIGSEGV after restart. 154856bb4cf6SOleg Nesterov */ 154956bb4cf6SOleg Nesterov instruction_pointer_set(regs, bp_vaddr); 155056bb4cf6SOleg Nesterov } 15510326f5a9SSrikar Dronamraju return; 15520326f5a9SSrikar Dronamraju } 155374e59dfcSOleg Nesterov 155474e59dfcSOleg Nesterov /* change it in advance for ->handler() and restart */ 155574e59dfcSOleg Nesterov instruction_pointer_set(regs, bp_vaddr); 155674e59dfcSOleg Nesterov 1557142b18ddSOleg Nesterov /* 1558142b18ddSOleg Nesterov * TODO: move copy_insn/etc into _register and remove this hack. 1559142b18ddSOleg Nesterov * After we hit the bp, _unregister + _register can install the 1560142b18ddSOleg Nesterov * new and not-yet-analyzed uprobe at the same address, restart. 1561142b18ddSOleg Nesterov */ 1562142b18ddSOleg Nesterov smp_rmb(); /* pairs with wmb() in install_breakpoint() */ 156371434f2fSOleg Nesterov if (unlikely(!test_bit(UPROBE_COPY_INSN, &uprobe->flags))) 156474e59dfcSOleg Nesterov goto out; 15650326f5a9SSrikar Dronamraju 15660326f5a9SSrikar Dronamraju handler_chain(uprobe, regs); 15670578a970SOleg Nesterov if (can_skip_sstep(uprobe, regs)) 15680578a970SOleg Nesterov goto out; 15690326f5a9SSrikar Dronamraju 1570608e7427SOleg Nesterov if (!pre_ssout(uprobe, regs, bp_vaddr)) 15710326f5a9SSrikar Dronamraju return; 15720326f5a9SSrikar Dronamraju 157374e59dfcSOleg Nesterov /* can_skip_sstep() succeeded, or restart if can't singlestep */ 15740578a970SOleg Nesterov out: 15750326f5a9SSrikar Dronamraju put_uprobe(uprobe); 15760326f5a9SSrikar Dronamraju } 15770326f5a9SSrikar Dronamraju 15780326f5a9SSrikar Dronamraju /* 15790326f5a9SSrikar Dronamraju * Perform required fix-ups and disable singlestep. 15800326f5a9SSrikar Dronamraju * Allow pending signals to take effect. 15810326f5a9SSrikar Dronamraju */ 15820326f5a9SSrikar Dronamraju static void handle_singlestep(struct uprobe_task *utask, struct pt_regs *regs) 15830326f5a9SSrikar Dronamraju { 15840326f5a9SSrikar Dronamraju struct uprobe *uprobe; 15850326f5a9SSrikar Dronamraju 15860326f5a9SSrikar Dronamraju uprobe = utask->active_uprobe; 15870326f5a9SSrikar Dronamraju if (utask->state == UTASK_SSTEP_ACK) 15880326f5a9SSrikar Dronamraju arch_uprobe_post_xol(&uprobe->arch, regs); 15890326f5a9SSrikar Dronamraju else if (utask->state == UTASK_SSTEP_TRAPPED) 15900326f5a9SSrikar Dronamraju arch_uprobe_abort_xol(&uprobe->arch, regs); 15910326f5a9SSrikar Dronamraju else 15920326f5a9SSrikar Dronamraju WARN_ON_ONCE(1); 15930326f5a9SSrikar Dronamraju 15940326f5a9SSrikar Dronamraju put_uprobe(uprobe); 15950326f5a9SSrikar Dronamraju utask->active_uprobe = NULL; 15960326f5a9SSrikar Dronamraju utask->state = UTASK_RUNNING; 1597d4b3b638SSrikar Dronamraju xol_free_insn_slot(current); 15980326f5a9SSrikar Dronamraju 15990326f5a9SSrikar Dronamraju spin_lock_irq(¤t->sighand->siglock); 16000326f5a9SSrikar Dronamraju recalc_sigpending(); /* see uprobe_deny_signal() */ 16010326f5a9SSrikar Dronamraju spin_unlock_irq(¤t->sighand->siglock); 16020326f5a9SSrikar Dronamraju } 16030326f5a9SSrikar Dronamraju 16040326f5a9SSrikar Dronamraju /* 16051b08e907SOleg Nesterov * On breakpoint hit, breakpoint notifier sets the TIF_UPROBE flag and 16061b08e907SOleg Nesterov * allows the thread to return from interrupt. After that handle_swbp() 16071b08e907SOleg Nesterov * sets utask->active_uprobe. 16080326f5a9SSrikar Dronamraju * 16091b08e907SOleg Nesterov * On singlestep exception, singlestep notifier sets the TIF_UPROBE flag 16101b08e907SOleg Nesterov * and allows the thread to return from interrupt. 16110326f5a9SSrikar Dronamraju * 16120326f5a9SSrikar Dronamraju * While returning to userspace, thread notices the TIF_UPROBE flag and calls 16130326f5a9SSrikar Dronamraju * uprobe_notify_resume(). 16140326f5a9SSrikar Dronamraju */ 16150326f5a9SSrikar Dronamraju void uprobe_notify_resume(struct pt_regs *regs) 16160326f5a9SSrikar Dronamraju { 16170326f5a9SSrikar Dronamraju struct uprobe_task *utask; 16180326f5a9SSrikar Dronamraju 1619db023ea5SOleg Nesterov clear_thread_flag(TIF_UPROBE); 1620db023ea5SOleg Nesterov 16210326f5a9SSrikar Dronamraju utask = current->utask; 16221b08e907SOleg Nesterov if (utask && utask->active_uprobe) 16230326f5a9SSrikar Dronamraju handle_singlestep(utask, regs); 16241b08e907SOleg Nesterov else 16251b08e907SOleg Nesterov handle_swbp(regs); 16260326f5a9SSrikar Dronamraju } 16270326f5a9SSrikar Dronamraju 16280326f5a9SSrikar Dronamraju /* 16290326f5a9SSrikar Dronamraju * uprobe_pre_sstep_notifier gets called from interrupt context as part of 16300326f5a9SSrikar Dronamraju * notifier mechanism. Set TIF_UPROBE flag and indicate breakpoint hit. 16310326f5a9SSrikar Dronamraju */ 16320326f5a9SSrikar Dronamraju int uprobe_pre_sstep_notifier(struct pt_regs *regs) 16330326f5a9SSrikar Dronamraju { 1634f8ac4ec9SOleg Nesterov if (!current->mm || !test_bit(MMF_HAS_UPROBES, ¤t->mm->flags)) 16350326f5a9SSrikar Dronamraju return 0; 16360326f5a9SSrikar Dronamraju 16370326f5a9SSrikar Dronamraju set_thread_flag(TIF_UPROBE); 16380326f5a9SSrikar Dronamraju return 1; 16390326f5a9SSrikar Dronamraju } 16400326f5a9SSrikar Dronamraju 16410326f5a9SSrikar Dronamraju /* 16420326f5a9SSrikar Dronamraju * uprobe_post_sstep_notifier gets called in interrupt context as part of notifier 16430326f5a9SSrikar Dronamraju * mechanism. Set TIF_UPROBE flag and indicate completion of singlestep. 16440326f5a9SSrikar Dronamraju */ 16450326f5a9SSrikar Dronamraju int uprobe_post_sstep_notifier(struct pt_regs *regs) 16460326f5a9SSrikar Dronamraju { 16470326f5a9SSrikar Dronamraju struct uprobe_task *utask = current->utask; 16480326f5a9SSrikar Dronamraju 16490326f5a9SSrikar Dronamraju if (!current->mm || !utask || !utask->active_uprobe) 16500326f5a9SSrikar Dronamraju /* task is currently not uprobed */ 16510326f5a9SSrikar Dronamraju return 0; 16520326f5a9SSrikar Dronamraju 16530326f5a9SSrikar Dronamraju utask->state = UTASK_SSTEP_ACK; 16540326f5a9SSrikar Dronamraju set_thread_flag(TIF_UPROBE); 16550326f5a9SSrikar Dronamraju return 1; 16560326f5a9SSrikar Dronamraju } 16570326f5a9SSrikar Dronamraju 16580326f5a9SSrikar Dronamraju static struct notifier_block uprobe_exception_nb = { 16590326f5a9SSrikar Dronamraju .notifier_call = arch_uprobe_exception_notify, 16600326f5a9SSrikar Dronamraju .priority = INT_MAX-1, /* notified after kprobes, kgdb */ 16610326f5a9SSrikar Dronamraju }; 16620326f5a9SSrikar Dronamraju 1663a5f4374aSIngo Molnar static int __init init_uprobes(void) 1664a5f4374aSIngo Molnar { 1665a5f4374aSIngo Molnar int i; 1666a5f4374aSIngo Molnar 166766d06dffSOleg Nesterov for (i = 0; i < UPROBES_HASH_SZ; i++) 1668a5f4374aSIngo Molnar mutex_init(&uprobes_mmap_mutex[i]); 16690326f5a9SSrikar Dronamraju 167032cdba1eSOleg Nesterov if (percpu_init_rwsem(&dup_mmap_sem)) 167132cdba1eSOleg Nesterov return -ENOMEM; 167232cdba1eSOleg Nesterov 16730326f5a9SSrikar Dronamraju return register_die_notifier(&uprobe_exception_nb); 1674a5f4374aSIngo Molnar } 16750326f5a9SSrikar Dronamraju module_init(init_uprobes); 1676a5f4374aSIngo Molnar 1677a5f4374aSIngo Molnar static void __exit exit_uprobes(void) 1678a5f4374aSIngo Molnar { 1679a5f4374aSIngo Molnar } 1680a5f4374aSIngo Molnar module_exit(exit_uprobes); 1681