Home | History | Annotate | Download | only in lib 
      1 // SPDX-License-Identifier: GPL-2.0+
      2 /*
      3  * (C) Copyright 2015
      4  * Kamil Lulko, <kamil.lulko (at) gmail.com>
      5  */
      6 
      7 #include <common.h>
      8 
      9 /*
     10  * Upon exception entry ARMv7-M processors automatically save stack
     11  * frames containing some registers. For simplicity initial
     12  * implementation uses only this auto-saved stack frame.
     13  * This does not contain complete register set dump,
     14  * only R0-R3, R12, LR, PC and xPSR are saved.
     15  */
     16 
     17 struct autosave_regs {
     18 	long uregs[8];
     19 };
     20 
     21 #define ARM_XPSR	uregs[7]
     22 #define ARM_PC		uregs[6]
     23 #define ARM_LR		uregs[5]
     24 #define ARM_R12		uregs[4]
     25 #define ARM_R3		uregs[3]
     26 #define ARM_R2		uregs[2]
     27 #define ARM_R1		uregs[1]
     28 #define ARM_R0		uregs[0]
     29 
     30 int interrupt_init(void)
     31 {
     32 	return 0;
     33 }
     34 
     35 void enable_interrupts(void)
     36 {
     37 	return;
     38 }
     39 
     40 int disable_interrupts(void)
     41 {
     42 	return 0;
     43 }
     44 
     45 void dump_regs(struct autosave_regs *regs)
     46 {
     47 	printf("pc : %08lx    lr : %08lx    xPSR : %08lx\n",
     48 	       regs->ARM_PC, regs->ARM_LR, regs->ARM_XPSR);
     49 	printf("r12 : %08lx   r3 : %08lx    r2 : %08lx\n"
     50 		"r1 : %08lx    r0 : %08lx\n",
     51 		regs->ARM_R12, regs->ARM_R3, regs->ARM_R2,
     52 		regs->ARM_R1, regs->ARM_R0);
     53 }
     54 
     55 void bad_mode(void)
     56 {
     57 	panic("Resetting CPU ...\n");
     58 	reset_cpu(0);
     59 }
     60 
     61 void do_hard_fault(struct autosave_regs *autosave_regs)
     62 {
     63 	printf("Hard fault\n");
     64 	dump_regs(autosave_regs);
     65 	bad_mode();
     66 }
     67 
     68 void do_mm_fault(struct autosave_regs *autosave_regs)
     69 {
     70 	printf("Memory management fault\n");
     71 	dump_regs(autosave_regs);
     72 	bad_mode();
     73 }
     74 
     75 void do_bus_fault(struct autosave_regs *autosave_regs)
     76 {
     77 	printf("Bus fault\n");
     78 	dump_regs(autosave_regs);
     79 	bad_mode();
     80 }
     81 
     82 void do_usage_fault(struct autosave_regs *autosave_regs)
     83 {
     84 	printf("Usage fault\n");
     85 	dump_regs(autosave_regs);
     86 	bad_mode();
     87 }
     88 
     89 void do_invalid_entry(struct autosave_regs *autosave_regs)
     90 {
     91 	printf("Exception\n");
     92 	dump_regs(autosave_regs);
     93 	bad_mode();
     94 }
     95