diff options
Diffstat (limited to 'arch/arm/mach-iop32x/cp6.c')
-rw-r--r-- | arch/arm/mach-iop32x/cp6.c | 48 |
1 files changed, 48 insertions, 0 deletions
diff --git a/arch/arm/mach-iop32x/cp6.c b/arch/arm/mach-iop32x/cp6.c new file mode 100644 index 000000000..7135a0ac9 --- /dev/null +++ b/arch/arm/mach-iop32x/cp6.c @@ -0,0 +1,48 @@ +// SPDX-License-Identifier: GPL-2.0-only +/* + * IOP Coprocessor-6 access handler + * Copyright (c) 2006, Intel Corporation. + */ +#include <linux/init.h> +#include <asm/traps.h> +#include <asm/ptrace.h> + +#include "iop3xx.h" + +void iop_enable_cp6(void) +{ + u32 temp; + + /* enable cp6 access */ + asm volatile ( + "mrc p15, 0, %0, c15, c1, 0\n\t" + "orr %0, %0, #(1 << 6)\n\t" + "mcr p15, 0, %0, c15, c1, 0\n\t" + "mrc p15, 0, %0, c15, c1, 0\n\t" + "mov %0, %0\n\t" + "sub pc, pc, #4 @ cp_wait\n\t" + : "=r"(temp)); +} + +static int cp6_trap(struct pt_regs *regs, unsigned int instr) +{ + iop_enable_cp6(); + + return 0; +} + +/* permit kernel space cp6 access + * deny user space cp6 access + */ +static struct undef_hook cp6_hook = { + .instr_mask = 0x0f000ff0, + .instr_val = 0x0e000610, + .cpsr_mask = MODE_MASK, + .cpsr_val = SVC_MODE, + .fn = cp6_trap, +}; + +void __init iop_init_cp6_handler(void) +{ + register_undef_hook(&cp6_hook); +} |