OF-device: Don't overwrite numa_node in device registration
[linux-2.6.git] / 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);