xref: /rk3399_rockchip-uboot/arch/arm/lib/interrupts_m.c (revision 5be93569262f4ebc963ca95891667f523f368d89)
112d8a729Srev13@wp.pl /*
212d8a729Srev13@wp.pl  * (C) Copyright 2015
3*5be93569SKamil Lulko  * Kamil Lulko, <kamil.lulko@gmail.com>
412d8a729Srev13@wp.pl  *
512d8a729Srev13@wp.pl  * SPDX-License-Identifier:	GPL-2.0+
612d8a729Srev13@wp.pl  */
712d8a729Srev13@wp.pl 
812d8a729Srev13@wp.pl #include <common.h>
912d8a729Srev13@wp.pl 
1012d8a729Srev13@wp.pl /*
1112d8a729Srev13@wp.pl  * Upon exception entry ARMv7-M processors automatically save stack
1212d8a729Srev13@wp.pl  * frames containing some registers. For simplicity initial
1312d8a729Srev13@wp.pl  * implementation uses only this auto-saved stack frame.
1412d8a729Srev13@wp.pl  * This does not contain complete register set dump,
1512d8a729Srev13@wp.pl  * only R0-R3, R12, LR, PC and xPSR are saved.
1612d8a729Srev13@wp.pl  */
1712d8a729Srev13@wp.pl 
1812d8a729Srev13@wp.pl struct autosave_regs {
1912d8a729Srev13@wp.pl 	long uregs[8];
2012d8a729Srev13@wp.pl };
2112d8a729Srev13@wp.pl 
2212d8a729Srev13@wp.pl #define ARM_XPSR	uregs[7]
2312d8a729Srev13@wp.pl #define ARM_PC		uregs[6]
2412d8a729Srev13@wp.pl #define ARM_LR		uregs[5]
2512d8a729Srev13@wp.pl #define ARM_R12		uregs[4]
2612d8a729Srev13@wp.pl #define ARM_R3		uregs[3]
2712d8a729Srev13@wp.pl #define ARM_R2		uregs[2]
2812d8a729Srev13@wp.pl #define ARM_R1		uregs[1]
2912d8a729Srev13@wp.pl #define ARM_R0		uregs[0]
3012d8a729Srev13@wp.pl 
interrupt_init(void)3112d8a729Srev13@wp.pl int interrupt_init(void)
3212d8a729Srev13@wp.pl {
3312d8a729Srev13@wp.pl 	return 0;
3412d8a729Srev13@wp.pl }
3512d8a729Srev13@wp.pl 
enable_interrupts(void)3612d8a729Srev13@wp.pl void enable_interrupts(void)
3712d8a729Srev13@wp.pl {
3812d8a729Srev13@wp.pl 	return;
3912d8a729Srev13@wp.pl }
4012d8a729Srev13@wp.pl 
disable_interrupts(void)4112d8a729Srev13@wp.pl int disable_interrupts(void)
4212d8a729Srev13@wp.pl {
4312d8a729Srev13@wp.pl 	return 0;
4412d8a729Srev13@wp.pl }
4512d8a729Srev13@wp.pl 
dump_regs(struct autosave_regs * regs)4612d8a729Srev13@wp.pl void dump_regs(struct autosave_regs *regs)
4712d8a729Srev13@wp.pl {
4812d8a729Srev13@wp.pl 	printf("pc : %08lx    lr : %08lx    xPSR : %08lx\n",
4912d8a729Srev13@wp.pl 	       regs->ARM_PC, regs->ARM_LR, regs->ARM_XPSR);
5012d8a729Srev13@wp.pl 	printf("r12 : %08lx   r3 : %08lx    r2 : %08lx\n"
5112d8a729Srev13@wp.pl 		"r1 : %08lx    r0 : %08lx\n",
5212d8a729Srev13@wp.pl 		regs->ARM_R12, regs->ARM_R3, regs->ARM_R2,
5312d8a729Srev13@wp.pl 		regs->ARM_R1, regs->ARM_R0);
5412d8a729Srev13@wp.pl }
5512d8a729Srev13@wp.pl 
bad_mode(void)5612d8a729Srev13@wp.pl void bad_mode(void)
5712d8a729Srev13@wp.pl {
5812d8a729Srev13@wp.pl 	panic("Resetting CPU ...\n");
5912d8a729Srev13@wp.pl 	reset_cpu(0);
6012d8a729Srev13@wp.pl }
6112d8a729Srev13@wp.pl 
do_hard_fault(struct autosave_regs * autosave_regs)6212d8a729Srev13@wp.pl void do_hard_fault(struct autosave_regs *autosave_regs)
6312d8a729Srev13@wp.pl {
6412d8a729Srev13@wp.pl 	printf("Hard fault\n");
6512d8a729Srev13@wp.pl 	dump_regs(autosave_regs);
6612d8a729Srev13@wp.pl 	bad_mode();
6712d8a729Srev13@wp.pl }
6812d8a729Srev13@wp.pl 
do_mm_fault(struct autosave_regs * autosave_regs)6912d8a729Srev13@wp.pl void do_mm_fault(struct autosave_regs *autosave_regs)
7012d8a729Srev13@wp.pl {
7112d8a729Srev13@wp.pl 	printf("Memory management fault\n");
7212d8a729Srev13@wp.pl 	dump_regs(autosave_regs);
7312d8a729Srev13@wp.pl 	bad_mode();
7412d8a729Srev13@wp.pl }
7512d8a729Srev13@wp.pl 
do_bus_fault(struct autosave_regs * autosave_regs)7612d8a729Srev13@wp.pl void do_bus_fault(struct autosave_regs *autosave_regs)
7712d8a729Srev13@wp.pl {
7812d8a729Srev13@wp.pl 	printf("Bus fault\n");
7912d8a729Srev13@wp.pl 	dump_regs(autosave_regs);
8012d8a729Srev13@wp.pl 	bad_mode();
8112d8a729Srev13@wp.pl }
8212d8a729Srev13@wp.pl 
do_usage_fault(struct autosave_regs * autosave_regs)8312d8a729Srev13@wp.pl void do_usage_fault(struct autosave_regs *autosave_regs)
8412d8a729Srev13@wp.pl {
8512d8a729Srev13@wp.pl 	printf("Usage fault\n");
8612d8a729Srev13@wp.pl 	dump_regs(autosave_regs);
8712d8a729Srev13@wp.pl 	bad_mode();
8812d8a729Srev13@wp.pl }
8912d8a729Srev13@wp.pl 
do_invalid_entry(struct autosave_regs * autosave_regs)9012d8a729Srev13@wp.pl void do_invalid_entry(struct autosave_regs *autosave_regs)
9112d8a729Srev13@wp.pl {
9212d8a729Srev13@wp.pl 	printf("Exception\n");
9312d8a729Srev13@wp.pl 	dump_regs(autosave_regs);
9412d8a729Srev13@wp.pl 	bad_mode();
9512d8a729Srev13@wp.pl }
96