git.oblomov.eu Git - linux-2.6/blob - arch/sparc/kernel/of_device.c

   1 #include <linux/string.h>
   2 #include <linux/kernel.h>
   3 #include <linux/of.h>
   4 #include <linux/init.h>
   5 #include <linux/module.h>
   6 #include <linux/mod_devicetable.h>
   7 #include <linux/slab.h>
   8 #include <linux/errno.h>
   9 #include <linux/of_device.h>
  10 #include <linux/of_platform.h>
  11
  12 static int node_match(struct device *dev, void *data)
  13 {
  14         struct of_device *op = to_of_device(dev);
  15         struct device_node *dp = data;
  16
  17         return (op->node == dp);
  18 }
  19
  20 struct of_device *of_find_device_by_node(struct device_node *dp)
  21 {
  22         struct device *dev = bus_find_device(&of_platform_bus_type, NULL,
  23                                              dp, node_match);
  24
  25         if (dev)
  26                 return to_of_device(dev);
  27
  28         return NULL;
  29 }
  30 EXPORT_SYMBOL(of_find_device_by_node);
  31
  32 unsigned int irq_of_parse_and_map(struct device_node *node, int index)
  33 {
  34         struct of_device *op = of_find_device_by_node(node);
  35
  36         if (!op || index >= op->num_irqs)
  37                 return 0;
  38
  39         return op->irqs[index];
  40 }
  41 EXPORT_SYMBOL(irq_of_parse_and_map);
  42
  43 /* Take the archdata values for IOMMU, STC, and HOSTDATA found in
  44  * BUS and propagate to all child of_device objects.
  45  */
  46 void of_propagate_archdata(struct of_device *bus)
  47 {
  48         struct dev_archdata *bus_sd = &bus->dev.archdata;
  49         struct device_node *bus_dp = bus->node;
  50         struct device_node *dp;
  51
  52         for (dp = bus_dp->child; dp; dp = dp->sibling) {
  53                 struct of_device *op = of_find_device_by_node(dp);
  54
  55                 op->dev.archdata.iommu = bus_sd->iommu;
  56                 op->dev.archdata.stc = bus_sd->stc;
  57                 op->dev.archdata.host_controller = bus_sd->host_controller;
  58                 op->dev.archdata.numa_node = bus_sd->numa_node;
  59
  60                 if (dp->child)
  61                         of_propagate_archdata(op);
  62         }
  63 }
  64
  65 struct bus_type of_platform_bus_type;
  66 EXPORT_SYMBOL(of_platform_bus_type);
  67
  68 static inline u64 of_read_addr(const u32 *cell, int size)
  69 {
  70         u64 r = 0;
  71         while (size--)
  72                 r = (r << 32) | *(cell++);
  73         return r;
  74 }
  75
  76 static void __init get_cells(struct device_node *dp,
  77                              int *addrc, int *sizec)
  78 {
  79         if (addrc)
  80                 *addrc = of_n_addr_cells(dp);
  81         if (sizec)
  82                 *sizec = of_n_size_cells(dp);
  83 }
  84
  85 /* Max address size we deal with */
  86 #define OF_MAX_ADDR_CELLS       4
  87
  88 struct of_bus {
  89         const char      *name;
  90         const char      *addr_prop_name;
  91         int             (*match)(struct device_node *parent);
  92         void            (*count_cells)(struct device_node *child,
  93                                        int *addrc, int *sizec);
  94         int             (*map)(u32 *addr, const u32 *range,
  95                                int na, int ns, int pna);
  96         unsigned long   (*get_flags)(const u32 *addr, unsigned long);
  97 };
  98
  99 /*
 100  * Default translator (generic bus)
 101  */
 102
 103 static void of_bus_default_count_cells(struct device_node *dev,
 104                                        int *addrc, int *sizec)
 105 {
 106         get_cells(dev, addrc, sizec);
 107 }
 108
 109 /* Make sure the least significant 64-bits are in-range.  Even
 110  * for 3 or 4 cell values it is a good enough approximation.
 111  */
 112 static int of_out_of_range(const u32 *addr, const u32 *base,
 113                            const u32 *size, int na, int ns)
 114 {
 115         u64 a = of_read_addr(addr, na);
 116         u64 b = of_read_addr(base, na);
 117
 118         if (a < b)
 119                 return 1;
 120
 121         b += of_read_addr(size, ns);
 122         if (a >= b)
 123                 return 1;
 124
 125         return 0;
 126 }
 127
 128 static int of_bus_default_map(u32 *addr, const u32 *range,
 129                               int na, int ns, int pna)
 130 {
 131         u32 result[OF_MAX_ADDR_CELLS];
 132         int i;
 133
 134         if (ns > 2) {
 135                 printk("of_device: Cannot handle size cells (%d) > 2.", ns);
 136                 return -EINVAL;
 137         }
 138
 139         if (of_out_of_range(addr, range, range + na + pna, na, ns))
 140                 return -EINVAL;
 141
 142         /* Start with the parent range base.  */
 143         memcpy(result, range + na, pna * 4);
 144
 145         /* Add in the child address offset.  */
 146         for (i = 0; i < na; i++)
 147                 result[pna - 1 - i] +=
 148                         (addr[na - 1 - i] -
 149                          range[na - 1 - i]);
 150
 151         memcpy(addr, result, pna * 4);
 152
 153         return 0;
 154 }
 155
 156 static unsigned long of_bus_default_get_flags(const u32 *addr, unsigned long flags)
 157 {
 158         if (flags)
 159                 return flags;
 160         return IORESOURCE_MEM;
 161 }
 162
 163 /*
 164  * PCI bus specific translator
 165  */
 166
 167 static int of_bus_pci_match(struct device_node *np)
 168 {
 169         if (!strcmp(np->type, "pci") || !strcmp(np->type, "pciex")) {
 170                 /* Do not do PCI specific frobbing if the
 171                  * PCI bridge lacks a ranges property.  We
 172                  * want to pass it through up to the next
 173                  * parent as-is, not with the PCI translate
 174                  * method which chops off the top address cell.
 175                  */
 176                 if (!of_find_property(np, "ranges", NULL))
 177                         return 0;
 178
 179                 return 1;
 180         }
 181
 182         return 0;
 183 }
 184
 185 static void of_bus_pci_count_cells(struct device_node *np,
 186                                    int *addrc, int *sizec)
 187 {
 188         if (addrc)
 189                 *addrc = 3;
 190         if (sizec)
 191                 *sizec = 2;
 192 }
 193
 194 static int of_bus_pci_map(u32 *addr, const u32 *range,
 195                           int na, int ns, int pna)
 196 {
 197         u32 result[OF_MAX_ADDR_CELLS];
 198         int i;
 199
 200         /* Check address type match */
 201         if ((addr[0] ^ range[0]) & 0x03000000)
 202                 return -EINVAL;
 203
 204         if (of_out_of_range(addr + 1, range + 1, range + na + pna,
 205                             na - 1, ns))
 206                 return -EINVAL;
 207
 208         /* Start with the parent range base.  */
 209         memcpy(result, range + na, pna * 4);
 210
 211         /* Add in the child address offset, skipping high cell.  */
 212         for (i = 0; i < na - 1; i++)
 213                 result[pna - 1 - i] +=
 214                         (addr[na - 1 - i] -
 215                          range[na - 1 - i]);
 216
 217         memcpy(addr, result, pna * 4);
 218
 219         return 0;
 220 }
 221
 222 static unsigned long of_bus_pci_get_flags(const u32 *addr, unsigned long flags)
 223 {
 224         u32 w = addr[0];
 225
 226         /* For PCI, we override whatever child busses may have used.  */
 227         flags = 0;
 228         switch((w >> 24) & 0x03) {
 229         case 0x01:
 230                 flags |= IORESOURCE_IO;
 231                 break;
 232
 233         case 0x02: /* 32 bits */
 234         case 0x03: /* 64 bits */
 235                 flags |= IORESOURCE_MEM;
 236                 break;
 237         }
 238         if (w & 0x40000000)
 239                 flags |= IORESOURCE_PREFETCH;
 240         return flags;
 241 }
 242
 243 /*
 244  * SBUS bus specific translator
 245  */
 246
 247 static int of_bus_sbus_match(struct device_node *np)
 248 {
 249         return !strcmp(np->name, "sbus") ||
 250                 !strcmp(np->name, "sbi");
 251 }
 252
 253 static void of_bus_sbus_count_cells(struct device_node *child,
 254                                    int *addrc, int *sizec)
 255 {
 256         if (addrc)
 257                 *addrc = 2;
 258         if (sizec)
 259                 *sizec = 1;
 260 }
 261
 262 static int of_bus_sbus_map(u32 *addr, const u32 *range, int na, int ns, int pna)
 263 {
 264         return of_bus_default_map(addr, range, na, ns, pna);
 265 }
 266
 267 static unsigned long of_bus_sbus_get_flags(const u32 *addr, unsigned long flags)
 268 {
 269         return IORESOURCE_MEM;
 270 }
 271
 272
 273 /*
 274  * Array of bus specific translators
 275  */
 276
 277 static struct of_bus of_busses[] = {
 278         /* PCI */
 279         {
 280                 .name = "pci",
 281                 .addr_prop_name = "assigned-addresses",
 282                 .match = of_bus_pci_match,
 283                 .count_cells = of_bus_pci_count_cells,
 284                 .map = of_bus_pci_map,
 285                 .get_flags = of_bus_pci_get_flags,
 286         },
 287         /* SBUS */
 288         {
 289                 .name = "sbus",
 290                 .addr_prop_name = "reg",
 291                 .match = of_bus_sbus_match,
 292                 .count_cells = of_bus_sbus_count_cells,
 293                 .map = of_bus_sbus_map,
 294                 .get_flags = of_bus_sbus_get_flags,
 295         },
 296         /* Default */
 297         {
 298                 .name = "default",
 299                 .addr_prop_name = "reg",
 300                 .match = NULL,
 301                 .count_cells = of_bus_default_count_cells,
 302                 .map = of_bus_default_map,
 303                 .get_flags = of_bus_default_get_flags,
 304         },
 305 };
 306
 307 static struct of_bus *of_match_bus(struct device_node *np)
 308 {
 309         int i;
 310
 311         for (i = 0; i < ARRAY_SIZE(of_busses); i ++)
 312                 if (!of_busses[i].match || of_busses[i].match(np))
 313                         return &of_busses[i];
 314         BUG();
 315         return NULL;
 316 }
 317
 318 static int __init build_one_resource(struct device_node *parent,
 319                                      struct of_bus *bus,
 320                                      struct of_bus *pbus,
 321                                      u32 *addr,
 322                                      int na, int ns, int pna)
 323 {
 324         const u32 *ranges;
 325         unsigned int rlen;
 326         int rone;
 327
 328         ranges = of_get_property(parent, "ranges", &rlen);
 329         if (ranges == NULL || rlen == 0) {
 330                 u32 result[OF_MAX_ADDR_CELLS];
 331                 int i;
 332
 333                 memset(result, 0, pna * 4);
 334                 for (i = 0; i < na; i++)
 335                         result[pna - 1 - i] =
 336                                 addr[na - 1 - i];
 337
 338                 memcpy(addr, result, pna * 4);
 339                 return 0;
 340         }
 341
 342         /* Now walk through the ranges */
 343         rlen /= 4;
 344         rone = na + pna + ns;
 345         for (; rlen >= rone; rlen -= rone, ranges += rone) {
 346                 if (!bus->map(addr, ranges, na, ns, pna))
 347                         return 0;
 348         }
 349
 350         return 1;
 351 }
 352
 353 static int __init use_1to1_mapping(struct device_node *pp)
 354 {
 355         /* If we have a ranges property in the parent, use it.  */
 356         if (of_find_property(pp, "ranges", NULL) != NULL)
 357                 return 0;
 358
 359         /* Some SBUS devices use intermediate nodes to express
 360          * hierarchy within the device itself.  These aren't
 361          * real bus nodes, and don't have a 'ranges' property.
 362          * But, we should still pass the translation work up
 363          * to the SBUS itself.
 364          */
 365         if (!strcmp(pp->name, "dma") ||
 366             !strcmp(pp->name, "espdma") ||
 367             !strcmp(pp->name, "ledma") ||
 368             !strcmp(pp->name, "lebuffer"))
 369                 return 0;
 370
 371         return 1;
 372 }
 373
 374 static int of_resource_verbose;
 375
 376 static void __init build_device_resources(struct of_device *op,
 377                                           struct device *parent)
 378 {
 379         struct of_device *p_op;
 380         struct of_bus *bus;
 381         int na, ns;
 382         int index, num_reg;
 383         const void *preg;
 384
 385         if (!parent)
 386                 return;
 387
 388         p_op = to_of_device(parent);
 389         bus = of_match_bus(p_op->node);
 390         bus->count_cells(op->node, &na, &ns);
 391
 392         preg = of_get_property(op->node, bus->addr_prop_name, &num_reg);
 393         if (!preg || num_reg == 0)
 394                 return;
 395
 396         /* Convert to num-cells.  */
 397         num_reg /= 4;
 398
 399         /* Conver to num-entries.  */
 400         num_reg /= na + ns;
 401
 402         for (index = 0; index < num_reg; index++) {
 403                 struct resource *r = &op->resource[index];
 404                 u32 addr[OF_MAX_ADDR_CELLS];
 405                 const u32 *reg = (preg + (index * ((na + ns) * 4)));
 406                 struct device_node *dp = op->node;
 407                 struct device_node *pp = p_op->node;
 408                 struct of_bus *pbus, *dbus;
 409                 u64 size, result = OF_BAD_ADDR;
 410                 unsigned long flags;
 411                 int dna, dns;
 412                 int pna, pns;
 413
 414                 size = of_read_addr(reg + na, ns);
 415
 416                 memcpy(addr, reg, na * 4);
 417
 418                 flags = bus->get_flags(reg, 0);
 419
 420                 if (use_1to1_mapping(pp)) {
 421                         result = of_read_addr(addr, na);
 422                         goto build_res;
 423                 }
 424
 425                 dna = na;
 426                 dns = ns;
 427                 dbus = bus;
 428
 429                 while (1) {
 430                         dp = pp;
 431                         pp = dp->parent;
 432                         if (!pp) {
 433                                 result = of_read_addr(addr, dna);
 434                                 break;
 435                         }
 436
 437                         pbus = of_match_bus(pp);
 438                         pbus->count_cells(dp, &pna, &pns);
 439
 440                         if (build_one_resource(dp, dbus, pbus, addr,
 441                                                dna, dns, pna))
 442                                 break;
 443
 444                         flags = pbus->get_flags(addr, flags);
 445
 446                         dna = pna;
 447                         dns = pns;
 448                         dbus = pbus;
 449                 }
 450
 451         build_res:
 452                 memset(r, 0, sizeof(*r));
 453
 454                 if (of_resource_verbose)
 455                         printk("%s reg[%d] -> %llx\n",
 456                                op->node->full_name, index,
 457                                result);
 458
 459                 if (result != OF_BAD_ADDR) {
 460                         r->start = result & 0xffffffff;
 461                         r->end = result + size - 1;
 462                         r->flags = flags | ((result >> 32ULL) & 0xffUL);
 463                 }
 464                 r->name = op->node->name;
 465         }
 466 }
 467
 468 static struct of_device * __init scan_one_device(struct device_node *dp,
 469                                                  struct device *parent)
 470 {
 471         struct of_device *op = kzalloc(sizeof(*op), GFP_KERNEL);
 472         const struct linux_prom_irqs *intr;
 473         struct dev_archdata *sd;
 474         int len, i;
 475
 476         if (!op)
 477                 return NULL;
 478
 479         sd = &op->dev.archdata;
 480         sd->prom_node = dp;
 481         sd->op = op;
 482
 483         op->node = dp;
 484
 485         op->clock_freq = of_getintprop_default(dp, "clock-frequency",
 486                                                (25*1000*1000));
 487         op->portid = of_getintprop_default(dp, "upa-portid", -1);
 488         if (op->portid == -1)
 489                 op->portid = of_getintprop_default(dp, "portid", -1);
 490
 491         intr = of_get_property(dp, "intr", &len);
 492         if (intr) {
 493                 op->num_irqs = len / sizeof(struct linux_prom_irqs);
 494                 for (i = 0; i < op->num_irqs; i++)
 495                         op->irqs[i] = intr[i].pri;
 496         } else {
 497                 const unsigned int *irq =
 498                         of_get_property(dp, "interrupts", &len);
 499
 500                 if (irq) {
 501                         op->num_irqs = len / sizeof(unsigned int);
 502                         for (i = 0; i < op->num_irqs; i++)
 503                                 op->irqs[i] = irq[i];
 504                 } else {
 505                         op->num_irqs = 0;
 506                 }
 507         }
 508         if (sparc_cpu_model == sun4d) {
 509                 static int pil_to_sbus[] = {
 510                         0, 0, 1, 2, 0, 3, 0, 4, 0, 5, 0, 6, 0, 7, 0, 0,
 511                 };
 512                 struct device_node *io_unit, *sbi = dp->parent;
 513                 const struct linux_prom_registers *regs;
 514                 int board, slot;
 515
 516                 while (sbi) {
 517                         if (!strcmp(sbi->name, "sbi"))
 518                                 break;
 519
 520                         sbi = sbi->parent;
 521                 }
 522                 if (!sbi)
 523                         goto build_resources;
 524
 525                 regs = of_get_property(dp, "reg", NULL);
 526                 if (!regs)
 527                         goto build_resources;
 528
 529                 slot = regs->which_io;
 530
 531                 /* If SBI's parent is not io-unit or the io-unit lacks
 532                  * a "board#" property, something is very wrong.
 533                  */
 534                 if (!sbi->parent || strcmp(sbi->parent->name, "io-unit")) {
 535                         printk("%s: Error, parent is not io-unit.\n",
 536                                sbi->full_name);
 537                         goto build_resources;
 538                 }
 539                 io_unit = sbi->parent;
 540                 board = of_getintprop_default(io_unit, "board#", -1);
 541                 if (board == -1) {
 542                         printk("%s: Error, lacks board# property.\n",
 543                                io_unit->full_name);
 544                         goto build_resources;
 545                 }
 546
 547                 for (i = 0; i < op->num_irqs; i++) {
 548                         int this_irq = op->irqs[i];
 549                         int sbusl = pil_to_sbus[this_irq];
 550
 551                         if (sbusl)
 552                                 this_irq = (((board + 1) << 5) +
 553                                             (sbusl << 2) +
 554                                             slot);
 555
 556                         op->irqs[i] = this_irq;
 557                 }
 558         }
 559
 560 build_resources:
 561         build_device_resources(op, parent);
 562
 563         op->dev.parent = parent;
 564         op->dev.bus = &of_platform_bus_type;
 565         if (!parent)
 566                 strcpy(op->dev.bus_id, "root");
 567         else
 568                 sprintf(op->dev.bus_id, "%08x", dp->node);
 569
 570         if (of_device_register(op)) {
 571                 printk("%s: Could not register of device.\n",
 572                        dp->full_name);
 573                 kfree(op);
 574                 op = NULL;
 575         }
 576
 577         return op;
 578 }
 579
 580 static void __init scan_tree(struct device_node *dp, struct device *parent)
 581 {
 582         while (dp) {
 583                 struct of_device *op = scan_one_device(dp, parent);
 584
 585                 if (op)
 586                         scan_tree(dp->child, &op->dev);
 587
 588                 dp = dp->sibling;
 589         }
 590 }
 591
 592 static void __init scan_of_devices(void)
 593 {
 594         struct device_node *root = of_find_node_by_path("/");
 595         struct of_device *parent;
 596
 597         parent = scan_one_device(root, NULL);
 598         if (!parent)
 599                 return;
 600
 601         scan_tree(root->child, &parent->dev);
 602 }
 603
 604 static int __init of_bus_driver_init(void)
 605 {
 606         int err;
 607
 608         err = of_bus_type_init(&of_platform_bus_type, "of");
 609         if (!err)
 610                 scan_of_devices();
 611
 612         return err;
 613 }
 614
 615 postcore_initcall(of_bus_driver_init);
 616
 617 static int __init of_debug(char *str)
 618 {
 619         int val = 0;
 620
 621         get_option(&str, &val);
 622         if (val & 1)
 623                 of_resource_verbose = 1;
 624         return 1;
 625 }
 626
 627 __setup("of_debug=", of_debug);