[J-u-boot.git] / cpu / mpc83xx / traps.c

/*
 * (C) Copyright 2000
 * Wolfgang Denk, DENX Software Engineering, [email protected].
 *
 * Copyright (C) 1995-1996  Gary Thomas ([email protected])
 *
 * This program is free software; you can redistribute it and/or
 * modify it under the terms of the GNU General Public License as
 * published by the Free Software Foundation; either version 2 of
 * the License, or (at your option) any later version.
 *
 * This program is distributed in the hope that it will be useful,
 * but WITHOUT ANY WARRANTY; without even the implied warranty of
 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
 * GNU General Public License for more details.
 *
 * You should have received a copy of the GNU General Public License
 * along with this program; if not, write to the Free Software
 * Foundation, Inc., 59 Temple Place, Suite 330, Boston,
 * MA 02111-1307 USA
 */

/*
 * This file handles the architecture-dependent parts of hardware
 * exceptions
 */

#include <common.h>
#include <command.h>
#include <asm/processor.h>
#include <asm/mpc8349_pci.h>

DECLARE_GLOBAL_DATA_PTR;

/* Returns 0 if exception not found and fixup otherwise.  */
extern unsigned long search_exception_table(unsigned long);

#define END_OF_MEM	(gd->bd->bi_memstart + gd->bd->bi_memsize)

/*
 * Trap & Exception support
 */

void
print_backtrace(unsigned long *sp)
{
	int cnt = 0;
	unsigned long i;

	puts ("Call backtrace: ");
	while (sp) {
		if ((uint)sp > END_OF_MEM)
			break;

		i = sp[1];
		if (cnt++ % 7 == 0)
			putc ('\n');
		printf("%08lX ", i);
		if (cnt > 32) break;
		sp = (unsigned long *)*sp;
	}
	putc ('\n');
}

void show_regs(struct pt_regs * regs)
{
	int i;

	printf("NIP: %08lX XER: %08lX LR: %08lX REGS: %p TRAP: %04lx DAR: %08lX\n",
	       regs->nip, regs->xer, regs->link, regs, regs->trap, regs->dar);
	printf("MSR: %08lx EE: %01x PR: %01x FP: %01x ME: %01x IR/DR: %01x%01x\n",
	       regs->msr, regs->msr&MSR_EE ? 1 : 0, regs->msr&MSR_PR ? 1 : 0,
	       regs->msr & MSR_FP ? 1 : 0,regs->msr&MSR_ME ? 1 : 0,
	       regs->msr&MSR_IR ? 1 : 0,
	       regs->msr&MSR_DR ? 1 : 0);

	putc ('\n');
	for (i = 0;  i < 32;  i++) {
		if ((i % 8) == 0) {
			printf("GPR%02d: ", i);
		}

		printf("%08lX ", regs->gpr[i]);
		if ((i % 8) == 7) {
			putc ('\n');
		}
	}
}


void
_exception(int signr, struct pt_regs *regs)
{
	show_regs(regs);
	print_backtrace((unsigned long *)regs->gpr[1]);
	panic("Exception in kernel pc %lx signal %d",regs->nip,signr);
}

#ifdef CONFIG_PCI
void dump_pci (void)
{
/*
	volatile immap_t *immap = (immap_t *) CONFIG_SYS_IMMR;
	printf ("PCI: err status %x err mask %x err ctrl %x\n",
		le32_to_cpu (immap->im_pci.pci_esr),
		le32_to_cpu (immap->im_pci.pci_emr),
		le32_to_cpu (immap->im_pci.pci_ecr));
	printf ("     error address %x error data %x ctrl %x\n",
		le32_to_cpu (immap->im_pci.pci_eacr),
		le32_to_cpu (immap->im_pci.pci_edcr),
		le32_to_cpu (immap->im_pci.pci_eccr));
*/
}
#endif

