// 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);