| 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) 2009 Wind River Systems, |
| 7 |
* written by Ralf Baechle <[email protected]> |
| 8 |
*/ |
| 9 |
#include <linux/init.h> |
| 10 |
#include <linux/irqflags.h> |
| 11 |
#include <linux/notifier.h> |
| 12 |
#include <linux/prefetch.h> |
| 13 |
#include <linux/ptrace.h> |
| 14 |
#include <linux/sched.h> |
| 15 |
#include <linux/sched/task_stack.h> |
| 16 |
|
| 17 |
#include <asm/cop2.h> |
| 18 |
#include <asm/current.h> |
| 19 |
#include <asm/mipsregs.h> |
| 20 |
#include <asm/page.h> |
| 21 |
#include <asm/octeon/octeon.h> |
| 22 |
|
| 23 |
static int cnmips_cu2_call(struct notifier_block *nfb, unsigned long action, |
| 24 |
void *data) |
| 25 |
{ |
| 26 |
unsigned long flags; |
| 27 |
unsigned int status; |
| 28 |
|
| 29 |
switch (action) { |
| 30 |
case CU2_EXCEPTION: |
| 31 |
prefetch(¤t->thread.cp2); |
| 32 |
local_irq_save(flags); |
| 33 |
KSTK_STATUS(current) |= ST0_CU2; |
| 34 |
status = read_c0_status(); |
| 35 |
write_c0_status(status | ST0_CU2); |
| 36 |
octeon_cop2_restore(&(current->thread.cp2)); |
| 37 |
write_c0_status(status & ~ST0_CU2); |
| 38 |
local_irq_restore(flags); |
| 39 |
|
| 40 |
return NOTIFY_BAD; /* Don't call default notifier */ |
| 41 |
} |
| 42 |
|
| 43 |
return NOTIFY_OK; /* Let default notifier send signals */ |
| 44 |
} |
| 45 |
|
| 46 |
static int __init cnmips_cu2_setup(void) |
| 47 |
{ |
| 48 |
return cu2_notifier(cnmips_cu2_call, 0); |
| 49 |
} |
| 50 |
early_initcall(cnmips_cu2_setup); |