arch/sparc/kernel/of_device_32.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/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_irq_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_irq_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);