1 // SPDX-License-Identifier: GPL-2.0 2 #include <linux/string.h> 3 #include <linux/kernel.h> 4 #include <linux/of.h> 5 #include <linux/init.h> 6 #include <linux/mod_devicetable.h> 7 #include <linux/slab.h> 8 #include <linux/errno.h> 9 #include <linux/irq.h> 10 #include <linux/of_device.h> 11 #include <linux/of_platform.h> 12 #include <asm/leon.h> 13 #include <asm/leon_amba.h> 14 15 #include "of_device_common.h" 16 #include "irq.h" 17 18 /* 19 * PCI bus specific translator 20 */ 21 22 static int of_bus_pci_match(struct device_node *np) 23 { 24 if (!strcmp(np->type, "pci") || !strcmp(np->type, "pciex")) { 25 /* Do not do PCI specific frobbing if the 26 * PCI bridge lacks a ranges property. We 27 * want to pass it through up to the next 28 * parent as-is, not with the PCI translate 29 * method which chops off the top address cell. 30 */ 31 if (!of_find_property(np, "ranges", NULL)) 32 return 0; 33 34 return 1; 35 } 36 37 return 0; 38 } 39 40 static void of_bus_pci_count_cells(struct device_node *np, 41 int *addrc, int *sizec) 42 { 43 if (addrc) 44 *addrc = 3; 45 if (sizec) 46 *sizec = 2; 47 } 48 49 static int of_bus_pci_map(u32 *addr, const u32 *range, 50 int na, int ns, int pna) 51 { 52 u32 result[OF_MAX_ADDR_CELLS]; 53 int i; 54 55 /* Check address type match */ 56 if ((addr[0] ^ range[0]) & 0x03000000) 57 return -EINVAL; 58 59 if (of_out_of_range(addr + 1, range + 1, range + na + pna, 60 na - 1, ns)) 61 return -EINVAL; 62 63 /* Start with the parent range base. */ 64 memcpy(result, range + na, pna * 4); 65 66 /* Add in the child address offset, skipping high cell. */ 67 for (i = 0; i < na - 1; i++) 68 result[pna - 1 - i] += 69 (addr[na - 1 - i] - 70 range[na - 1 - i]); 71 72 memcpy(addr, result, pna * 4); 73 74 return 0; 75 } 76 77 static unsigned long of_bus_pci_get_flags(const u32 *addr, unsigned long flags) 78 { 79 u32 w = addr[0]; 80 81 /* For PCI, we override whatever child busses may have used. */ 82 flags = 0; 83 switch((w >> 24) & 0x03) { 84 case 0x01: 85 flags |= IORESOURCE_IO; 86 break; 87 88 case 0x02: /* 32 bits */ 89 case 0x03: /* 64 bits */ 90 flags |= IORESOURCE_MEM; 91 break; 92 } 93 if (w & 0x40000000) 94 flags |= IORESOURCE_PREFETCH; 95 return flags; 96 } 97 98 static unsigned long of_bus_sbus_get_flags(const u32 *addr, unsigned long flags) 99 { 100 return IORESOURCE_MEM; 101 } 102 103 /* 104 * AMBAPP bus specific translator 105 */ 106 107 static int of_bus_ambapp_match(struct device_node *np) 108 { 109 return !strcmp(np->type, "ambapp"); 110 } 111 112 static void of_bus_ambapp_count_cells(struct device_node *child, 113 int *addrc, int *sizec) 114 { 115 if (addrc) 116 *addrc = 1; 117 if (sizec) 118 *sizec = 1; 119 } 120 121 static int of_bus_ambapp_map(u32 *addr, const u32 *range, 122 int na, int ns, int pna) 123 { 124 return of_bus_default_map(addr, range, na, ns, pna); 125 } 126 127 static unsigned long of_bus_ambapp_get_flags(const u32 *addr, 128 unsigned long flags) 129 { 130 return IORESOURCE_MEM; 131 } 132 133 /* 134 * Array of bus specific translators 135 */ 136 137 static struct of_bus of_busses[] = { 138 /* PCI */ 139 { 140 .name = "pci", 141 .addr_prop_name = "assigned-addresses", 142 .match = of_bus_pci_match, 143 .count_cells = of_bus_pci_count_cells, 144 .map = of_bus_pci_map, 145 .get_flags = of_bus_pci_get_flags, 146 }, 147 /* SBUS */ 148 { 149 .name = "sbus", 150 .addr_prop_name = "reg", 151 .match = of_bus_sbus_match, 152 .count_cells = of_bus_sbus_count_cells, 153 .map = of_bus_default_map, 154 .get_flags = of_bus_sbus_get_flags, 155 }, 156 /* AMBA */ 157 { 158 .name = "ambapp", 159 .addr_prop_name = "reg", 160 .match = of_bus_ambapp_match, 161 .count_cells = of_bus_ambapp_count_cells, 162 .map = of_bus_ambapp_map, 163 .get_flags = of_bus_ambapp_get_flags, 164 }, 165 /* Default */ 166 { 167 .name = "default", 168 .addr_prop_name = "reg", 169 .match = NULL, 170 .count_cells = of_bus_default_count_cells, 171 .map = of_bus_default_map, 172 .get_flags = of_bus_default_get_flags, 173 }, 174 }; 175 176 static struct of_bus *of_match_bus(struct device_node *np) 177 { 178 int i; 179 180 for (i = 0; i < ARRAY_SIZE(of_busses); i ++) 181 if (!of_busses[i].match || of_busses[i].match(np)) 182 return &of_busses[i]; 183 BUG(); 184 return NULL; 185 } 186 187 static int __init build_one_resource(struct device_node *parent, 188 struct of_bus *bus, 189 struct of_bus *pbus, 190 u32 *addr, 191 int na, int ns, int pna) 192 { 193 const u32 *ranges; 194 unsigned int rlen; 195 int rone; 196 197 ranges = of_get_property(parent, "ranges", &rlen); 198 if (ranges == NULL || rlen == 0) { 199 u32 result[OF_MAX_ADDR_CELLS]; 200 int i; 201 202 memset(result, 0, pna * 4); 203 for (i = 0; i < na; i++) 204 result[pna - 1 - i] = 205 addr[na - 1 - i]; 206 207 memcpy(addr, result, pna * 4); 208 return 0; 209 } 210 211 /* Now walk through the ranges */ 212 rlen /= 4; 213 rone = na + pna + ns; 214 for (; rlen >= rone; rlen -= rone, ranges += rone) { 215 if (!bus->map(addr, ranges, na, ns, pna)) 216 return 0; 217 } 218 219 return 1; 220 } 221 222 static int __init use_1to1_mapping(struct device_node *pp) 223 { 224 /* If we have a ranges property in the parent, use it. */ 225 if (of_find_property(pp, "ranges", NULL) != NULL) 226 return 0; 227 228 /* Some SBUS devices use intermediate nodes to express 229 * hierarchy within the device itself. These aren't 230 * real bus nodes, and don't have a 'ranges' property. 231 * But, we should still pass the translation work up 232 * to the SBUS itself. 233 */ 234 if (!strcmp(pp->name, "dma") || 235 !strcmp(pp->name, "espdma") || 236 !strcmp(pp->name, "ledma") || 237 !strcmp(pp->name, "lebuffer")) 238 return 0; 239 240 return 1; 241 } 242 243 static int of_resource_verbose; 244 245 static void __init build_device_resources(struct platform_device *op, 246 struct device *parent) 247 { 248 struct platform_device *p_op; 249 struct of_bus *bus; 250 int na, ns; 251 int index, num_reg; 252 const void *preg; 253 254 if (!parent) 255 return; 256 257 p_op = to_platform_device(parent); 258 bus = of_match_bus(p_op->dev.of_node); 259 bus->count_cells(op->dev.of_node, &na, &ns); 260 261 preg = of_get_property(op->dev.of_node, bus->addr_prop_name, &num_reg); 262 if (!preg || num_reg == 0) 263 return; 264 265 /* Convert to num-cells. */ 266 num_reg /= 4; 267 268 /* Conver to num-entries. */ 269 num_reg /= na + ns; 270 271 op->resource = op->archdata.resource; 272 op->num_resources = num_reg; 273 for (index = 0; index < num_reg; index++) { 274 struct resource *r = &op->resource[index]; 275 u32 addr[OF_MAX_ADDR_CELLS]; 276 const u32 *reg = (preg + (index * ((na + ns) * 4))); 277 struct device_node *dp = op->dev.of_node; 278 struct device_node *pp = p_op->dev.of_node; 279 struct of_bus *pbus, *dbus; 280 u64 size, result = OF_BAD_ADDR; 281 unsigned long flags; 282 int dna, dns; 283 int pna, pns; 284 285 size = of_read_addr(reg + na, ns); 286 287 memcpy(addr, reg, na * 4); 288 289 flags = bus->get_flags(reg, 0); 290 291 if (use_1to1_mapping(pp)) { 292 result = of_read_addr(addr, na); 293 goto build_res; 294 } 295 296 dna = na; 297 dns = ns; 298 dbus = bus; 299 300 while (1) { 301 dp = pp; 302 pp = dp->parent; 303 if (!pp) { 304 result = of_read_addr(addr, dna); 305 break; 306 } 307 308 pbus = of_match_bus(pp); 309 pbus->count_cells(dp, &pna, &pns); 310 311 if (build_one_resource(dp, dbus, pbus, addr, 312 dna, dns, pna)) 313 break; 314 315 flags = pbus->get_flags(addr, flags); 316 317 dna = pna; 318 dns = pns; 319 dbus = pbus; 320 } 321 322 build_res: 323 memset(r, 0, sizeof(*r)); 324 325 if (of_resource_verbose) 326 printk("%s reg[%d] -> %llx\n", 327 op->dev.of_node->full_name, index, 328 result); 329 330 if (result != OF_BAD_ADDR) { 331 r->start = result & 0xffffffff; 332 r->end = result + size - 1; 333 r->flags = flags | ((result >> 32ULL) & 0xffUL); 334 } 335 r->name = op->dev.of_node->name; 336 } 337 } 338 339 static struct platform_device * __init scan_one_device(struct device_node *dp, 340 struct device *parent) 341 { 342 struct platform_device *op = kzalloc(sizeof(*op), GFP_KERNEL); 343 const struct linux_prom_irqs *intr; 344 struct dev_archdata *sd; 345 int len, i; 346 347 if (!op) 348 return NULL; 349 350 sd = &op->dev.archdata; 351 sd->op = op; 352 353 op->dev.of_node = dp; 354 355 intr = of_get_property(dp, "intr", &len); 356 if (intr) { 357 op->archdata.num_irqs = len / sizeof(struct linux_prom_irqs); 358 for (i = 0; i < op->archdata.num_irqs; i++) 359 op->archdata.irqs[i] = 360 sparc_config.build_device_irq(op, intr[i].pri); 361 } else { 362 const unsigned int *irq = 363 of_get_property(dp, "interrupts", &len); 364 365 if (irq) { 366 op->archdata.num_irqs = len / sizeof(unsigned int); 367 for (i = 0; i < op->archdata.num_irqs; i++) 368 op->archdata.irqs[i] = 369 sparc_config.build_device_irq(op, irq[i]); 370 } else { 371 op->archdata.num_irqs = 0; 372 } 373 } 374 375 build_device_resources(op, parent); 376 377 op->dev.parent = parent; 378 op->dev.bus = &platform_bus_type; 379 if (!parent) 380 dev_set_name(&op->dev, "root"); 381 else 382 dev_set_name(&op->dev, "%08x", dp->phandle); 383 384 if (of_device_register(op)) { 385 printk("%s: Could not register of device.\n", 386 dp->full_name); 387 kfree(op); 388 op = NULL; 389 } 390 391 return op; 392 } 393 394 static void __init scan_tree(struct device_node *dp, struct device *parent) 395 { 396 while (dp) { 397 struct platform_device *op = scan_one_device(dp, parent); 398 399 if (op) 400 scan_tree(dp->child, &op->dev); 401 402 dp = dp->sibling; 403 } 404 } 405 406 static int __init scan_of_devices(void) 407 { 408 struct device_node *root = of_find_node_by_path("/"); 409 struct platform_device *parent; 410 411 parent = scan_one_device(root, NULL); 412 if (!parent) 413 return 0; 414 415 scan_tree(root->child, &parent->dev); 416 return 0; 417 } 418 postcore_initcall(scan_of_devices); 419 420 static int __init of_debug(char *str) 421 { 422 int val = 0; 423 424 get_option(&str, &val); 425 if (val & 1) 426 of_resource_verbose = 1; 427 return 1; 428 } 429 430 __setup("of_debug=", of_debug); 431