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         dev->dev.archdata.numa_node = of_node_to_nid(np);
  82
  83         if (bus_id)
  84                 strlcpy(dev->dev.bus_id, bus_id, BUS_ID_SIZE);
  85         else
  86                 of_device_make_bus_id(dev);
  87
  88         return dev;
  89 }
  90 EXPORT_SYMBOL(of_device_alloc);
  91
  92 ssize_t of_device_get_modalias(struct of_device *ofdev,
  93                                 char *str, ssize_t len)
  94 {
  95         const char *compat;
  96         int cplen, i;
  97         ssize_t tsize, csize, repend;
  98
  99         /* Name & Type */
 100         csize = snprintf(str, len, "of:N%sT%s",
 101                                 ofdev->node->name, ofdev->node->type);
 102
 103         /* Get compatible property if any */
 104         compat = of_get_property(ofdev->node, "compatible", &cplen);
 105         if (!compat)
 106                 return csize;
 107
 108         /* Find true end (we tolerate multiple \0 at the end */
 109         for (i=(cplen-1); i>=0 && !compat[i]; i--)
 110                 cplen--;
 111         if (!cplen)
 112                 return csize;
 113         cplen++;
 114
 115         /* Check space (need cplen+1 chars including final \0) */
 116         tsize = csize + cplen;
 117         repend = tsize;
 118
 119         if (csize>=len)         /* @ the limit, all is already filled */
 120                 return tsize;
 121
 122         if (tsize>=len) {               /* limit compat list */
 123                 cplen = len-csize-1;
 124                 repend = len;
 125         }
 126
 127         /* Copy and do char replacement */
 128         memcpy(&str[csize+1], compat, cplen);
 129         for (i=csize; i<repend; i++) {
 130                 char c = str[i];
 131                 if (c=='\0')
 132                         str[i] = 'C';
 133                 else if (c==' ')
 134                         str[i] = '_';
 135         }
 136
 137         return tsize;
 138 }
 139
 140 int of_device_uevent(struct device *dev, struct kobj_uevent_env *env)
 141 {
 142         struct of_device *ofdev;
 143         const char *compat;
 144         int seen = 0, cplen, sl;
 145
 146         if (!dev)
 147                 return -ENODEV;
 148
 149         ofdev = to_of_device(dev);
 150
 151         if (add_uevent_var(env, "OF_NAME=%s", ofdev->node->name))
 152                 return -ENOMEM;
 153
 154         if (add_uevent_var(env, "OF_TYPE=%s", ofdev->node->type))
 155                 return -ENOMEM;
 156
 157         /* Since the compatible field can contain pretty much anything
 158          * it's not really legal to split it out with commas. We split it
 159          * up using a number of environment variables instead. */
 160
 161         compat = of_get_property(ofdev->node, "compatible", &cplen);
 162         while (compat && *compat && cplen > 0) {
 163                 if (add_uevent_var(env, "OF_COMPATIBLE_%d=%s", seen, compat))
 164                         return -ENOMEM;
 165
 166                 sl = strlen (compat) + 1;
 167                 compat += sl;
 168                 cplen -= sl;
 169                 seen++;
 170         }
 171
 172         if (add_uevent_var(env, "OF_COMPATIBLE_N=%d", seen))
 173                 return -ENOMEM;
 174
 175         /* modalias is trickier, we add it in 2 steps */
 176         if (add_uevent_var(env, "MODALIAS="))
 177                 return -ENOMEM;
 178         sl = of_device_get_modalias(ofdev, &env->buf[env->buflen-1],
 179                                     sizeof(env->buf) - env->buflen);
 180         if (sl >= (sizeof(env->buf) - env->buflen))
 181                 return -ENOMEM;
 182         env->buflen += sl;
 183
 184         return 0;
 185 }
 186 EXPORT_SYMBOL(of_device_uevent);
 187 EXPORT_SYMBOL(of_device_get_modalias);