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