projects / mirror_ubuntu-bionic-kernel.git / blame
| Commit | Line | Data |
|---|---|---|
| ef2f826c HC |
1 | /* |
| 2 | * This file is subject to the terms and conditions of the GNU General Public | |
| 3 | * License. See the file "COPYING" in the main directory of this archive | |
| 4 | * for more details. | |
| 5 | * | |
| 6 | * Copyright (C) 2014 Lemote Corporation. | |
| 7 | * written by Huacai Chen <chenhc@lemote.com> | |
| 8 | * | |
| 9 | * based on arch/mips/cavium-octeon/cpu.c | |
| 10 | * Copyright (C) 2009 Wind River Systems, | |
| 11 | * written by Ralf Baechle <ralf@linux-mips.org> | |
| 12 | */ | |
| 13 | #include <linux/init.h> | |
| 14 | #include <linux/sched.h> | |
| 15 | #include <linux/notifier.h> | |
| fc69910f | 16 | #include <linux/ptrace.h> |
| ef2f826c HC |
17 | |
| 18 | #include <asm/fpu.h> | |
| 19 | #include <asm/cop2.h> | |
| 20 | #include <asm/current.h> | |
| 21 | #include <asm/mipsregs.h> | |
| 22 | ||
| 23 | static int loongson_cu2_call(struct notifier_block *nfb, unsigned long action, | |
| 24 | void *data) | |
| 25 | { | |
| bfcdf130 | 26 | int fpu_owned; |
| ef2f826c HC |
27 | int fr = !test_thread_flag(TIF_32BIT_FPREGS); |
| 28 | ||
| 29 | switch (action) { | |
| 30 | case CU2_EXCEPTION: | |
| 31 | preempt_disable(); | |
| bfcdf130 | 32 | fpu_owned = __is_fpu_owner(); |
| ef2f826c HC |
33 | if (!fr) |
| 34 | set_c0_status(ST0_CU1 | ST0_CU2); | |
| 35 | else | |
| 36 | set_c0_status(ST0_CU1 | ST0_CU2 | ST0_FR); | |
| 37 | enable_fpu_hazard(); | |
| 38 | KSTK_STATUS(current) |= (ST0_CU1 | ST0_CU2); | |
| 39 | if (fr) | |
| 40 | KSTK_STATUS(current) |= ST0_FR; | |
| 41 | else | |
| 42 | KSTK_STATUS(current) &= ~ST0_FR; | |
| bfcdf130 HC |
43 | /* If FPU is owned, we needn't init or restore fp */ |
| 44 | if (!fpu_owned) { | |
| ef2f826c HC |
45 | set_thread_flag(TIF_USEDFPU); |
| 46 | if (!used_math()) { | |
| 9b26616c | 47 | _init_fpu(current->thread.fpu.fcr31); |
| ef2f826c HC |
48 | set_used_math(); |
| 49 | } else | |
| 50 | _restore_fp(current); | |
| 51 | } | |
| 52 | preempt_enable(); | |
| 53 | ||
| 54 | return NOTIFY_STOP; /* Don't call default notifier */ | |
| 55 | } | |
| 56 | ||
| 57 | return NOTIFY_OK; /* Let default notifier send signals */ | |
| 58 | } | |
| 59 | ||
| 60 | static int __init loongson_cu2_setup(void) | |
| 61 | { | |
| 62 | return cu2_notifier(loongson_cu2_call, 0); | |
| 63 | } | |
| 64 | early_initcall(loongson_cu2_setup); |