[ARM] pxa: Gumstix Verdex PCMCIA support
[linux-2.6/verdex.git] / drivers / of / device.c
blob224ae6bc67b6bb7b5b893192b7170cc6be8ef29c
1 #include <linux/string.h>
2 #include <linux/kernel.h>
3 #include <linux/of.h>
4 #include <linux/of_device.h>
5 #include <linux/init.h>
6 #include <linux/module.h>
7 #include <linux/mod_devicetable.h>
8 #include <linux/slab.h>
10 #include <asm/errno.h>
12 /**
13 * of_match_device - Tell if an of_device structure has a matching
14 * of_match structure
15 * @ids: array of of device match structures to search in
16 * @dev: the of device structure to match against
18 * Used by a driver to check whether an of_device present in the
19 * system is in its list of supported devices.
21 const struct of_device_id *of_match_device(const struct of_device_id *matches,
22 const struct of_device *dev)
24 if (!dev->node)
25 return NULL;
26 return of_match_node(matches, dev->node);
28 EXPORT_SYMBOL(of_match_device);
30 struct of_device *of_dev_get(struct of_device *dev)
32 struct device *tmp;
34 if (!dev)
35 return NULL;
36 tmp = get_device(&dev->dev);
37 if (tmp)
38 return to_of_device(tmp);
39 else
40 return NULL;
42 EXPORT_SYMBOL(of_dev_get);
44 void of_dev_put(struct of_device *dev)
46 if (dev)
47 put_device(&dev->dev);
49 EXPORT_SYMBOL(of_dev_put);
51 static ssize_t devspec_show(struct device *dev,
52 struct device_attribute *attr, char *buf)
54 struct of_device *ofdev;
56 ofdev = to_of_device(dev);
57 return sprintf(buf, "%s\n", ofdev->node->full_name);
60 static ssize_t name_show(struct device *dev,
61 struct device_attribute *attr, char *buf)
63 struct of_device *ofdev;
65 ofdev = to_of_device(dev);
66 return sprintf(buf, "%s\n", ofdev->node->name);
69 static ssize_t modalias_show(struct device *dev,
70 struct device_attribute *attr, char *buf)
72 struct of_device *ofdev = to_of_device(dev);
73 ssize_t len = 0;
75 len = of_device_get_modalias(ofdev, buf, PAGE_SIZE - 2);
76 buf[len] = '\n';
77 buf[len+1] = 0;
78 return len+1;
81 struct device_attribute of_platform_device_attrs[] = {
82 __ATTR_RO(devspec),
83 __ATTR_RO(name),
84 __ATTR_RO(modalias),
85 __ATTR_NULL
88 /**
89 * of_release_dev - free an of device structure when all users of it are finished.
90 * @dev: device that's been disconnected
92 * Will be called only by the device core when all users of this of device are
93 * done.
95 void of_release_dev(struct device *dev)
97 struct of_device *ofdev;
99 ofdev = to_of_device(dev);
100 of_node_put(ofdev->node);
101 kfree(ofdev);
103 EXPORT_SYMBOL(of_release_dev);
105 int of_device_register(struct of_device *ofdev)
107 BUG_ON(ofdev->node == NULL);
109 device_initialize(&ofdev->dev);
111 /* device_add will assume that this device is on the same node as
112 * the parent. If there is no parent defined, set the node
113 * explicitly */
114 if (!ofdev->dev.parent)
115 set_dev_node(&ofdev->dev, of_node_to_nid(ofdev->node));
117 return device_add(&ofdev->dev);
119 EXPORT_SYMBOL(of_device_register);
121 void of_device_unregister(struct of_device *ofdev)
123 device_unregister(&ofdev->dev);
125 EXPORT_SYMBOL(of_device_unregister);
127 ssize_t of_device_get_modalias(struct of_device *ofdev,
128 char *str, ssize_t len)
130 const char *compat;
131 int cplen, i;
132 ssize_t tsize, csize, repend;
134 /* Name & Type */
135 csize = snprintf(str, len, "of:N%sT%s",
136 ofdev->node->name, ofdev->node->type);
138 /* Get compatible property if any */
139 compat = of_get_property(ofdev->node, "compatible", &cplen);
140 if (!compat)
141 return csize;
143 /* Find true end (we tolerate multiple \0 at the end */
144 for (i = (cplen - 1); i >= 0 && !compat[i]; i--)
145 cplen--;
146 if (!cplen)
147 return csize;
148 cplen++;
150 /* Check space (need cplen+1 chars including final \0) */
151 tsize = csize + cplen;
152 repend = tsize;
154 if (csize >= len) /* @ the limit, all is already filled */
155 return tsize;
157 if (tsize >= len) { /* limit compat list */
158 cplen = len - csize - 1;
159 repend = len;
162 /* Copy and do char replacement */
163 memcpy(&str[csize + 1], compat, cplen);
164 for (i = csize; i < repend; i++) {
165 char c = str[i];
166 if (c == '\0')
167 str[i] = 'C';
168 else if (c == ' ')
169 str[i] = '_';
172 return tsize;