[PATCH] Fix sysctl unregistration oops (CVE-2005-2709)
[deliverable/linux.git] / drivers / base / platform.c
CommitLineData
1da177e4
LT
1/*
2 * platform.c - platform 'pseudo' bus for legacy devices
3 *
4 * Copyright (c) 2002-3 Patrick Mochel
5 * Copyright (c) 2002-3 Open Source Development Labs
6 *
7 * This file is released under the GPLv2
8 *
9 * Please see Documentation/driver-model/platform.txt for more
10 * information.
11 */
12
d052d1be 13#include <linux/platform_device.h>
1da177e4
LT
14#include <linux/module.h>
15#include <linux/init.h>
16#include <linux/dma-mapping.h>
17#include <linux/bootmem.h>
18#include <linux/err.h>
4e57b681 19#include <linux/slab.h>
1da177e4 20
a1bdc7aa
BD
21#include "base.h"
22
1da177e4
LT
23struct device platform_bus = {
24 .bus_id = "platform",
25};
26
27/**
28 * platform_get_resource - get a resource for a device
29 * @dev: platform device
30 * @type: resource type
31 * @num: resource index
32 */
33struct resource *
34platform_get_resource(struct platform_device *dev, unsigned int type,
35 unsigned int num)
36{
37 int i;
38
39 for (i = 0; i < dev->num_resources; i++) {
40 struct resource *r = &dev->resource[i];
41
42 if ((r->flags & (IORESOURCE_IO|IORESOURCE_MEM|
43 IORESOURCE_IRQ|IORESOURCE_DMA))
44 == type)
45 if (num-- == 0)
46 return r;
47 }
48 return NULL;
49}
50
51/**
52 * platform_get_irq - get an IRQ for a device
53 * @dev: platform device
54 * @num: IRQ number index
55 */
56int platform_get_irq(struct platform_device *dev, unsigned int num)
57{
58 struct resource *r = platform_get_resource(dev, IORESOURCE_IRQ, num);
59
60 return r ? r->start : 0;
61}
62
63/**
64 * platform_get_resource_byname - get a resource for a device by name
65 * @dev: platform device
66 * @type: resource type
67 * @name: resource name
68 */
69struct resource *
70platform_get_resource_byname(struct platform_device *dev, unsigned int type,
71 char *name)
72{
73 int i;
74
75 for (i = 0; i < dev->num_resources; i++) {
76 struct resource *r = &dev->resource[i];
77
78 if ((r->flags & (IORESOURCE_IO|IORESOURCE_MEM|
79 IORESOURCE_IRQ|IORESOURCE_DMA)) == type)
80 if (!strcmp(r->name, name))
81 return r;
82 }
83 return NULL;
84}
85
86/**
87 * platform_get_irq - get an IRQ for a device
88 * @dev: platform device
89 * @name: IRQ name
90 */
91int platform_get_irq_byname(struct platform_device *dev, char *name)
92{
93 struct resource *r = platform_get_resource_byname(dev, IORESOURCE_IRQ, name);
94
95 return r ? r->start : 0;
96}
97
98/**
99 * platform_add_devices - add a numbers of platform devices
100 * @devs: array of platform devices to add
101 * @num: number of platform devices in array
102 */
103int platform_add_devices(struct platform_device **devs, int num)
104{
105 int i, ret = 0;
106
107 for (i = 0; i < num; i++) {
108 ret = platform_device_register(devs[i]);
109 if (ret) {
110 while (--i >= 0)
111 platform_device_unregister(devs[i]);
112 break;
113 }
114 }
115
116 return ret;
117}
118
37c12e74
RK
119struct platform_object {
120 struct platform_device pdev;
121 char name[1];
122};
123
1da177e4 124/**
37c12e74
RK
125 * platform_device_put
126 * @pdev: platform device to free
127 *
128 * Free all memory associated with a platform device. This function
129 * must _only_ be externally called in error cases. All other usage
130 * is a bug.
131 */
132void platform_device_put(struct platform_device *pdev)
133{
134 if (pdev)
135 put_device(&pdev->dev);
136}
137EXPORT_SYMBOL_GPL(platform_device_put);
138
139static void platform_device_release(struct device *dev)
140{
141 struct platform_object *pa = container_of(dev, struct platform_object, pdev.dev);
142
143 kfree(pa->pdev.dev.platform_data);
144 kfree(pa->pdev.resource);
145 kfree(pa);
146}
147
148/**
149 * platform_device_alloc
150 * @name: base name of the device we're adding
151 * @id: instance id
152 *
153 * Create a platform device object which can have other objects attached
154 * to it, and which will have attached objects freed when it is released.
155 */
156struct platform_device *platform_device_alloc(const char *name, unsigned int id)
157{
158 struct platform_object *pa;
159
160 pa = kzalloc(sizeof(struct platform_object) + strlen(name), GFP_KERNEL);
161 if (pa) {
162 strcpy(pa->name, name);
163 pa->pdev.name = pa->name;
164 pa->pdev.id = id;
165 device_initialize(&pa->pdev.dev);
166 pa->pdev.dev.release = platform_device_release;
167 }
168
169 return pa ? &pa->pdev : NULL;
170}
171EXPORT_SYMBOL_GPL(platform_device_alloc);
172
173/**
174 * platform_device_add_resources
175 * @pdev: platform device allocated by platform_device_alloc to add resources to
176 * @res: set of resources that needs to be allocated for the device
177 * @num: number of resources
178 *
179 * Add a copy of the resources to the platform device. The memory
180 * associated with the resources will be freed when the platform
181 * device is released.
182 */
183int platform_device_add_resources(struct platform_device *pdev, struct resource *res, unsigned int num)
184{
185 struct resource *r;
186
187 r = kmalloc(sizeof(struct resource) * num, GFP_KERNEL);
188 if (r) {
189 memcpy(r, res, sizeof(struct resource) * num);
190 pdev->resource = r;
191 pdev->num_resources = num;
192 }
193 return r ? 0 : -ENOMEM;
194}
195EXPORT_SYMBOL_GPL(platform_device_add_resources);
196
197/**
198 * platform_device_add_data
199 * @pdev: platform device allocated by platform_device_alloc to add resources to
200 * @data: platform specific data for this platform device
201 * @size: size of platform specific data
202 *
203 * Add a copy of platform specific data to the platform device's platform_data
204 * pointer. The memory associated with the platform data will be freed
205 * when the platform device is released.
206 */
207int platform_device_add_data(struct platform_device *pdev, void *data, size_t size)
208{
209 void *d;
210
211 d = kmalloc(size, GFP_KERNEL);
212 if (d) {
213 memcpy(d, data, size);
214 pdev->dev.platform_data = d;
215 }
216 return d ? 0 : -ENOMEM;
217}
218EXPORT_SYMBOL_GPL(platform_device_add_data);
219
220/**
221 * platform_device_add - add a platform device to device hierarchy
67be2dd1 222 * @pdev: platform device we're adding
1da177e4 223 *
37c12e74
RK
224 * This is part 2 of platform_device_register(), though may be called
225 * separately _iff_ pdev was allocated by platform_device_alloc().
1da177e4 226 */
37c12e74 227int platform_device_add(struct platform_device *pdev)
1da177e4
LT
228{
229 int i, ret = 0;
230
231 if (!pdev)
232 return -EINVAL;
233
234 if (!pdev->dev.parent)
235 pdev->dev.parent = &platform_bus;
236
237 pdev->dev.bus = &platform_bus_type;
238
239 if (pdev->id != -1)
240 snprintf(pdev->dev.bus_id, BUS_ID_SIZE, "%s.%u", pdev->name, pdev->id);
241 else
242 strlcpy(pdev->dev.bus_id, pdev->name, BUS_ID_SIZE);
243
244 for (i = 0; i < pdev->num_resources; i++) {
245 struct resource *p, *r = &pdev->resource[i];
246
247 if (r->name == NULL)
248 r->name = pdev->dev.bus_id;
249
250 p = r->parent;
251 if (!p) {
252 if (r->flags & IORESOURCE_MEM)
253 p = &iomem_resource;
254 else if (r->flags & IORESOURCE_IO)
255 p = &ioport_resource;
256 }
257
258 if (p && request_resource(p, r)) {
259 printk(KERN_ERR
260 "%s: failed to claim resource %d\n",
261 pdev->dev.bus_id, i);
262 ret = -EBUSY;
263 goto failed;
264 }
265 }
266
267 pr_debug("Registering platform device '%s'. Parent at %s\n",
268 pdev->dev.bus_id, pdev->dev.parent->bus_id);
269
270 ret = device_register(&pdev->dev);
271 if (ret == 0)
272 return ret;
273
274 failed:
275 while (--i >= 0)
276 if (pdev->resource[i].flags & (IORESOURCE_MEM|IORESOURCE_IO))
277 release_resource(&pdev->resource[i]);
278 return ret;
279}
37c12e74
RK
280EXPORT_SYMBOL_GPL(platform_device_add);
281
282/**
283 * platform_device_register - add a platform-level device
284 * @pdev: platform device we're adding
285 *
286 */
287int platform_device_register(struct platform_device * pdev)
288{
289 device_initialize(&pdev->dev);
290 return platform_device_add(pdev);
291}
1da177e4
LT
292
293/**
294 * platform_device_unregister - remove a platform-level device
67be2dd1 295 * @pdev: platform device we're removing
1da177e4
LT
296 *
297 * Note that this function will also release all memory- and port-based
298 * resources owned by the device (@dev->resource).
299 */
300void platform_device_unregister(struct platform_device * pdev)
301{
302 int i;
303
304 if (pdev) {
305 for (i = 0; i < pdev->num_resources; i++) {
306 struct resource *r = &pdev->resource[i];
307 if (r->flags & (IORESOURCE_MEM|IORESOURCE_IO))
308 release_resource(r);
309 }
310
311 device_unregister(&pdev->dev);
312 }
313}
314
1da177e4
LT
315/**
316 * platform_device_register_simple
317 * @name: base name of the device we're adding
318 * @id: instance id
319 * @res: set of resources that needs to be allocated for the device
320 * @num: number of resources
321 *
322 * This function creates a simple platform device that requires minimal
323 * resource and memory management. Canned release function freeing
324 * memory allocated for the device allows drivers using such devices
325 * to be unloaded iwithout waiting for the last reference to the device
326 * to be dropped.
327 */
328struct platform_device *platform_device_register_simple(char *name, unsigned int id,
329 struct resource *res, unsigned int num)
330{
37c12e74 331 struct platform_device *pdev;
1da177e4
LT
332 int retval;
333
37c12e74
RK
334 pdev = platform_device_alloc(name, id);
335 if (!pdev) {
1da177e4
LT
336 retval = -ENOMEM;
337 goto error;
338 }
339
1da177e4 340 if (num) {
37c12e74
RK
341 retval = platform_device_add_resources(pdev, res, num);
342 if (retval)
343 goto error;
1da177e4
LT
344 }
345
37c12e74 346 retval = platform_device_add(pdev);
1da177e4
LT
347 if (retval)
348 goto error;
349
37c12e74 350 return pdev;
1da177e4
LT
351
352error:
37c12e74 353 platform_device_put(pdev);
1da177e4
LT
354 return ERR_PTR(retval);
355}
356
357
358/**
359 * platform_match - bind platform device to platform driver.
360 * @dev: device.
361 * @drv: driver.
362 *
363 * Platform device IDs are assumed to be encoded like this:
364 * "<name><instance>", where <name> is a short description of the
365 * type of device, like "pci" or "floppy", and <instance> is the
366 * enumerated instance of the device, like '0' or '42'.
367 * Driver IDs are simply "<name>".
368 * So, extract the <name> from the platform_device structure,
369 * and compare it against the name of the driver. Return whether
370 * they match or not.
371 */
372
373static int platform_match(struct device * dev, struct device_driver * drv)
374{
375 struct platform_device *pdev = container_of(dev, struct platform_device, dev);
376
377 return (strncmp(pdev->name, drv->name, BUS_ID_SIZE) == 0);
378}
379
380static int platform_suspend(struct device * dev, pm_message_t state)
381{
382 int ret = 0;
383
9480e307
RK
384 if (dev->driver && dev->driver->suspend)
385 ret = dev->driver->suspend(dev, state);
386
1da177e4
LT
387 return ret;
388}
389
390static int platform_resume(struct device * dev)
391{
392 int ret = 0;
393
9480e307
RK
394 if (dev->driver && dev->driver->resume)
395 ret = dev->driver->resume(dev);
396
1da177e4
LT
397 return ret;
398}
399
400struct bus_type platform_bus_type = {
401 .name = "platform",
402 .match = platform_match,
403 .suspend = platform_suspend,
404 .resume = platform_resume,
405};
406
407int __init platform_bus_init(void)
408{
409 device_register(&platform_bus);
410 return bus_register(&platform_bus_type);
411}
412
413#ifndef ARCH_HAS_DMA_GET_REQUIRED_MASK
414u64 dma_get_required_mask(struct device *dev)
415{
416 u32 low_totalram = ((max_pfn - 1) << PAGE_SHIFT);
417 u32 high_totalram = ((max_pfn - 1) >> (32 - PAGE_SHIFT));
418 u64 mask;
419
420 if (!high_totalram) {
421 /* convert to mask just covering totalram */
422 low_totalram = (1 << (fls(low_totalram) - 1));
423 low_totalram += low_totalram - 1;
424 mask = low_totalram;
425 } else {
426 high_totalram = (1 << (fls(high_totalram) - 1));
427 high_totalram += high_totalram - 1;
428 mask = (((u64)high_totalram) << 32) + 0xffffffff;
429 }
430 return mask & *dev->dma_mask;
431}
432EXPORT_SYMBOL_GPL(dma_get_required_mask);
433#endif
434
435EXPORT_SYMBOL_GPL(platform_bus);
436EXPORT_SYMBOL_GPL(platform_bus_type);
46ea0d6c 437EXPORT_SYMBOL_GPL(platform_add_devices);
1da177e4
LT
438EXPORT_SYMBOL_GPL(platform_device_register);
439EXPORT_SYMBOL_GPL(platform_device_register_simple);
440EXPORT_SYMBOL_GPL(platform_device_unregister);
441EXPORT_SYMBOL_GPL(platform_get_irq);
442EXPORT_SYMBOL_GPL(platform_get_resource);
443EXPORT_SYMBOL_GPL(platform_get_irq_byname);
444EXPORT_SYMBOL_GPL(platform_get_resource_byname);
This page took 0.097022 seconds and 5 git commands to generate.