arch/x86/kernel/devicetree.c

   1 /*
   2  * Architecture specific OF callbacks.
   3  */
   4 #include <linux/bootmem.h>
   5 #include <linux/export.h>
   6 #include <linux/io.h>
   7 #include <linux/interrupt.h>
   8 #include <linux/list.h>
   9 #include <linux/of.h>
  10 #include <linux/of_fdt.h>
  11 #include <linux/of_address.h>
  12 #include <linux/of_platform.h>
  13 #include <linux/of_irq.h>
  14 #include <linux/slab.h>
  15 #include <linux/pci.h>
  16 #include <linux/of_pci.h>
  17 #include <linux/initrd.h>
  18
  19 #include <asm/irqdomain.h>
  20 #include <asm/hpet.h>
  21 #include <asm/apic.h>
  22 #include <asm/pci_x86.h>
  23 #include <asm/setup.h>
  24 #include <asm/i8259.h>
  25
  26 __initdata u64 initial_dtb;
  27 char __initdata cmd_line[COMMAND_LINE_SIZE];
  28
  29 int __initdata of_ioapic;
  30
  31 void __init early_init_dt_scan_chosen_arch(unsigned long node)
  32 {
  33         BUG();
  34 }
  35
  36 void __init early_init_dt_add_memory_arch(u64 base, u64 size)
  37 {
  38         BUG();
  39 }
  40
  41 void * __init early_init_dt_alloc_memory_arch(u64 size, u64 align)
  42 {
  43         return __alloc_bootmem(size, align, __pa(MAX_DMA_ADDRESS));
  44 }
  45
  46 void __init add_dtb(u64 data)
  47 {
  48         initial_dtb = data + offsetof(struct setup_data, data);
  49 }
  50
  51 /*
  52  * CE4100 ids. Will be moved to machine_device_initcall() once we have it.
  53  */
  54 static struct of_device_id __initdata ce4100_ids[] = {
  55         { .compatible = "intel,ce4100-cp", },
  56         { .compatible = "isa", },
  57         { .compatible = "pci", },
  58         {},
  59 };
  60
  61 static int __init add_bus_probe(void)
  62 {
  63         if (!of_have_populated_dt())
  64                 return 0;
  65
  66         return of_platform_bus_probe(NULL, ce4100_ids, NULL);
  67 }
  68 device_initcall(add_bus_probe);
  69
  70 #ifdef CONFIG_PCI
  71 struct device_node *pcibios_get_phb_of_node(struct pci_bus *bus)
  72 {
  73         struct device_node *np;
  74
  75         for_each_node_by_type(np, "pci") {
  76                 const void *prop;
  77                 unsigned int bus_min;
  78
  79                 prop = of_get_property(np, "bus-range", NULL);
  80                 if (!prop)
  81                         continue;
  82                 bus_min = be32_to_cpup(prop);
  83                 if (bus->number == bus_min)
  84                         return np;
  85         }
  86         return NULL;
  87 }
  88
  89 static int x86_of_pci_irq_enable(struct pci_dev *dev)
  90 {
  91         u32 virq;
  92         int ret;
  93         u8 pin;
  94
  95         ret = pci_read_config_byte(dev, PCI_INTERRUPT_PIN, &pin);
  96         if (ret)
  97                 return ret;
  98         if (!pin)
  99                 return 0;
 100
 101         virq = of_irq_parse_and_map_pci(dev, 0, 0);
 102         if (virq == 0)
 103                 return -EINVAL;
 104         dev->irq = virq;
 105         return 0;
 106 }
 107
 108 static void x86_of_pci_irq_disable(struct pci_dev *dev)
 109 {
 110 }
 111
 112 void x86_of_pci_init(void)
 113 {
 114         pcibios_enable_irq = x86_of_pci_irq_enable;
 115         pcibios_disable_irq = x86_of_pci_irq_disable;
 116 }
 117 #endif
 118
 119 static void __init dtb_setup_hpet(void)
 120 {
 121 #ifdef CONFIG_HPET_TIMER
 122         struct device_node *dn;
 123         struct resource r;
 124         int ret;
 125
 126         dn = of_find_compatible_node(NULL, NULL, "intel,ce4100-hpet");
 127         if (!dn)
 128                 return;
 129         ret = of_address_to_resource(dn, 0, &r);
 130         if (ret) {
 131                 WARN_ON(1);
 132                 return;
 133         }
 134         hpet_address = r.start;
 135 #endif
 136 }
 137
 138 static void __init dtb_lapic_setup(void)
 139 {
 140 #ifdef CONFIG_X86_LOCAL_APIC
 141         struct device_node *dn;
 142         struct resource r;
 143         int ret;
 144
 145         dn = of_find_compatible_node(NULL, NULL, "intel,ce4100-lapic");
 146         if (!dn)
 147                 return;
 148
 149         ret = of_address_to_resource(dn, 0, &r);
 150         if (WARN_ON(ret))
 151                 return;
 152
 153         /* Did the boot loader setup the local APIC ? */
 154         if (!boot_cpu_has(X86_FEATURE_APIC)) {
 155                 if (apic_force_enable(r.start))
 156                         return;
 157         }
 158         smp_found_config = 1;
 159         pic_mode = 1;
 160         register_lapic_address(r.start);
 161         generic_processor_info(boot_cpu_physical_apicid,
 162                                GET_APIC_VERSION(apic_read(APIC_LVR)));
 163 #endif
 164 }
 165
 166 #ifdef CONFIG_X86_IO_APIC
 167 static unsigned int ioapic_id;
 168
 169 struct of_ioapic_type {
 170         u32 out_type;
 171         u32 trigger;
 172         u32 polarity;
 173 };
 174
 175 static struct of_ioapic_type of_ioapic_type[] =
 176 {
 177         {
 178                 .out_type       = IRQ_TYPE_EDGE_RISING,
 179                 .trigger        = IOAPIC_EDGE,
 180                 .polarity       = 1,
 181         },
 182         {
 183                 .out_type       = IRQ_TYPE_LEVEL_LOW,
 184                 .trigger        = IOAPIC_LEVEL,
 185                 .polarity       = 0,
 186         },
 187         {
 188                 .out_type       = IRQ_TYPE_LEVEL_HIGH,
 189                 .trigger        = IOAPIC_LEVEL,
 190                 .polarity       = 1,
 191         },
 192         {
 193                 .out_type       = IRQ_TYPE_EDGE_FALLING,
 194                 .trigger        = IOAPIC_EDGE,
 195                 .polarity       = 0,
 196         },
 197 };
 198
 199 static int dt_irqdomain_alloc(struct irq_domain *domain, unsigned int virq,
 200                               unsigned int nr_irqs, void *arg)
 201 {
 202         struct of_phandle_args *irq_data = (void *)arg;
 203         struct of_ioapic_type *it;
 204         struct irq_alloc_info tmp;
 205
 206         if (WARN_ON(irq_data->args_count < 2))
 207                 return -EINVAL;
 208         if (irq_data->args[1] >= ARRAY_SIZE(of_ioapic_type))
 209                 return -EINVAL;
 210
 211         it = &of_ioapic_type[irq_data->args[1]];
 212         ioapic_set_alloc_attr(&tmp, NUMA_NO_NODE, it->trigger, it->polarity);
 213         tmp.ioapic_id = mpc_ioapic_id(mp_irqdomain_ioapic_idx(domain));
 214         tmp.ioapic_pin = irq_data->args[0];
 215
 216         return mp_irqdomain_alloc(domain, virq, nr_irqs, &tmp);
 217 }
 218
 219 static const struct irq_domain_ops ioapic_irq_domain_ops = {
 220         .alloc          = dt_irqdomain_alloc,
 221         .free           = mp_irqdomain_free,
 222         .activate       = mp_irqdomain_activate,
 223         .deactivate     = mp_irqdomain_deactivate,
 224 };
 225
 226 static void __init dtb_add_ioapic(struct device_node *dn)
 227 {
 228         struct resource r;
 229         int ret;
 230         struct ioapic_domain_cfg cfg = {
 231                 .type = IOAPIC_DOMAIN_DYNAMIC,
 232                 .ops = &ioapic_irq_domain_ops,
 233                 .dev = dn,
 234         };
 235
 236         ret = of_address_to_resource(dn, 0, &r);
 237         if (ret) {
 238                 printk(KERN_ERR "Can't obtain address from node %s.\n",
 239                                 dn->full_name);
 240                 return;
 241         }
 242         mp_register_ioapic(++ioapic_id, r.start, gsi_top, &cfg);
 243 }
 244
 245 static void __init dtb_ioapic_setup(void)
 246 {
 247         struct device_node *dn;
 248
 249         for_each_compatible_node(dn, NULL, "intel,ce4100-ioapic")
 250                 dtb_add_ioapic(dn);
 251
 252         if (nr_ioapics) {
 253                 of_ioapic = 1;
 254                 return;
 255         }
 256         printk(KERN_ERR "Error: No information about IO-APIC in OF.\n");
 257 }
 258 #else
 259 static void __init dtb_ioapic_setup(void) {}
 260 #endif
 261
 262 static void __init dtb_apic_setup(void)
 263 {
 264         dtb_lapic_setup();
 265         dtb_ioapic_setup();
 266 }
 267
 268 #ifdef CONFIG_OF_FLATTREE
 269 static void __init x86_flattree_get_config(void)
 270 {
 271         u32 size, map_len;
 272         void *dt;
 273
 274         if (!initial_dtb)
 275                 return;
 276
 277         map_len = max(PAGE_SIZE - (initial_dtb & ~PAGE_MASK), (u64)128);
 278
 279         initial_boot_params = dt = early_memremap(initial_dtb, map_len);
 280         size = of_get_flat_dt_size();
 281         if (map_len < size) {
 282                 early_memunmap(dt, map_len);
 283                 initial_boot_params = dt = early_memremap(initial_dtb, size);
 284                 map_len = size;
 285         }
 286
 287         unflatten_and_copy_device_tree();
 288         early_memunmap(dt, map_len);
 289 }
 290 #else
 291 static inline void x86_flattree_get_config(void) { }
 292 #endif
 293
 294 void __init x86_dtb_init(void)
 295 {
 296         x86_flattree_get_config();
 297
 298         if (!of_have_populated_dt())
 299                 return;
 300
 301         dtb_setup_hpet();
 302         dtb_apic_setup();
 303 }