ftp://ftp.kernel.org/pub/linux/kernel/v2.6/linux-2.6.6.tar.bz2
[linux-2.6.git] / arch / i386 / mach-visws / traps.c
1 /* VISWS traps */
2
3 #include <linux/config.h>
4 #include <linux/sched.h>
5 #include <linux/kernel.h>
6 #include <linux/init.h>
7 #include <linux/pci.h>
8 #include <linux/pci_ids.h>
9
10 #include <asm/io.h>
11 #include <asm/pgalloc.h>
12 #include <asm/arch_hooks.h>
13 #include <asm/apic.h>
14 #include "cobalt.h"
15 #include "lithium.h"
16
17
18 #define A01234 (LI_INTA_0 | LI_INTA_1 | LI_INTA_2 | LI_INTA_3 | LI_INTA_4)
19 #define BCD (LI_INTB | LI_INTC | LI_INTD)
20 #define ALLDEVS (A01234 | BCD)
21
22 static __init void lithium_init(void)
23 {
24         set_fixmap(FIX_LI_PCIA, LI_PCI_A_PHYS);
25         set_fixmap(FIX_LI_PCIB, LI_PCI_B_PHYS);
26
27         if ((li_pcia_read16(PCI_VENDOR_ID) != PCI_VENDOR_ID_SGI) ||
28             (li_pcia_read16(PCI_DEVICE_ID) != PCI_VENDOR_ID_SGI_LITHIUM)) {
29                 printk(KERN_EMERG "Lithium hostbridge %c not found\n", 'A');
30                 panic("This machine is not SGI Visual Workstation 320/540");
31         }
32
33         if ((li_pcib_read16(PCI_VENDOR_ID) != PCI_VENDOR_ID_SGI) ||
34             (li_pcib_read16(PCI_DEVICE_ID) != PCI_VENDOR_ID_SGI_LITHIUM)) {
35                 printk(KERN_EMERG "Lithium hostbridge %c not found\n", 'B');
36                 panic("This machine is not SGI Visual Workstation 320/540");
37         }
38
39         li_pcia_write16(LI_PCI_INTEN, ALLDEVS);
40         li_pcib_write16(LI_PCI_INTEN, ALLDEVS);
41 }
42
43 static __init void cobalt_init(void)
44 {
45         /*
46          * On normal SMP PC this is used only with SMP, but we have to
47          * use it and set it up here to start the Cobalt clock
48          */
49         set_fixmap(FIX_APIC_BASE, APIC_DEFAULT_PHYS_BASE);
50         setup_local_APIC();
51         printk(KERN_INFO "Local APIC Version %#lx, ID %#lx\n",
52                 apic_read(APIC_LVR), apic_read(APIC_ID));
53
54         set_fixmap(FIX_CO_CPU, CO_CPU_PHYS);
55         set_fixmap(FIX_CO_APIC, CO_APIC_PHYS);
56         printk(KERN_INFO "Cobalt Revision %#lx, APIC ID %#lx\n",
57                 co_cpu_read(CO_CPU_REV), co_apic_read(CO_APIC_ID));
58
59         /* Enable Cobalt APIC being careful to NOT change the ID! */
60         co_apic_write(CO_APIC_ID, co_apic_read(CO_APIC_ID) | CO_APIC_ENABLE);
61
62         printk(KERN_INFO "Cobalt APIC enabled: ID reg %#lx\n",
63                 co_apic_read(CO_APIC_ID));
64 }
65
66 void __init trap_init_hook(void)
67 {
68         lithium_init();
69         cobalt_init();
70 }