void
MachineCheckException(struct pt_regs *regs)
{
	unsigned long fixup;

	/* Probing PCI using config cycles cause this exception
	 * when a device is not present.  Catch it and return to
	 * the PCI exception handler.
	 */
#ifdef CONFIG_PCI
#if 0
	volatile immap_t *immap  = (immap_t *)CONFIG_SYS_IMMR;
#ifdef DEBUG
	dump_pci();
#endif
	/* clear the error in the error status register */
	if(immap->im_pci.pci_esr & cpu_to_le32(PCI_ERROR_PCI_NO_RSP)) {
		immap->im_pci.pci_esr = cpu_to_le32(PCI_ERROR_PCI_NO_RSP);
		return;
	}
#endif
#endif /* CONFIG_PCI */
	if ((fixup = search_exception_table(regs->nip)) != 0) {
		regs->nip = fixup;
		return;
	}

#if defined(CONFIG_CMD_KGDB)
	if (debugger_exception_handler && (*debugger_exception_handler)(regs))
		return;
#endif

	puts ("Machine check in kernel mode.\n"
		"Caused by (from msr): ");
	printf("regs %p ",regs);
	switch( regs->msr & 0x000F0000) {
	case (0x80000000>>12):
		puts ("Machine check signal - probably due to mm fault\n"
			"with mmu off\n");
		break;
	case (0x80000000>>13):
		puts ("Transfer error ack signal\n");
		break;
	case (0x80000000>>14):
		puts ("Data parity signal\n");
		break;
	case (0x80000000>>15):
		puts ("Address parity signal\n");
		break;
	default:
		puts ("Unknown values in msr\n");
	}
	show_regs(regs);
	print_backtrace((unsigned long *)regs->gpr[1]);
#ifdef CONFIG_PCI
	dump_pci();
#endif
	panic("machine check");
}

void
AlignmentException(struct pt_regs *regs)
{
#if defined(CONFIG_CMD_KGDB)
	if (debugger_exception_handler && (*debugger_exception_handler)(regs))
		return;
#endif
	show_regs(regs);
	print_backtrace((unsigned long *)regs->gpr[1]);
	panic("Alignment Exception");
}

void
ProgramCheckException(struct pt_regs *regs)
{
#if defined(CONFIG_CMD_KGDB)
	if (debugger_exception_handler && (*debugger_exception_handler)(regs))
		return;
#endif
	show_regs(regs);
	print_backtrace((unsigned long *)regs->gpr[1]);
	panic("Program Check Exception");
}

void
SoftEmuException(struct pt_regs *regs)
{
#if defined(CONFIG_CMD_KGDB)
	if (debugger_exception_handler && (*debugger_exception_handler)(regs))
		return;
#endif
	show_regs(regs);
	print_backtrace((unsigned long *)regs->gpr[1]);
	panic("Software Emulation Exception");
}


void
UnknownException(struct pt_regs *regs)
{
#if defined(CONFIG_CMD_KGDB)
	if (debugger_exception_handler && (*debugger_exception_handler)(regs))
		return;
#endif
	printf("Bad trap at PC: %lx, SR: %lx, vector=%lx\n",
	       regs->nip, regs->msr, regs->trap);
	_exception(0, regs);
}

#if defined(CONFIG_CMD_BEDBUG)
extern void do_bedbug_breakpoint(struct pt_regs *);
#endif

void
DebugException(struct pt_regs *regs)
{
	printf("Debugger trap at @ %lx\n", regs->nip );
	show_regs(regs);
#if defined(CONFIG_CMD_BEDBUG)
	do_bedbug_breakpoint( regs );
#endif
}

/* Probe an address by reading.  If not present, return -1, otherwise
 * return 0.
 */
int
addr_probe(uint *addr)
{
#if 0
	int	retval;

	__asm__ __volatile__(			\
		"1:	lwz %0,0(%1)\n"		\
		"	eieio\n"		\
		"	li %0,0\n"		\
		"2:\n"				\
		".section .fixup,\"ax\"\n"	\
		"3:	li %0,-1\n"		\
		"	b 2b\n"			\
		".section __ex_table,\"a\"\n"	\
		"	.align 2\n"		\
		"	.long 1b,3b\n"		\
		".text"				\
		: "=r" (retval) : "r"(addr));

	return (retval);
#endif
	return 0;
}
Commit	Line	Data
f046ccd1	1	/*
e857a5bd TT	2	* (C) Copyright 2000
	3	* Wolfgang Denk, DENX Software Engineering, [email protected].
	4	*
	5	* Copyright (C) 1995-1996 Gary Thomas ([email protected])
f046ccd1 EL	6	*
	7	* This program is free software; you can redistribute it and/or
	8	* modify it under the terms of the GNU General Public License as
	9	* published by the Free Software Foundation; either version 2 of
	10	* the License, or (at your option) any later version.
	11	*
	12	* This program is distributed in the hope that it will be useful,
	13	* but WITHOUT ANY WARRANTY; without even the implied warranty of
	14	* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
	15	* GNU General Public License for more details.
	16	*
	17	* You should have received a copy of the GNU General Public License
	18	* along with this program; if not, write to the Free Software
	19	* Foundation, Inc., 59 Temple Place, Suite 330, Boston,
	20	* MA 02111-1307 USA
f046ccd1 EL	21	*/
	22
	23	/*
	24	* This file handles the architecture-dependent parts of hardware
	25	* exceptions
	26	*/
	27
	28	#include <common.h>
	29	#include <command.h>
	30	#include <asm/processor.h>
	31	#include <asm/mpc8349_pci.h>
	32
