arch/powerpc/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/of_device.h>
   9
  10 #include <asm/errno.h>
  11 #include <asm/dcr.h>
  12
  13 static void of_device_make_bus_id(struct of_device *dev)
  14 {
  15         static atomic_t bus_no_reg_magic;
  16         struct device_node *node = dev->node;
  17         char *name = dev->dev.bus_id;
  18         const u32 *reg;
  19         u64 addr;
  20         int magic;
  21
  22         /*
  23          * If it's a DCR based device, use 'd' for native DCRs
  24          * and 'D' for MMIO DCRs.
  25          */
  26 #ifdef CONFIG_PPC_DCR
  27         reg = of_get_property(node, "dcr-reg", NULL);
  28         if (reg) {
  29 #ifdef CONFIG_PPC_DCR_NATIVE
  30                 snprintf(name, BUS_ID_SIZE, "d%x.%s",
  31                          *reg, node->name);
  32 #else /* CONFIG_PPC_DCR_NATIVE */
  33                 addr = of_translate_dcr_address(node, *reg, NULL);
  34                 if (addr != OF_BAD_ADDR) {
  35                         snprintf(name, BUS_ID_SIZE,
  36                                  "D%llx.%s", (unsigned long long)addr,
  37                                  node->name);
  38                         return;
  39                 }
  40 #endif /* !CONFIG_PPC_DCR_NATIVE */
  41         }
  42 #endif /* CONFIG_PPC_DCR */
  43
  44         /*
  45          * For MMIO, get the physical address
  46          */
  47         reg = of_get_property(node, "reg", NULL);
  48         if (reg) {
  49                 addr = of_translate_address(node, reg);
  50                 if (addr != OF_BAD_ADDR) {
  51                         snprintf(name, BUS_ID_SIZE,
  52                                  "%llx.%s", (unsigned long long)addr,
  53                                  node->name);
  54                         return;
  55                 }
  56         }
  57
  58         /*
  59          * No BusID, use the node name and add a globally incremented
  60          * counter (and pray...)
  61          */
  62         magic = atomic_add_return(1, &bus_no_reg_magic);
  63         snprintf(name, BUS_ID_SIZE, "%s.%d", node->name, magic - 1);
  64 }
  65
  66 struct of_device *of_device_alloc(struct device_node *np,
  67                                   const char *bus_id,
  68                                   struct device *parent)
  69 {
  70         struct of_device *dev;
  71
  72         dev = kzalloc(sizeof(*dev), GFP_KERNEL);
  73         if (!dev)
  74                 return NULL;
  75
  76         dev->node = of_node_get(np);
  77         dev->dev.dma_mask = &dev->dma_mask;
  78         dev->dev.parent = parent;
  79         dev->dev.release = of_release_dev;
  80         dev->dev.archdata.of_node = np;
  81
  82         if (bus_id)
  83                 strlcpy(dev->dev.bus_id, bus_id, BUS_ID_SIZE);
  84         else
  85                 of_device_make_bus_id(dev);
  86
  87         return dev;
  88 }
  89 EXPORT_SYMBOL(of_device_alloc);
  90
  91 int of_device_uevent(struct device *dev, struct kobj_uevent_env *env)
  92 {
  93         struct of_device *ofdev;
  94         const char *compat;
  95         int seen = 0, cplen, sl;
  96
  97         if (!dev)
  98                 return -ENODEV;
  99
 100         ofdev = to_of_device(dev);
 101
 102         if (add_uevent_var(env, "OF_NAME=%s", ofdev->node->name))
 103                 return -ENOMEM;
 104
 105         if (add_uevent_var(env, "OF_TYPE=%s", ofdev->node->type))
 106                 return -ENOMEM;
 107
 108         /* Since the compatible field can contain pretty much anything
 109          * it's not really legal to split it out with commas. We split it
 110          * up using a number of environment variables instead. */
 111
 112         compat = of_get_property(ofdev->node, "compatible", &cplen);
 113         while (compat && *compat && cplen > 0) {
 114                 if (add_uevent_var(env, "OF_COMPATIBLE_%d=%s", seen, compat))
 115                         return -ENOMEM;
 116
 117                 sl = strlen (compat) + 1;
 118                 compat += sl;
 119                 cplen -= sl;
 120                 seen++;
 121         }
 122
 123         if (add_uevent_var(env, "OF_COMPATIBLE_N=%d", seen))
 124                 return -ENOMEM;
 125
 126         /* modalias is trickier, we add it in 2 steps */
 127         if (add_uevent_var(env, "MODALIAS="))
 128                 return -ENOMEM;
 129         sl = of_device_get_modalias(ofdev, &env->buf[env->buflen-1],
 130                                     sizeof(env->buf) - env->buflen);
 131         if (sl >= (sizeof(env->buf) - env->buflen))
 132                 return -ENOMEM;
 133         env->buflen += sl;
 134
 135         return 0;
 136 }
 137 EXPORT_SYMBOL(of_device_uevent);
 138 EXPORT_SYMBOL(of_device_get_modalias);