1 /* SPDX-License-Identifier: GPL-2.0-only */ 2 /* 3 * Copyright (C) 2021 SiFive 4 */ 5 6 #include <linux/linkage.h> 7 #include <asm/asm.h> 8 #include <asm/asm-offsets.h> 9 #include <asm/alternative.h> 10 11 .macro ADD_SIGN_EXT pt_reg badaddr tmp_reg 12 REG_L \badaddr, PT_BADADDR(\pt_reg) 13 li \tmp_reg,1 14 slli \tmp_reg,\tmp_reg,0x26 15 and \tmp_reg,\tmp_reg,\badaddr 16 beqz \tmp_reg, 1f 17 li \tmp_reg,-1 18 slli \tmp_reg,\tmp_reg,0x27 19 or \badaddr,\tmp_reg,\badaddr 20 REG_S \badaddr, PT_BADADDR(\pt_reg) 21 1: 22 .endm 23 24 ENTRY(sifive_cip_453_page_fault_trp) 25 ADD_SIGN_EXT a0, t0, t1 26 #ifdef CONFIG_MMU 27 la t0, do_page_fault 28 #else 29 la t0, do_trap_unknown 30 #endif 31 jr t0 32 END(sifive_cip_453_page_fault_trp) 33 34 ENTRY(sifive_cip_453_insn_fault_trp) 35 ADD_SIGN_EXT a0, t0, t1 36 la t0, do_trap_insn_fault 37 jr t0 38 END(sifive_cip_453_insn_fault_trp) 39