d87080b7 WD	33	DECLARE_GLOBAL_DATA_PTR;
d87080b7 WD	34
f046ccd1 EL	35	/* Returns 0 if exception not found and fixup otherwise. */
	36	extern unsigned long search_exception_table(unsigned long);
	37
	38	#define END_OF_MEM (gd->bd->bi_memstart + gd->bd->bi_memsize)
	39
	40	/*
	41	* Trap & Exception support
	42	*/
	43
	44	void
	45	print_backtrace(unsigned long *sp)
	46	{
f046ccd1 EL	47	int cnt = 0;
	48	unsigned long i;
	49
	50	puts ("Call backtrace: ");
	51	while (sp) {
	52	if ((uint)sp > END_OF_MEM)
	53	break;
	54
	55	i = sp[1];
	56	if (cnt++ % 7 == 0)
	57	putc ('\n');
	58	printf("%08lX ", i);
	59	if (cnt > 32) break;
	60	sp = (unsigned long )sp;
	61	}
	62	putc ('\n');
	63	}
	64
	65	void show_regs(struct pt_regs * regs)
	66	{
	67	int i;
	68
	69	printf("NIP: %08lX XER: %08lX LR: %08lX REGS: %p TRAP: %04lx DAR: %08lX\n",
	70	regs->nip, regs->xer, regs->link, regs, regs->trap, regs->dar);
	71	printf("MSR: %08lx EE: %01x PR: %01x FP: %01x ME: %01x IR/DR: %01x%01x\n",
	72	regs->msr, regs->msr&MSR_EE ? 1 : 0, regs->msr&MSR_PR ? 1 : 0,
	73	regs->msr & MSR_FP ? 1 : 0,regs->msr&MSR_ME ? 1 : 0,
	74	regs->msr&MSR_IR ? 1 : 0,
	75	regs->msr&MSR_DR ? 1 : 0);
	76
	77	putc ('\n');
	78	for (i = 0; i < 32; i++) {
	79	if ((i % 8) == 0) {
	80	printf("GPR%02d: ", i);
	81	}
	82
	83	printf("%08lX ", regs->gpr[i]);
	84	if ((i % 8) == 7) {
	85	putc ('\n');
	86	}
	87	}
	88	}
	89
	90
	91	void
	92	_exception(int signr, struct pt_regs *regs)
	93	{
	94	show_regs(regs);
	95	print_backtrace((unsigned long *)regs->gpr[1]);
	96	panic("Exception in kernel pc %lx signal %d",regs->nip,signr);
	97	}
	98
	99	#ifdef CONFIG_PCI
	100	void dump_pci (void)
	101	{
	102	/*
6d0f6bcf	103	volatile immap_t immap = (immap_t ) CONFIG_SYS_IMMR;
f046ccd1 EL	104	printf ("PCI: err status %x err mask %x err ctrl %x\n",
	105	le32_to_cpu (immap->im_pci.pci_esr),
	106	le32_to_cpu (immap->im_pci.pci_emr),
	107	le32_to_cpu (immap->im_pci.pci_ecr));
	108	printf (" error address %x error data %x ctrl %x\n",
	109	le32_to_cpu (immap->im_pci.pci_eacr),
	110	le32_to_cpu (immap->im_pci.pci_edcr),
	111	le32_to_cpu (immap->im_pci.pci_eccr));
	112	*/
	113	}
	114	#endif
	115
	116	void
	117	MachineCheckException(struct pt_regs *regs)
	118	{
	119	unsigned long fixup;
	120
	121	/* Probing PCI using config cycles cause this exception
	122	* when a device is not present. Catch it and return to
	123	* the PCI exception handler.
	124	*/
	125	#ifdef CONFIG_PCI
	126	#if 0
6d0f6bcf	127	volatile immap_t immap = (immap_t )CONFIG_SYS_IMMR;
f046ccd1 EL	128	#ifdef DEBUG
	129	dump_pci();
	130	#endif
	131	/* clear the error in the error status register */
	132	if(immap->im_pci.pci_esr & cpu_to_le32(PCI_ERROR_PCI_NO_RSP)) {
	133	immap->im_pci.pci_esr = cpu_to_le32(PCI_ERROR_PCI_NO_RSP);
	134	return;
	135	}
	136	#endif
	137	#endif /* CONFIG_PCI */
	138	if ((fixup = search_exception_table(regs->nip)) != 0) {
	139	regs->nip = fixup;
	140	return;
	141	}
	142
4431283c	143	#if defined(CONFIG_CMD_KGDB)
f046ccd1 EL	144	if (debugger_exception_handler && (*debugger_exception_handler)(regs))
	145	return;
	146	#endif
	147
	148	puts ("Machine check in kernel mode.\n"
	149	"Caused by (from msr): ");
	150	printf("regs %p ",regs);
	151	switch( regs->msr & 0x000F0000) {
	152	case (0x80000000>>12):
	153	puts ("Machine check signal - probably due to mm fault\n"
	154	"with mmu off\n");
	155	break;
	156	case (0x80000000>>13):
	157	puts ("Transfer error ack signal\n");
	158	break;
	159	case (0x80000000>>14):
	160	puts ("Data parity signal\n");
	161	break;
	162	case (0x80000000>>15):
	163	puts ("Address parity signal\n");
	164	break;
	165	default:
	166	puts ("Unknown values in msr\n");
	167	}
	168	show_regs(regs);
	169	print_backtrace((unsigned long *)regs->gpr[1]);
	170	#ifdef CONFIG_PCI
	171	dump_pci();
	172	#endif
	173	panic("machine check");
	174	}
	175
	176	void
	177	AlignmentException(struct pt_regs *regs)
	178	{
4431283c	179	#if defined(CONFIG_CMD_KGDB)
f046ccd1 EL	180	if (debugger_exception_handler && (*debugger_exception_handler)(regs))
	181	return;
	182	#endif
	183	show_regs(regs);
	184	print_backtrace((unsigned long *)regs->gpr[1]);
	185	panic("Alignment Exception");
	186	}
	187
	188	void
	189	ProgramCheckException(struct pt_regs *regs)
	190	{
4431283c	191	#if defined(CONFIG_CMD_KGDB)
f046ccd1 EL	192	if (debugger_exception_handler && (*debugger_exception_handler)(regs))
	193	return;
	194	#endif
	195	show_regs(regs);
	196	print_backtrace((unsigned long *)regs->gpr[1]);
	197	panic("Program Check Exception");
	198	}
	199
	200	void
	201	SoftEmuException(struct pt_regs *regs)
	202	{
4431283c	203	#if defined(CONFIG_CMD_KGDB)
f046ccd1 EL	204	if (debugger_exception_handler && (*debugger_exception_handler)(regs))
	205	return;
	206	#endif
	207	show_regs(regs);
	208	print_backtrace((unsigned long *)regs->gpr[1]);
	209	panic("Software Emulation Exception");
	210	}
	211
	212
	213	void
	214	UnknownException(struct pt_regs *regs)
	215	{
4431283c	216	#if defined(CONFIG_CMD_KGDB)
f046ccd1 EL	217	if (debugger_exception_handler && (*debugger_exception_handler)(regs))
	218	return;
	219	#endif
	220	printf("Bad trap at PC: %lx, SR: %lx, vector=%lx\n",
	221	regs->nip, regs->msr, regs->trap);
	222	_exception(0, regs);
	223	}
	224
