diff options
-rw-r--r-- | drivers/amba/bus.c | 113 |
1 files changed, 65 insertions, 48 deletions
diff --git a/drivers/amba/bus.c b/drivers/amba/bus.c index 9e3e2a69c03a..fd5475071acc 100644 --- a/drivers/amba/bus.c +++ b/drivers/amba/bus.c | |||
@@ -80,12 +80,38 @@ static int amba_resume(struct device *dev) | |||
80 | return ret; | 80 | return ret; |
81 | } | 81 | } |
82 | 82 | ||
83 | #define amba_attr_func(name,fmt,arg...) \ | ||
84 | static ssize_t name##_show(struct device *_dev, \ | ||
85 | struct device_attribute *attr, char *buf) \ | ||
86 | { \ | ||
87 | struct amba_device *dev = to_amba_device(_dev); \ | ||
88 | return sprintf(buf, fmt, arg); \ | ||
89 | } | ||
90 | |||
91 | #define amba_attr(name,fmt,arg...) \ | ||
92 | amba_attr_func(name,fmt,arg) \ | ||
93 | static DEVICE_ATTR(name, S_IRUGO, name##_show, NULL) | ||
94 | |||
95 | amba_attr_func(id, "%08x\n", dev->periphid); | ||
96 | amba_attr(irq0, "%u\n", dev->irq[0]); | ||
97 | amba_attr(irq1, "%u\n", dev->irq[1]); | ||
98 | amba_attr_func(resource, "\t%016llx\t%016llx\t%016lx\n", | ||
99 | (unsigned long long)dev->res.start, (unsigned long long)dev->res.end, | ||
100 | dev->res.flags); | ||
101 | |||
102 | static struct device_attribute amba_dev_attrs[] = { | ||
103 | __ATTR_RO(id), | ||
104 | __ATTR_RO(resource), | ||
105 | __ATTR_NULL, | ||
106 | }; | ||
107 | |||
83 | /* | 108 | /* |
84 | * Primecells are part of the Advanced Microcontroller Bus Architecture, | 109 | * Primecells are part of the Advanced Microcontroller Bus Architecture, |
85 | * so we call the bus "amba". | 110 | * so we call the bus "amba". |
86 | */ | 111 | */ |
87 | static struct bus_type amba_bustype = { | 112 | static struct bus_type amba_bustype = { |
88 | .name = "amba", | 113 | .name = "amba", |
114 | .dev_attrs = amba_dev_attrs, | ||
89 | .match = amba_match, | 115 | .match = amba_match, |
90 | .uevent = amba_uevent, | 116 | .uevent = amba_uevent, |
91 | .suspend = amba_suspend, | 117 | .suspend = amba_suspend, |
@@ -169,21 +195,6 @@ static void amba_device_release(struct device *dev) | |||
169 | kfree(d); | 195 | kfree(d); |
170 | } | 196 | } |
171 | 197 | ||
172 | #define amba_attr(name,fmt,arg...) \ | ||
173 | static ssize_t show_##name(struct device *_dev, struct device_attribute *attr, char *buf) \ | ||
174 | { \ | ||
175 | struct amba_device *dev = to_amba_device(_dev); \ | ||
176 | return sprintf(buf, fmt, arg); \ | ||
177 | } \ | ||
178 | static DEVICE_ATTR(name, S_IRUGO, show_##name, NULL) | ||
179 | |||
180 | amba_attr(id, "%08x\n", dev->periphid); | ||
181 | amba_attr(irq0, "%u\n", dev->irq[0]); | ||
182 | amba_attr(irq1, "%u\n", dev->irq[1]); | ||
183 | amba_attr(resource, "\t%016llx\t%016llx\t%016lx\n", | ||
184 | (unsigned long long)dev->res.start, (unsigned long long)dev->res.end, | ||
185 | dev->res.flags); | ||
186 | |||
187 | /** | 198 | /** |
188 | * amba_device_register - register an AMBA device | 199 | * amba_device_register - register an AMBA device |
189 | * @dev: AMBA device to register | 200 | * @dev: AMBA device to register |
@@ -208,40 +219,46 @@ int amba_device_register(struct amba_device *dev, struct resource *parent) | |||
208 | dev_warn(&dev->dev, "coherent dma mask is unset\n"); | 219 | dev_warn(&dev->dev, "coherent dma mask is unset\n"); |
209 | 220 | ||
210 | ret = request_resource(parent, &dev->res); | 221 | ret = request_resource(parent, &dev->res); |
211 | if (ret == 0) { | 222 | if (ret) |
212 | tmp = ioremap(dev->res.start, SZ_4K); | 223 | goto err_out; |
213 | if (!tmp) { | 224 | |
214 | ret = -ENOMEM; | 225 | tmp = ioremap(dev->res.start, SZ_4K); |
215 | goto out; | 226 | if (!tmp) { |
216 | } | 227 | ret = -ENOMEM; |
217 | 228 | goto err_release; | |
218 | for (pid = 0, i = 0; i < 4; i++) | ||
219 | pid |= (readl(tmp + 0xfe0 + 4 * i) & 255) << (i * 8); | ||
220 | for (cid = 0, i = 0; i < 4; i++) | ||
221 | cid |= (readl(tmp + 0xff0 + 4 * i) & 255) << (i * 8); | ||
222 | |||
223 | iounmap(tmp); | ||
224 | |||
225 | if (cid == 0xb105f00d) | ||
226 | dev->periphid = pid; | ||
227 | |||
228 | if (dev->periphid) | ||
229 | ret = device_register(&dev->dev); | ||
230 | else | ||
231 | ret = -ENODEV; | ||
232 | |||
233 | if (ret == 0) { | ||
234 | device_create_file(&dev->dev, &dev_attr_id); | ||
235 | if (dev->irq[0] != NO_IRQ) | ||
236 | device_create_file(&dev->dev, &dev_attr_irq0); | ||
237 | if (dev->irq[1] != NO_IRQ) | ||
238 | device_create_file(&dev->dev, &dev_attr_irq1); | ||
239 | device_create_file(&dev->dev, &dev_attr_resource); | ||
240 | } else { | ||
241 | out: | ||
242 | release_resource(&dev->res); | ||
243 | } | ||
244 | } | 229 | } |
230 | |||
231 | for (pid = 0, i = 0; i < 4; i++) | ||
232 | pid |= (readl(tmp + 0xfe0 + 4 * i) & 255) << (i * 8); | ||
233 | for (cid = 0, i = 0; i < 4; i++) | ||
234 | cid |= (readl(tmp + 0xff0 + 4 * i) & 255) << (i * 8); | ||
235 | |||
236 | iounmap(tmp); | ||
237 | |||
238 | if (cid == 0xb105f00d) | ||
239 | dev->periphid = pid; | ||
240 | |||
241 | if (!dev->periphid) { | ||
242 | ret = -ENODEV; | ||
243 | goto err_release; | ||
244 | } | ||
245 | |||
246 | ret = device_register(&dev->dev); | ||
247 | if (ret) | ||
248 | goto err_release; | ||
249 | |||
250 | if (dev->irq[0] != NO_IRQ) | ||
251 | ret = device_create_file(&dev->dev, &dev_attr_irq0); | ||
252 | if (ret == 0 && dev->irq[1] != NO_IRQ) | ||
253 | ret = device_create_file(&dev->dev, &dev_attr_irq1); | ||
254 | if (ret == 0) | ||
255 | return ret; | ||
256 | |||
257 | device_unregister(&dev->dev); | ||
258 | |||
259 | err_release: | ||
260 | release_resource(&dev->res); | ||
261 | err_out: | ||
245 | return ret; | 262 | return ret; |
246 | } | 263 | } |
247 | 264 | ||