summaryrefstree
path: root/kernel/init/uh_fault_handler.c
blob: 40a90cd4782ba2c5144f0f44bb4119cd854b1f86 (plain)
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
106
107
108
109
110
111
112
113
114
115
116
117
118
119
120
121
122
123
124
125
126
127
128
#include <linux/kernel.h>
#include <linux/module.h>
#include <linux/types.h>
#include <asm/cacheflush.h>
#include <asm/irqflags.h>
#include <linux/fs.h>
#include <asm/tlbflush.h>
#include <linux/init.h>
#include <linux/io.h>
#include <asm/topology.h>
#include <asm/memory.h>
#include <asm/system_misc.h>

#include <linux/uh.h>
#include <linux/uh_fault_handler.h>
#include "ld.h"

DEFINE_SPINLOCK(uh_fault_lock);

static const char *exception_class_string[] = {
	[esr_ec_unknown_reason]
	    = "[EL2 EXCEPTION] unknown reason",
	[esr_ec_wfi_or_wfe_instruction_execution]
	    = "[EL2 EXCEPTION] wfi or wfe instruction execution",
	[esr_ec_mcr_or_mrc_access_to_cp15]
	    = "[EL2 EXCEPTION] mcr or mrc access to cp15",
	[esr_ec_mcrr_or_mrrc_access_to_cp15]
	    = "[EL2 EXCEPTION] mcrr or mrrc access to cp15",
	[esr_ec_mcr_or_mrc_access_to_cp14]
	    = "[EL2 EXCEPTION] mcr or mrc access to cp14",
	[esr_ec_ldc_or_stc_access_to_cp14]
	    = "[EL2 EXCEPTION] ldc or stc access to cp14",
	[esr_ec_access_to_simd_or_floating_point_registers]
	    = "[EL2 EXCEPTION] access to simd or floating point registers",
	[esr_ec_trapped_mrc_or_mrs_access_to_cp10_for_id_group_traps]
	    = "[EL2 EXCEPTION] trapped mrc or mrs access to cp10 for id group traps",
	[esr_ec_trapped_mrrc_or_mcrr_access_to_cp14]
	    = "[EL2 EXCEPTION] trapped mrrc or mcrr access to cp14",
	[esr_ec_illegal_execution_state]
	    = "[EL2 EXCEPTION] illegal execution state",
	[esr_ec_aarch32_svc_instruction_execution]
	    = "[EL2 EXCEPTION] aarch32 svc instruction execution",
	[esr_ec_aarch32_hvc_instruction_execution]
	    = "[EL2 EXCEPTION] aarch32 hvc instruction execution",
	[esr_ec_aarch32_smc_instruction_execution]
	    = "[EL2 EXCEPTION] aarch32 smc instruction execution",
	[esr_ec_aarch64_svc_instruction_execution]
	    = "[EL2 EXCEPTION] aarch64 svc instruction execution",
	[esr_ec_aarch64_hvc_instruction_execution]
	    = "[EL2 EXCEPTION] aarch64 hvc instruction execution",
	[esr_ec_aarch64_smc_instruction_execution]
	    = "[EL2 EXCEPTION] aarch64 smc instruction execution",
	[esr_ec_other_msr_mrs_or_system_instruction_execution]
	    = "[EL2 EXCEPTION] other msr mrs or system instruction execution",
	[esr_ec_prefetch_abort_from_a_lower_exception_level]
	    = "[EL2 EXCEPTION] prefetch abort from a lower exception level",
	[esr_ec_prefetch_abort_taken_without_a_change_in_exception_level]
	    = "[EL2 EXCEPTION] prefetch abort taken without a change in exception level",
	[esr_ec_misaligned_pc_exception]
	    = "[EL2 EXCEPTION] misaligned pc exception",
	[esr_ec_data_abort_from_a_lower_exception_level]
	    = "[EL2 EXCEPTION] data abort from a lower exception level",
	[esr_ec_data_abort_taken_without_a_change_in_exception_level]
	    = "[EL2 EXCEPTION] data abort taken without a change in exception level",
	[esr_ec_stack_pointer_alignment_exception]
	    = "[EL2 EXCEPTION] stack pointer alignment exception",
	[esr_ec_aarch32_floating_point_exception]
	    = "[EL2 EXCEPTION] aarch32 floating point exception",
	[esr_ec_aarch64_floating_point_exception]
	    = "[EL2 EXCEPTION] aarch64 floating point exception",
	[esr_ec_serror_interrupt]
	    = "[EL2 EXCEPTION] serror interrupt",
	[esr_ec_breakpoint_exception_from_a_lower_exception_level]
	    = "[EL2 EXCEPTION] breakpoint exception from a lower exception level",
	[esr_ec_breakpoint_exception_taken_without_a_change_in_exception_level]
	    = "[EL2 EXCEPTION] breakpoint exception taken without a change in exception level",
	[esr_ec_software_step_exception_taken_from_a_lower_exception_level]
	    = "[EL2 EXCEPTION] software step exception taken from a lower exception level",
	[esr_ec_software_step_exception_taken_without_a_change_in_exception_level]
	    = "[EL2 EXCEPTION] software step exception taken without a change in exception level",
	[esr_ec_watchpoint_exception_from_a_lower_exception_level]
	    = "[EL2 EXCEPTION] watchpoint exception from a lower exception level",
	[esr_ec_watchpoint_exception_taken_without_a_change_in_exception_level]
	    = "[EL2 EXCEPTION] watchpoint exception taken without a change in exception level",
	[esr_ec_bkpt_instruction_execution]
	    = "[EL2 EXCEPTION] bkpt instruction execution",
	[esr_ec_vector_catch_exception_from_aach32_state]
	    = "[EL2 EXCEPTION] vector catch exception from aach32 state",
	[esr_ec_brk_instruction_execution]
	    = "[EL2 EXCEPTION] brk instruction execution",
};

static uh_handler_list_t uh_handler_list;

void uh_fault_handler(void)
{
	u32 cpu = get_current_cpunum();
	uh_handler_data_t *uh_handler_data = &uh_handler_list.uh_handler_data[cpu];
	u32 exception_class = uh_handler_data->esr_el2.ec;
	unsigned long flags;
	struct pt_regs kregs;
	memset(&kregs,0,sizeof(struct pt_regs));
	spin_lock_irqsave(&uh_fault_lock, flags);

	if (!exception_class_string[exception_class]
	    || exception_class > esr_ec_brk_instruction_execution)
		exception_class = esr_ec_unknown_reason;

	pr_alert("=============uH fault handler logging=============\n");
	pr_alert("[System registers]\n");
	pr_alert("ESR_EL2: %x\tHCR_EL2: %llx\tHPFAR_EL2: %llx\n",
		 uh_handler_data->esr_el2.bits,
		 uh_handler_data->hcr_el2, uh_handler_data->hpfar_el2);
	pr_alert("FAR_EL2: %llx\tELR_EL2: %llx\n", uh_handler_data->far_el2,
		 uh_handler_data->elr_el2);

	do_not_show_extra = 1;
	memcpy(&kregs, &uh_handler_data->regs, sizeof(struct uh_registers));
	__show_regs(&kregs);
	do_not_show_extra = 0;	
	panic("uH Fault handler : %s", exception_class_string[exception_class]);
}

u64 uh_get_fault_handler(void)
{
	uh_handler_list.uh_handler = (u64) & uh_fault_handler;
	return (u64) & uh_handler_list;
}