forked from Qortal/Brooklyn
You can not select more than 25 topics
Topics must start with a letter or number, can include dashes ('-') and can be up to 35 characters long.
126 lines
3.1 KiB
126 lines
3.1 KiB
// SPDX-License-Identifier: GPL-2.0 |
|
|
|
#include <linux/kernel.h> |
|
#include <linux/kgdb.h> |
|
#include <linux/printk.h> |
|
#include <linux/sched/debug.h> |
|
#include <linux/delay.h> |
|
#include <linux/reboot.h> |
|
|
|
#include <asm/pdc.h> |
|
#include <asm/pdc_chassis.h> |
|
#include <asm/ldcw.h> |
|
#include <asm/processor.h> |
|
|
|
static unsigned int __aligned(16) toc_lock = 1; |
|
DEFINE_PER_CPU_PAGE_ALIGNED(char [16384], toc_stack) __visible; |
|
|
|
static void toc20_to_pt_regs(struct pt_regs *regs, struct pdc_toc_pim_20 *toc) |
|
{ |
|
int i; |
|
|
|
regs->gr[0] = (unsigned long)toc->cr[22]; |
|
|
|
for (i = 1; i < 32; i++) |
|
regs->gr[i] = (unsigned long)toc->gr[i]; |
|
|
|
for (i = 0; i < 8; i++) |
|
regs->sr[i] = (unsigned long)toc->sr[i]; |
|
|
|
regs->iasq[0] = (unsigned long)toc->cr[17]; |
|
regs->iasq[1] = (unsigned long)toc->iasq_back; |
|
regs->iaoq[0] = (unsigned long)toc->cr[18]; |
|
regs->iaoq[1] = (unsigned long)toc->iaoq_back; |
|
|
|
regs->sar = (unsigned long)toc->cr[11]; |
|
regs->iir = (unsigned long)toc->cr[19]; |
|
regs->isr = (unsigned long)toc->cr[20]; |
|
regs->ior = (unsigned long)toc->cr[21]; |
|
} |
|
|
|
static void toc11_to_pt_regs(struct pt_regs *regs, struct pdc_toc_pim_11 *toc) |
|
{ |
|
int i; |
|
|
|
regs->gr[0] = toc->cr[22]; |
|
|
|
for (i = 1; i < 32; i++) |
|
regs->gr[i] = toc->gr[i]; |
|
|
|
for (i = 0; i < 8; i++) |
|
regs->sr[i] = toc->sr[i]; |
|
|
|
regs->iasq[0] = toc->cr[17]; |
|
regs->iasq[1] = toc->iasq_back; |
|
regs->iaoq[0] = toc->cr[18]; |
|
regs->iaoq[1] = toc->iaoq_back; |
|
|
|
regs->sar = toc->cr[11]; |
|
regs->iir = toc->cr[19]; |
|
regs->isr = toc->cr[20]; |
|
regs->ior = toc->cr[21]; |
|
} |
|
|
|
void notrace __noreturn __cold toc_intr(struct pt_regs *regs) |
|
{ |
|
struct pdc_toc_pim_20 pim_data20; |
|
struct pdc_toc_pim_11 pim_data11; |
|
|
|
/* verify we wrote regs to the correct stack */ |
|
BUG_ON(regs != (struct pt_regs *)&per_cpu(toc_stack, raw_smp_processor_id())); |
|
|
|
if (boot_cpu_data.cpu_type >= pcxu) { |
|
if (pdc_pim_toc20(&pim_data20)) |
|
panic("Failed to get PIM data"); |
|
toc20_to_pt_regs(regs, &pim_data20); |
|
} else { |
|
if (pdc_pim_toc11(&pim_data11)) |
|
panic("Failed to get PIM data"); |
|
toc11_to_pt_regs(regs, &pim_data11); |
|
} |
|
|
|
#ifdef CONFIG_KGDB |
|
nmi_enter(); |
|
|
|
if (atomic_read(&kgdb_active) != -1) |
|
kgdb_nmicallback(raw_smp_processor_id(), regs); |
|
kgdb_handle_exception(9, SIGTRAP, 0, regs); |
|
#endif |
|
|
|
/* serialize output, otherwise all CPUs write backtrace at once */ |
|
while (__ldcw(&toc_lock) == 0) |
|
; /* wait */ |
|
show_regs(regs); |
|
toc_lock = 1; /* release lock for next CPU */ |
|
|
|
if (raw_smp_processor_id() != 0) |
|
while (1) ; /* all but monarch CPU will wait endless. */ |
|
|
|
/* give other CPUs time to show their backtrace */ |
|
mdelay(2000); |
|
|
|
machine_restart("TOC"); |
|
|
|
/* should never reach this */ |
|
panic("TOC"); |
|
} |
|
|
|
static __init int setup_toc(void) |
|
{ |
|
unsigned int csum = 0; |
|
unsigned long toc_code = (unsigned long)dereference_function_descriptor(toc_handler); |
|
int i; |
|
|
|
PAGE0->vec_toc = __pa(toc_code) & 0xffffffff; |
|
#ifdef CONFIG_64BIT |
|
PAGE0->vec_toc_hi = __pa(toc_code) >> 32; |
|
#endif |
|
PAGE0->vec_toclen = toc_handler_size; |
|
|
|
for (i = 0; i < toc_handler_size/4; i++) |
|
csum += ((u32 *)toc_code)[i]; |
|
toc_handler_csum = -csum; |
|
pr_info("TOC handler registered\n"); |
|
return 0; |
|
} |
|
early_initcall(setup_toc);
|
|
|