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