]> git.kernelconcepts.de Git - karo-tx-uboot.git/blob - arch/x86/cpu/interrupts.c
karo: fdt: fix panel-dpi support
[karo-tx-uboot.git] / arch / x86 / cpu / interrupts.c
1 /*
2  * (C) Copyright 2008-2011
3  * Graeme Russ, <graeme.russ@gmail.com>
4  *
5  * (C) Copyright 2002
6  * Daniel Engström, Omicron Ceti AB, <daniel@omicron.se>
7  *
8  * Portions of this file are derived from the Linux kernel source
9  *  Copyright (C) 1991, 1992  Linus Torvalds
10  *
11  * SPDX-License-Identifier:     GPL-2.0+
12  */
13
14 #include <common.h>
15 #include <asm/cache.h>
16 #include <asm/control_regs.h>
17 #include <asm/interrupt.h>
18 #include <asm/io.h>
19 #include <asm/processor-flags.h>
20 #include <linux/compiler.h>
21 #include <asm/msr.h>
22 #include <asm/processor.h>
23 #include <asm/u-boot-x86.h>
24 #include <asm/i8259.h>
25
26 DECLARE_GLOBAL_DATA_PTR;
27
28 #define DECLARE_INTERRUPT(x) \
29         ".globl irq_"#x"\n" \
30         ".hidden irq_"#x"\n" \
31         ".type irq_"#x", @function\n" \
32         "irq_"#x":\n" \
33         "pushl $"#x"\n" \
34         "jmp irq_common_entry\n"
35
36 static char *exceptions[] = {
37         "Divide Error",
38         "Debug",
39         "NMI Interrupt",
40         "Breakpoint",
41         "Overflow",
42         "BOUND Range Exceeded",
43         "Invalid Opcode (Undefined Opcode)",
44         "Device Not Avaiable (No Math Coprocessor)",
45         "Double Fault",
46         "Coprocessor Segment Overrun",
47         "Invalid TSS",
48         "Segment Not Present",
49         "Stack Segment Fault",
50         "General Protection",
51         "Page Fault",
52         "Reserved",
53         "x87 FPU Floating-Point Error",
54         "Alignment Check",
55         "Machine Check",
56         "SIMD Floating-Point Exception",
57         "Virtualization Exception",
58         "Reserved",
59         "Reserved",
60         "Reserved",
61         "Reserved",
62         "Reserved",
63         "Reserved",
64         "Reserved",
65         "Reserved",
66         "Reserved",
67         "Reserved",
68         "Reserved"
69 };
70
71 static void dump_regs(struct irq_regs *regs)
72 {
73         unsigned long cs, eip, eflags;
74         unsigned long cr0 = 0L, cr2 = 0L, cr3 = 0L, cr4 = 0L;
75         unsigned long d0, d1, d2, d3, d6, d7;
76         unsigned long sp;
77
78         /*
79          * Some exceptions cause an error code to be saved on the current stack
80          * after the EIP value. We should extract CS/EIP/EFLAGS from different
81          * position on the stack based on the exception number.
82          */
83         switch (regs->irq_id) {
84         case EXC_DF:
85         case EXC_TS:
86         case EXC_NP:
87         case EXC_SS:
88         case EXC_GP:
89         case EXC_PF:
90         case EXC_AC:
91                 cs = regs->context.ctx2.xcs;
92                 eip = regs->context.ctx2.eip;
93                 eflags = regs->context.ctx2.eflags;
94                 /* We should fix up the ESP due to error code */
95                 regs->esp += 4;
96                 break;
97         default:
98                 cs = regs->context.ctx1.xcs;
99                 eip = regs->context.ctx1.eip;
100                 eflags = regs->context.ctx1.eflags;
101                 break;
102         }
103
104         printf("EIP: %04x:[<%08lx>] EFLAGS: %08lx\n",
105                         (u16)cs, eip, eflags);
106         if (gd->flags & GD_FLG_RELOC)
107                 printf("Original EIP :[<%08lx>]\n", eip - gd->reloc_off);
108
109         printf("EAX: %08lx EBX: %08lx ECX: %08lx EDX: %08lx\n",
110                 regs->eax, regs->ebx, regs->ecx, regs->edx);
111         printf("ESI: %08lx EDI: %08lx EBP: %08lx ESP: %08lx\n",
112                 regs->esi, regs->edi, regs->ebp, regs->esp);
113         printf(" DS: %04x ES: %04x FS: %04x GS: %04x SS: %04x\n",
114                (u16)regs->xds, (u16)regs->xes, (u16)regs->xfs,
115                (u16)regs->xgs, (u16)regs->xss);
116
117         cr0 = read_cr0();
118         cr2 = read_cr2();
119         cr3 = read_cr3();
120         cr4 = read_cr4();
121
122         printf("CR0: %08lx CR2: %08lx CR3: %08lx CR4: %08lx\n",
123                         cr0, cr2, cr3, cr4);
124
125         d0 = get_debugreg(0);
126         d1 = get_debugreg(1);
127         d2 = get_debugreg(2);
128         d3 = get_debugreg(3);
129
130         printf("DR0: %08lx DR1: %08lx DR2: %08lx DR3: %08lx\n",
131                         d0, d1, d2, d3);
132
133         d6 = get_debugreg(6);
134         d7 = get_debugreg(7);
135         printf("DR6: %08lx DR7: %08lx\n",
136                         d6, d7);
137
138         printf("Stack:\n");
139         sp = regs->esp;
140
141         sp += 64;
142
143         while (sp > (regs->esp - 16)) {
144                 if (sp == regs->esp)
145                         printf("--->");
146                 else
147                         printf("    ");
148                 printf("0x%8.8lx : 0x%8.8lx\n", sp, (ulong)readl(sp));
149                 sp -= 4;
150         }
151 }
152
153 static void do_exception(struct irq_regs *regs)
154 {
155         printf("%s\n", exceptions[regs->irq_id]);
156         dump_regs(regs);
157         hang();
158 }
159
160 struct idt_entry {
161         u16     base_low;
162         u16     selector;
163         u8      res;
164         u8      access;
165         u16     base_high;
166 } __packed;
167
168 struct desc_ptr {
169         unsigned short size;
170         unsigned long address;
171 } __packed;
172
173 struct idt_entry idt[256] __aligned(16);
174
175 struct desc_ptr idt_ptr;
176
177 static inline void load_idt(const struct desc_ptr *dtr)
178 {
179         asm volatile("cs lidt %0" : : "m" (*dtr));
180 }
181
182 void set_vector(u8 intnum, void *routine)
183 {
184         idt[intnum].base_high = (u16)((u32)(routine) >> 16);
185         idt[intnum].base_low = (u16)((u32)(routine) & 0xffff);
186 }
187
188 /*
189  * Ideally these would be defined static to avoid a checkpatch warning, but
190  * the compiler cannot see them in the inline asm and complains that they
191  * aren't defined
192  */
193 void irq_0(void);
194 void irq_1(void);
195
196 int cpu_init_interrupts(void)
197 {
198         int i;
199
200         int irq_entry_size = irq_1 - irq_0;
201         void *irq_entry = (void *)irq_0;
202
203         /* Setup the IDT */
204         for (i = 0; i < 256; i++) {
205                 idt[i].access = 0x8e;
206                 idt[i].res = 0;
207                 idt[i].selector = X86_GDT_ENTRY_32BIT_CS * X86_GDT_ENTRY_SIZE;
208                 set_vector(i, irq_entry);
209                 irq_entry += irq_entry_size;
210         }
211
212         idt_ptr.size = 256 * 8 - 1;
213         idt_ptr.address = (unsigned long) idt;
214
215         load_idt(&idt_ptr);
216
217         return 0;
218 }
219
220 void *x86_get_idt(void)
221 {
222         return &idt_ptr;
223 }
224
225 void __do_irq(int irq)
226 {
227         printf("Unhandled IRQ : %d\n", irq);
228 }
229 void do_irq(int irq) __attribute__((weak, alias("__do_irq")));
230
231 void enable_interrupts(void)
232 {
233         asm("sti\n");
234 }
235
236 int disable_interrupts(void)
237 {
238         long flags;
239
240         asm volatile ("pushfl ; popl %0 ; cli\n" : "=g" (flags) : );
241
242         return flags & X86_EFLAGS_IF;
243 }
244
245 int interrupt_init(void)
246 {
247         /*
248          * When running as an EFI application we are not in control of
249          * interrupts and should leave them alone.
250          */
251 #ifndef CONFIG_EFI_APP
252         /* Just in case... */
253         disable_interrupts();
254
255 #ifdef CONFIG_SYS_PCAT_INTERRUPTS
256         /* Initialize the master/slave i8259 pic */
257         i8259_init();
258 #endif
259
260         /* Initialize core interrupt and exception functionality of CPU */
261         cpu_init_interrupts();
262
263         /*
264          * It is now safe to enable interrupts.
265          *
266          * TODO(sjg@chromium.org): But we don't handle these correctly when
267          * booted from EFI.
268          */
269         if (ll_boot_init())
270                 enable_interrupts();
271 #endif
272
273         return 0;
274 }
275
276 /* IRQ Low-Level Service Routine */
277 void irq_llsr(struct irq_regs *regs)
278 {
279         /*
280          * For detailed description of each exception, refer to:
281          * Intel® 64 and IA-32 Architectures Software Developer's Manual
282          * Volume 1: Basic Architecture
283          * Order Number: 253665-029US, November 2008
284          * Table 6-1. Exceptions and Interrupts
285          */
286         if (regs->irq_id < 32) {
287                 /* Architecture defined exception */
288                 do_exception(regs);
289         } else {
290                 /* Hardware or User IRQ */
291                 do_irq(regs->irq_id);
292         }
293 }
294
295 /*
296  * OK - This looks really horrible, but it serves a purpose - It helps create
297  * fully relocatable code.
298  *  - The call to irq_llsr will be a relative jump
299  *  - The IRQ entries will be guaranteed to be in order
300  *  Interrupt entries are now very small (a push and a jump) but they are
301  *  now slower (all registers pushed on stack which provides complete
302  *  crash dumps in the low level handlers
303  *
304  * Interrupt Entry Point:
305  *  - Interrupt has caused eflags, CS and EIP to be pushed
306  *  - Interrupt Vector Handler has pushed orig_eax
307  *  - pt_regs.esp needs to be adjusted by 40 bytes:
308  *      12 bytes pushed by CPU (EFLAGSF, CS, EIP)
309  *      4 bytes pushed by vector handler (irq_id)
310  *      24 bytes pushed before SP (SS, GS, FS, ES, DS, EAX)
311  *      NOTE: Only longs are pushed on/popped off the stack!
312  */
313 asm(".globl irq_common_entry\n" \
314         ".hidden irq_common_entry\n" \
315         ".type irq_common_entry, @function\n" \
316         "irq_common_entry:\n" \
317         "cld\n" \
318         "pushl %ss\n" \
319         "pushl %gs\n" \
320         "pushl %fs\n" \
321         "pushl %es\n" \
322         "pushl %ds\n" \
323         "pushl %eax\n" \
324         "movl  %esp, %eax\n" \
325         "addl  $40, %eax\n" \
326         "pushl %eax\n" \
327         "pushl %ebp\n" \
328         "pushl %edi\n" \
329         "pushl %esi\n" \
330         "pushl %edx\n" \
331         "pushl %ecx\n" \
332         "pushl %ebx\n" \
333         "mov   %esp, %eax\n" \
334         "call irq_llsr\n" \
335         "popl %ebx\n" \
336         "popl %ecx\n" \
337         "popl %edx\n" \
338         "popl %esi\n" \
339         "popl %edi\n" \
340         "popl %ebp\n" \
341         "popl %eax\n" \
342         "popl %eax\n" \
343         "popl %ds\n" \
344         "popl %es\n" \
345         "popl %fs\n" \
346         "popl %gs\n" \
347         "popl %ss\n" \
348         "add  $4, %esp\n" \
349         "iret\n" \
350         DECLARE_INTERRUPT(0) \
351         DECLARE_INTERRUPT(1) \
352         DECLARE_INTERRUPT(2) \
353         DECLARE_INTERRUPT(3) \
354         DECLARE_INTERRUPT(4) \
355         DECLARE_INTERRUPT(5) \
356         DECLARE_INTERRUPT(6) \
357         DECLARE_INTERRUPT(7) \
358         DECLARE_INTERRUPT(8) \
359         DECLARE_INTERRUPT(9) \
360         DECLARE_INTERRUPT(10) \
361         DECLARE_INTERRUPT(11) \
362         DECLARE_INTERRUPT(12) \
363         DECLARE_INTERRUPT(13) \
364         DECLARE_INTERRUPT(14) \
365         DECLARE_INTERRUPT(15) \
366         DECLARE_INTERRUPT(16) \
367         DECLARE_INTERRUPT(17) \
368         DECLARE_INTERRUPT(18) \
369         DECLARE_INTERRUPT(19) \
370         DECLARE_INTERRUPT(20) \
371         DECLARE_INTERRUPT(21) \
372         DECLARE_INTERRUPT(22) \
373         DECLARE_INTERRUPT(23) \
374         DECLARE_INTERRUPT(24) \
375         DECLARE_INTERRUPT(25) \
376         DECLARE_INTERRUPT(26) \
377         DECLARE_INTERRUPT(27) \
378         DECLARE_INTERRUPT(28) \
379         DECLARE_INTERRUPT(29) \
380         DECLARE_INTERRUPT(30) \
381         DECLARE_INTERRUPT(31) \
382         DECLARE_INTERRUPT(32) \
383         DECLARE_INTERRUPT(33) \
384         DECLARE_INTERRUPT(34) \
385         DECLARE_INTERRUPT(35) \
386         DECLARE_INTERRUPT(36) \
387         DECLARE_INTERRUPT(37) \
388         DECLARE_INTERRUPT(38) \
389         DECLARE_INTERRUPT(39) \
390         DECLARE_INTERRUPT(40) \
391         DECLARE_INTERRUPT(41) \
392         DECLARE_INTERRUPT(42) \
393         DECLARE_INTERRUPT(43) \
394         DECLARE_INTERRUPT(44) \
395         DECLARE_INTERRUPT(45) \
396         DECLARE_INTERRUPT(46) \
397         DECLARE_INTERRUPT(47) \
398         DECLARE_INTERRUPT(48) \
399         DECLARE_INTERRUPT(49) \
400         DECLARE_INTERRUPT(50) \
401         DECLARE_INTERRUPT(51) \
402         DECLARE_INTERRUPT(52) \
403         DECLARE_INTERRUPT(53) \
404         DECLARE_INTERRUPT(54) \
405         DECLARE_INTERRUPT(55) \
406         DECLARE_INTERRUPT(56) \
407         DECLARE_INTERRUPT(57) \
408         DECLARE_INTERRUPT(58) \
409         DECLARE_INTERRUPT(59) \
410         DECLARE_INTERRUPT(60) \
411         DECLARE_INTERRUPT(61) \
412         DECLARE_INTERRUPT(62) \
413         DECLARE_INTERRUPT(63) \
414         DECLARE_INTERRUPT(64) \
415         DECLARE_INTERRUPT(65) \
416         DECLARE_INTERRUPT(66) \
417         DECLARE_INTERRUPT(67) \
418         DECLARE_INTERRUPT(68) \
419         DECLARE_INTERRUPT(69) \
420         DECLARE_INTERRUPT(70) \
421         DECLARE_INTERRUPT(71) \
422         DECLARE_INTERRUPT(72) \
423         DECLARE_INTERRUPT(73) \
424         DECLARE_INTERRUPT(74) \
425         DECLARE_INTERRUPT(75) \
426         DECLARE_INTERRUPT(76) \
427         DECLARE_INTERRUPT(77) \
428         DECLARE_INTERRUPT(78) \
429         DECLARE_INTERRUPT(79) \
430         DECLARE_INTERRUPT(80) \
431         DECLARE_INTERRUPT(81) \
432         DECLARE_INTERRUPT(82) \
433         DECLARE_INTERRUPT(83) \
434         DECLARE_INTERRUPT(84) \
435         DECLARE_INTERRUPT(85) \
436         DECLARE_INTERRUPT(86) \
437         DECLARE_INTERRUPT(87) \
438         DECLARE_INTERRUPT(88) \
439         DECLARE_INTERRUPT(89) \
440         DECLARE_INTERRUPT(90) \
441         DECLARE_INTERRUPT(91) \
442         DECLARE_INTERRUPT(92) \
443         DECLARE_INTERRUPT(93) \
444         DECLARE_INTERRUPT(94) \
445         DECLARE_INTERRUPT(95) \
446         DECLARE_INTERRUPT(97) \
447         DECLARE_INTERRUPT(96) \
448         DECLARE_INTERRUPT(98) \
449         DECLARE_INTERRUPT(99) \
450         DECLARE_INTERRUPT(100) \
451         DECLARE_INTERRUPT(101) \
452         DECLARE_INTERRUPT(102) \
453         DECLARE_INTERRUPT(103) \
454         DECLARE_INTERRUPT(104) \
455         DECLARE_INTERRUPT(105) \
456         DECLARE_INTERRUPT(106) \
457         DECLARE_INTERRUPT(107) \
458         DECLARE_INTERRUPT(108) \
459         DECLARE_INTERRUPT(109) \
460         DECLARE_INTERRUPT(110) \
461         DECLARE_INTERRUPT(111) \
462         DECLARE_INTERRUPT(112) \
463         DECLARE_INTERRUPT(113) \
464         DECLARE_INTERRUPT(114) \
465         DECLARE_INTERRUPT(115) \
466         DECLARE_INTERRUPT(116) \
467         DECLARE_INTERRUPT(117) \
468         DECLARE_INTERRUPT(118) \
469         DECLARE_INTERRUPT(119) \
470         DECLARE_INTERRUPT(120) \
471         DECLARE_INTERRUPT(121) \
472         DECLARE_INTERRUPT(122) \
473         DECLARE_INTERRUPT(123) \
474         DECLARE_INTERRUPT(124) \
475         DECLARE_INTERRUPT(125) \
476         DECLARE_INTERRUPT(126) \
477         DECLARE_INTERRUPT(127) \
478         DECLARE_INTERRUPT(128) \
479         DECLARE_INTERRUPT(129) \
480         DECLARE_INTERRUPT(130) \
481         DECLARE_INTERRUPT(131) \
482         DECLARE_INTERRUPT(132) \
483         DECLARE_INTERRUPT(133) \
484         DECLARE_INTERRUPT(134) \
485         DECLARE_INTERRUPT(135) \
486         DECLARE_INTERRUPT(136) \
487         DECLARE_INTERRUPT(137) \
488         DECLARE_INTERRUPT(138) \
489         DECLARE_INTERRUPT(139) \
490         DECLARE_INTERRUPT(140) \
491         DECLARE_INTERRUPT(141) \
492         DECLARE_INTERRUPT(142) \
493         DECLARE_INTERRUPT(143) \
494         DECLARE_INTERRUPT(144) \
495         DECLARE_INTERRUPT(145) \
496         DECLARE_INTERRUPT(146) \
497         DECLARE_INTERRUPT(147) \
498         DECLARE_INTERRUPT(148) \
499         DECLARE_INTERRUPT(149) \
500         DECLARE_INTERRUPT(150) \
501         DECLARE_INTERRUPT(151) \
502         DECLARE_INTERRUPT(152) \
503         DECLARE_INTERRUPT(153) \
504         DECLARE_INTERRUPT(154) \
505         DECLARE_INTERRUPT(155) \
506         DECLARE_INTERRUPT(156) \
507         DECLARE_INTERRUPT(157) \
508         DECLARE_INTERRUPT(158) \
509         DECLARE_INTERRUPT(159) \
510         DECLARE_INTERRUPT(160) \
511         DECLARE_INTERRUPT(161) \
512         DECLARE_INTERRUPT(162) \
513         DECLARE_INTERRUPT(163) \
514         DECLARE_INTERRUPT(164) \
515         DECLARE_INTERRUPT(165) \
516         DECLARE_INTERRUPT(166) \
517         DECLARE_INTERRUPT(167) \
518         DECLARE_INTERRUPT(168) \
519         DECLARE_INTERRUPT(169) \
520         DECLARE_INTERRUPT(170) \
521         DECLARE_INTERRUPT(171) \
522         DECLARE_INTERRUPT(172) \
523         DECLARE_INTERRUPT(173) \
524         DECLARE_INTERRUPT(174) \
525         DECLARE_INTERRUPT(175) \
526         DECLARE_INTERRUPT(176) \
527         DECLARE_INTERRUPT(177) \
528         DECLARE_INTERRUPT(178) \
529         DECLARE_INTERRUPT(179) \
530         DECLARE_INTERRUPT(180) \
531         DECLARE_INTERRUPT(181) \
532         DECLARE_INTERRUPT(182) \
533         DECLARE_INTERRUPT(183) \
534         DECLARE_INTERRUPT(184) \
535         DECLARE_INTERRUPT(185) \
536         DECLARE_INTERRUPT(186) \
537         DECLARE_INTERRUPT(187) \
538         DECLARE_INTERRUPT(188) \
539         DECLARE_INTERRUPT(189) \
540         DECLARE_INTERRUPT(190) \
541         DECLARE_INTERRUPT(191) \
542         DECLARE_INTERRUPT(192) \
543         DECLARE_INTERRUPT(193) \
544         DECLARE_INTERRUPT(194) \
545         DECLARE_INTERRUPT(195) \
546         DECLARE_INTERRUPT(196) \
547         DECLARE_INTERRUPT(197) \
548         DECLARE_INTERRUPT(198) \
549         DECLARE_INTERRUPT(199) \
550         DECLARE_INTERRUPT(200) \
551         DECLARE_INTERRUPT(201) \
552         DECLARE_INTERRUPT(202) \
553         DECLARE_INTERRUPT(203) \
554         DECLARE_INTERRUPT(204) \
555         DECLARE_INTERRUPT(205) \
556         DECLARE_INTERRUPT(206) \
557         DECLARE_INTERRUPT(207) \
558         DECLARE_INTERRUPT(208) \
559         DECLARE_INTERRUPT(209) \
560         DECLARE_INTERRUPT(210) \
561         DECLARE_INTERRUPT(211) \
562         DECLARE_INTERRUPT(212) \
563         DECLARE_INTERRUPT(213) \
564         DECLARE_INTERRUPT(214) \
565         DECLARE_INTERRUPT(215) \
566         DECLARE_INTERRUPT(216) \
567         DECLARE_INTERRUPT(217) \
568         DECLARE_INTERRUPT(218) \
569         DECLARE_INTERRUPT(219) \
570         DECLARE_INTERRUPT(220) \
571         DECLARE_INTERRUPT(221) \
572         DECLARE_INTERRUPT(222) \
573         DECLARE_INTERRUPT(223) \
574         DECLARE_INTERRUPT(224) \
575         DECLARE_INTERRUPT(225) \
576         DECLARE_INTERRUPT(226) \
577         DECLARE_INTERRUPT(227) \
578         DECLARE_INTERRUPT(228) \
579         DECLARE_INTERRUPT(229) \
580         DECLARE_INTERRUPT(230) \
581         DECLARE_INTERRUPT(231) \
582         DECLARE_INTERRUPT(232) \
583         DECLARE_INTERRUPT(233) \
584         DECLARE_INTERRUPT(234) \
585         DECLARE_INTERRUPT(235) \
586         DECLARE_INTERRUPT(236) \
587         DECLARE_INTERRUPT(237) \
588         DECLARE_INTERRUPT(238) \
589         DECLARE_INTERRUPT(239) \
590         DECLARE_INTERRUPT(240) \
591         DECLARE_INTERRUPT(241) \
592         DECLARE_INTERRUPT(242) \
593         DECLARE_INTERRUPT(243) \
594         DECLARE_INTERRUPT(244) \
595         DECLARE_INTERRUPT(245) \
596         DECLARE_INTERRUPT(246) \
597         DECLARE_INTERRUPT(247) \
598         DECLARE_INTERRUPT(248) \
599         DECLARE_INTERRUPT(249) \
600         DECLARE_INTERRUPT(250) \
601         DECLARE_INTERRUPT(251) \
602         DECLARE_INTERRUPT(252) \
603         DECLARE_INTERRUPT(253) \
604         DECLARE_INTERRUPT(254) \
605         DECLARE_INTERRUPT(255));