|  | // SPDX-License-Identifier: GPL-2.0 | 
|  | #include <linux/err.h> | 
|  | #include <linux/mm.h> | 
|  | #include <asm/current.h> | 
|  | #include <asm/traps.h> | 
|  | #include <asm/vdso.h> | 
|  |  | 
|  | struct vdso_exception_table_entry { | 
|  | int insn, fixup; | 
|  | }; | 
|  |  | 
|  | bool fixup_vdso_exception(struct pt_regs *regs, int trapnr, | 
|  | unsigned long error_code, unsigned long fault_addr) | 
|  | { | 
|  | const struct vdso_image *image = current->mm->context.vdso_image; | 
|  | const struct vdso_exception_table_entry *extable; | 
|  | unsigned int nr_entries, i; | 
|  | unsigned long base; | 
|  |  | 
|  | /* | 
|  | * Do not attempt to fixup #DB or #BP.  It's impossible to identify | 
|  | * whether or not a #DB/#BP originated from within an SGX enclave and | 
|  | * SGX enclaves are currently the only use case for vDSO fixup. | 
|  | */ | 
|  | if (trapnr == X86_TRAP_DB || trapnr == X86_TRAP_BP) | 
|  | return false; | 
|  |  | 
|  | if (!current->mm->context.vdso) | 
|  | return false; | 
|  |  | 
|  | base =  (unsigned long)current->mm->context.vdso + image->extable_base; | 
|  | nr_entries = image->extable_len / (sizeof(*extable)); | 
|  | extable = image->extable; | 
|  |  | 
|  | for (i = 0; i < nr_entries; i++) { | 
|  | if (regs->ip == base + extable[i].insn) { | 
|  | regs->ip = base + extable[i].fixup; | 
|  | regs->di = trapnr; | 
|  | regs->si = error_code; | 
|  | regs->dx = fault_addr; | 
|  | return true; | 
|  | } | 
|  | } | 
|  |  | 
|  | return false; | 
|  | } |