1
2
3
4
5
6
7
8
9
10
11
12#include <linux/smp.h>
13#include <linux/delay.h>
14#include <linux/crash_dump.h>
15#include <linux/memblock.h>
16#include <linux/kexec.h>
17#include <linux/elfcore.h>
18#include <linux/sysctl.h>
19#include <linux/init.h>
20#include <linux/kdebug.h>
21
22#include <asm/mca.h>
23
24int kdump_status[NR_CPUS];
25static atomic_t kdump_cpu_frozen;
26atomic_t kdump_in_progress;
27static int kdump_freeze_monarch;
28static int kdump_on_init = 1;
29static int kdump_on_fatal_mca = 1;
30
31extern void ia64_dump_cpu_regs(void *);
32
33static DEFINE_PER_CPU(struct elf_prstatus, elf_prstatus);
34
35void
36crash_save_this_cpu(void)
37{
38 void *buf;
39 unsigned long cfm, sof, sol;
40
41 int cpu = smp_processor_id();
42 struct elf_prstatus *prstatus = &per_cpu(elf_prstatus, cpu);
43
44 elf_greg_t *dst = (elf_greg_t *)&(prstatus->pr_reg);
45 memset(prstatus, 0, sizeof(*prstatus));
46 prstatus->pr_pid = current->pid;
47
48 ia64_dump_cpu_regs(dst);
49 cfm = dst[43];
50 sol = (cfm >> 7) & 0x7f;
51 sof = cfm & 0x7f;
52 dst[46] = (unsigned long)ia64_rse_skip_regs((unsigned long *)dst[46],
53 sof - sol);
54
55 buf = (u64 *) per_cpu_ptr(crash_notes, cpu);
56 if (!buf)
57 return;
58 buf = append_elf_note(buf, KEXEC_CORE_NOTE_NAME, NT_PRSTATUS, prstatus,
59 sizeof(*prstatus));
60 final_note(buf);
61}
62
63#ifdef CONFIG_SMP
64static int
65kdump_wait_cpu_freeze(void)
66{
67 int cpu_num = num_online_cpus() - 1;
68 int timeout = 1000;
69 while(timeout-- > 0) {
70 if (atomic_read(&kdump_cpu_frozen) == cpu_num)
71 return 0;
72 udelay(1000);
73 }
74 return 1;
75}
76#endif
77
78void
79machine_crash_shutdown(struct pt_regs *pt)
80{
81
82
83
84
85
86
87
88
89 kexec_disable_iosapic();
90#ifdef CONFIG_SMP
91
92
93
94
95 local_irq_disable();
96 ia64_set_psr_mc();
97 if (atomic_inc_return(&kdump_in_progress) != 1)
98 unw_init_running(kdump_cpu_freeze, NULL);
99
100
101
102
103
104
105
106
107
108
109
110
111
112
113
114
115
116
117 kdump_smp_send_stop();
118
119 if (kdump_wait_cpu_freeze()) {
120 kdump_smp_send_init();
121
122 kdump_wait_cpu_freeze();
123 }
124#endif
125}
126
127static void
128machine_kdump_on_init(void)
129{
130 crash_save_vmcoreinfo();
131 local_irq_disable();
132 kexec_disable_iosapic();
133 machine_kexec(ia64_kimage);
134}
135
136void
137kdump_cpu_freeze(struct unw_frame_info *info, void *arg)
138{
139 int cpuid;
140
141 local_irq_disable();
142 cpuid = smp_processor_id();
143 crash_save_this_cpu();
144 current->thread.ksp = (__u64)info->sw - 16;
145
146 ia64_set_psr_mc();
147
148 atomic_inc(&kdump_cpu_frozen);
149 kdump_status[cpuid] = 1;
150 mb();
151 for (;;)
152 cpu_relax();
153}
154
155static int
156kdump_init_notifier(struct notifier_block *self, unsigned long val, void *data)
157{
158 struct ia64_mca_notify_die *nd;
159 struct die_args *args = data;
160
161 if (atomic_read(&kdump_in_progress)) {
162 switch (val) {
163 case DIE_INIT_MONARCH_LEAVE:
164 if (!kdump_freeze_monarch)
165 break;
166
167 case DIE_INIT_SLAVE_LEAVE:
168 case DIE_INIT_MONARCH_ENTER:
169 case DIE_MCA_RENDZVOUS_LEAVE:
170 unw_init_running(kdump_cpu_freeze, NULL);
171 break;
172 }
173 }
174
175 if (!kdump_on_init && !kdump_on_fatal_mca)
176 return NOTIFY_DONE;
177
178 if (!ia64_kimage) {
179 if (val == DIE_INIT_MONARCH_LEAVE)
180 ia64_mca_printk(KERN_NOTICE
181 "%s: kdump not configured\n",
182 __func__);
183 return NOTIFY_DONE;
184 }
185
186 if (val != DIE_INIT_MONARCH_LEAVE &&
187 val != DIE_INIT_MONARCH_PROCESS &&
188 val != DIE_MCA_MONARCH_LEAVE)
189 return NOTIFY_DONE;
190
191 nd = (struct ia64_mca_notify_die *)args->err;
192
193 switch (val) {
194 case DIE_INIT_MONARCH_PROCESS:
195
196 if (kdump_on_init && (nd->sos->rv_rc != 1)) {
197 if (atomic_inc_return(&kdump_in_progress) != 1)
198 kdump_freeze_monarch = 1;
199 }
200 break;
201 case DIE_INIT_MONARCH_LEAVE:
202
203 if (kdump_on_init && (nd->sos->rv_rc != 1))
204 machine_kdump_on_init();
205 break;
206 case DIE_MCA_MONARCH_LEAVE:
207
208 if (kdump_on_fatal_mca && !(*(nd->data))) {
209 if (atomic_inc_return(&kdump_in_progress) == 1)
210 machine_kdump_on_init();
211
212 }
213 break;
214 }
215 return NOTIFY_DONE;
216}
217
218#ifdef CONFIG_SYSCTL
219static struct ctl_table kdump_ctl_table[] = {
220 {
221 .procname = "kdump_on_init",
222 .data = &kdump_on_init,
223 .maxlen = sizeof(int),
224 .mode = 0644,
225 .proc_handler = proc_dointvec,
226 },
227 {
228 .procname = "kdump_on_fatal_mca",
229 .data = &kdump_on_fatal_mca,
230 .maxlen = sizeof(int),
231 .mode = 0644,
232 .proc_handler = proc_dointvec,
233 },
234 { }
235};
236
237static struct ctl_table sys_table[] = {
238 {
239 .procname = "kernel",
240 .mode = 0555,
241 .child = kdump_ctl_table,
242 },
243 { }
244};
245#endif
246
247static int
248machine_crash_setup(void)
249{
250
251 static struct notifier_block kdump_init_notifier_nb = {
252 .notifier_call = kdump_init_notifier,
253 .priority = 1,
254 };
255 int ret;
256 if((ret = register_die_notifier(&kdump_init_notifier_nb)) != 0)
257 return ret;
258#ifdef CONFIG_SYSCTL
259 register_sysctl_table(sys_table);
260#endif
261 return 0;
262}
263
264__initcall(machine_crash_setup);
265
266