1 /* 2 * Copyright (C) 2015, Bin Meng <bmeng.cn@gmail.com> 3 * 4 * SPDX-License-Identifier: GPL-2.0+ 5 */ 6 7 #include <common.h> 8 #include <dm.h> 9 #include <errno.h> 10 #include <fdtdec.h> 11 #include <malloc.h> 12 #include <asm/io.h> 13 #include <asm/irq.h> 14 #include <asm/pci.h> 15 #include <asm/pirq_routing.h> 16 17 DECLARE_GLOBAL_DATA_PTR; 18 19 static struct irq_router irq_router; 20 static struct irq_routing_table *pirq_routing_table; 21 22 bool pirq_check_irq_routed(int link, u8 irq) 23 { 24 u8 pirq; 25 int base = irq_router.link_base; 26 27 if (irq_router.config == PIRQ_VIA_PCI) 28 pirq = x86_pci_read_config8(irq_router.bdf, 29 LINK_N2V(link, base)); 30 else 31 pirq = readb(irq_router.ibase + LINK_N2V(link, base)); 32 33 pirq &= 0xf; 34 35 /* IRQ# 0/1/2/8/13 are reserved */ 36 if (pirq < 3 || pirq == 8 || pirq == 13) 37 return false; 38 39 return pirq == irq ? true : false; 40 } 41 42 int pirq_translate_link(int link) 43 { 44 return LINK_V2N(link, irq_router.link_base); 45 } 46 47 void pirq_assign_irq(int link, u8 irq) 48 { 49 int base = irq_router.link_base; 50 51 /* IRQ# 0/1/2/8/13 are reserved */ 52 if (irq < 3 || irq == 8 || irq == 13) 53 return; 54 55 if (irq_router.config == PIRQ_VIA_PCI) 56 x86_pci_write_config8(irq_router.bdf, 57 LINK_N2V(link, base), irq); 58 else 59 writeb(irq, irq_router.ibase + LINK_N2V(link, base)); 60 } 61 62 static struct irq_info *check_dup_entry(struct irq_info *slot_base, 63 int entry_num, int bus, int device) 64 { 65 struct irq_info *slot = slot_base; 66 int i; 67 68 for (i = 0; i < entry_num; i++) { 69 if (slot->bus == bus && slot->devfn == (device << 3)) 70 break; 71 slot++; 72 } 73 74 return (i == entry_num) ? NULL : slot; 75 } 76 77 static inline void fill_irq_info(struct irq_info *slot, int bus, int device, 78 int pin, int pirq) 79 { 80 slot->bus = bus; 81 slot->devfn = (device << 3) | 0; 82 slot->irq[pin - 1].link = LINK_N2V(pirq, irq_router.link_base); 83 slot->irq[pin - 1].bitmap = irq_router.irq_mask; 84 } 85 86 __weak void cpu_irq_init(void) 87 { 88 return; 89 } 90 91 static int create_pirq_routing_table(struct udevice *dev) 92 { 93 const void *blob = gd->fdt_blob; 94 struct fdt_pci_addr addr; 95 int node; 96 int len, count; 97 const u32 *cell; 98 struct irq_routing_table *rt; 99 struct irq_info *slot, *slot_base; 100 int irq_entries = 0; 101 int parent; 102 int i; 103 int ret; 104 105 node = dev->of_offset; 106 parent = dev->parent->of_offset; 107 ret = fdtdec_get_pci_addr(blob, parent, FDT_PCI_SPACE_CONFIG, 108 "reg", &addr); 109 if (ret) 110 return ret; 111 112 /* extract the bdf from fdt_pci_addr */ 113 irq_router.bdf = addr.phys_hi & 0xffff00; 114 115 ret = fdt_find_string(blob, node, "intel,pirq-config", "pci"); 116 if (!ret) { 117 irq_router.config = PIRQ_VIA_PCI; 118 } else { 119 ret = fdt_find_string(blob, node, "intel,pirq-config", "ibase"); 120 if (!ret) 121 irq_router.config = PIRQ_VIA_IBASE; 122 else 123 return -EINVAL; 124 } 125 126 ret = fdtdec_get_int(blob, node, "intel,pirq-link", -1); 127 if (ret == -1) 128 return ret; 129 irq_router.link_base = ret; 130 131 irq_router.irq_mask = fdtdec_get_int(blob, node, 132 "intel,pirq-mask", PIRQ_BITMAP); 133 134 if (irq_router.config == PIRQ_VIA_IBASE) { 135 int ibase_off; 136 137 ibase_off = fdtdec_get_int(blob, node, "intel,ibase-offset", 0); 138 if (!ibase_off) 139 return -EINVAL; 140 141 /* 142 * Here we assume that the IBASE register has already been 143 * properly configured by U-Boot before. 144 * 145 * By 'valid' we mean: 146 * 1) a valid memory space carved within system memory space 147 * assigned to IBASE register block. 148 * 2) memory range decoding is enabled. 149 * Hence we don't do any santify test here. 150 */ 151 irq_router.ibase = x86_pci_read_config32(irq_router.bdf, 152 ibase_off); 153 irq_router.ibase &= ~0xf; 154 } 155 156 cell = fdt_getprop(blob, node, "intel,pirq-routing", &len); 157 if (!cell || len % sizeof(struct pirq_routing)) 158 return -EINVAL; 159 count = len / sizeof(struct pirq_routing); 160 161 rt = calloc(1, sizeof(struct irq_routing_table)); 162 if (!rt) 163 return -ENOMEM; 164 165 /* Populate the PIRQ table fields */ 166 rt->signature = PIRQ_SIGNATURE; 167 rt->version = PIRQ_VERSION; 168 rt->rtr_bus = PCI_BUS(irq_router.bdf); 169 rt->rtr_devfn = (PCI_DEV(irq_router.bdf) << 3) | 170 PCI_FUNC(irq_router.bdf); 171 rt->rtr_vendor = PCI_VENDOR_ID_INTEL; 172 rt->rtr_device = PCI_DEVICE_ID_INTEL_ICH7_31; 173 174 slot_base = rt->slots; 175 176 /* Now fill in the irq_info entries in the PIRQ table */ 177 for (i = 0; i < count; 178 i++, cell += sizeof(struct pirq_routing) / sizeof(u32)) { 179 struct pirq_routing pr; 180 181 pr.bdf = fdt_addr_to_cpu(cell[0]); 182 pr.pin = fdt_addr_to_cpu(cell[1]); 183 pr.pirq = fdt_addr_to_cpu(cell[2]); 184 185 debug("irq_info %d: b.d.f %x.%x.%x INT%c PIRQ%c\n", 186 i, PCI_BUS(pr.bdf), PCI_DEV(pr.bdf), 187 PCI_FUNC(pr.bdf), 'A' + pr.pin - 1, 188 'A' + pr.pirq); 189 190 slot = check_dup_entry(slot_base, irq_entries, 191 PCI_BUS(pr.bdf), PCI_DEV(pr.bdf)); 192 if (slot) { 193 debug("found entry for bus %d device %d, ", 194 PCI_BUS(pr.bdf), PCI_DEV(pr.bdf)); 195 196 if (slot->irq[pr.pin - 1].link) { 197 debug("skipping\n"); 198 199 /* 200 * Sanity test on the routed PIRQ pin 201 * 202 * If they don't match, show a warning to tell 203 * there might be something wrong with the PIRQ 204 * routing information in the device tree. 205 */ 206 if (slot->irq[pr.pin - 1].link != 207 LINK_N2V(pr.pirq, irq_router.link_base)) 208 debug("WARNING: Inconsistent PIRQ routing information\n"); 209 continue; 210 } 211 } else { 212 slot = slot_base + irq_entries++; 213 } 214 debug("writing INT%c\n", 'A' + pr.pin - 1); 215 fill_irq_info(slot, PCI_BUS(pr.bdf), PCI_DEV(pr.bdf), pr.pin, 216 pr.pirq); 217 } 218 219 rt->size = irq_entries * sizeof(struct irq_info) + 32; 220 221 pirq_routing_table = rt; 222 223 return 0; 224 } 225 226 int irq_router_common_init(struct udevice *dev) 227 { 228 int ret; 229 230 cpu_irq_init(); 231 232 ret = create_pirq_routing_table(dev); 233 if (ret) { 234 debug("Failed to create pirq routing table\n"); 235 return ret; 236 } 237 /* Route PIRQ */ 238 pirq_route_irqs(pirq_routing_table->slots, 239 get_irq_slot_count(pirq_routing_table)); 240 241 return 0; 242 } 243 244 int irq_router_probe(struct udevice *dev) 245 { 246 return irq_router_common_init(dev); 247 } 248 249 u32 write_pirq_routing_table(u32 addr) 250 { 251 if (!pirq_routing_table) 252 return addr; 253 254 return copy_pirq_routing_table(addr, pirq_routing_table); 255 } 256 257 static const struct udevice_id irq_router_ids[] = { 258 { .compatible = "intel,irq-router" }, 259 { } 260 }; 261 262 U_BOOT_DRIVER(irq_router_drv) = { 263 .name = "intel_irq", 264 .id = UCLASS_IRQ, 265 .of_match = irq_router_ids, 266 .probe = irq_router_probe, 267 }; 268 269 UCLASS_DRIVER(irq) = { 270 .id = UCLASS_IRQ, 271 .name = "irq", 272 }; 273