4431283c	225	#if defined(CONFIG_CMD_BEDBUG)
f046ccd1 EL	226	extern void do_bedbug_breakpoint(struct pt_regs *);
	227	#endif
	228
	229	void
	230	DebugException(struct pt_regs *regs)
	231	{
	232	printf("Debugger trap at @ %lx\n", regs->nip );
	233	show_regs(regs);
4431283c	234	#if defined(CONFIG_CMD_BEDBUG)
f046ccd1 EL	235	do_bedbug_breakpoint( regs );
	236	#endif
	237	}
	238
	239	/* Probe an address by reading. If not present, return -1, otherwise
	240	* return 0.
	241	*/
	242	int
	243	addr_probe(uint *addr)
	244	{
	245	#if 0
	246	int retval;
	247
	248	__asm__ __volatile__( \
	249	"1: lwz %0,0(%1)\n" \
	250	" eieio\n" \
	251	" li %0,0\n" \
	252	"2:\n" \
	253	".section .fixup,\"ax\"\n" \
	254	"3: li %0,-1\n" \
	255	" b 2b\n" \
	256	".section __ex_table,\"a\"\n" \
	257	" .align 2\n" \
	258	" .long 1b,3b\n" \
	259	".text" \
	260	: "=r" (retval) : "r"(addr));
	261
	262	return (retval);
	263	#endif
	264	return 0;
	265	}