Blame view

drivers/base/platform.c 28.7 KB
1da177e4c   Linus Torvalds   Linux-2.6.12-rc2
1
2
3
4
5
6
7
8
9
10
11
  /*
   * platform.c - platform 'pseudo' bus for legacy devices
   *
   * Copyright (c) 2002-3 Patrick Mochel
   * Copyright (c) 2002-3 Open Source Development Labs
   *
   * This file is released under the GPLv2
   *
   * Please see Documentation/driver-model/platform.txt for more
   * information.
   */
daa412267   Andrew Morton   driver core: plat...
12
  #include <linux/string.h>
d052d1bef   Russell King   Create platform_d...
13
  #include <linux/platform_device.h>
05212157e   Grant Likely   drivercore/of: Ad...
14
  #include <linux/of_device.h>
1da177e4c   Linus Torvalds   Linux-2.6.12-rc2
15
16
17
18
19
  #include <linux/module.h>
  #include <linux/init.h>
  #include <linux/dma-mapping.h>
  #include <linux/bootmem.h>
  #include <linux/err.h>
4e57b6817   Tim Schmielau   [PATCH] fix missi...
20
  #include <linux/slab.h>
9d7302299   Magnus Damm   PM: Run-time PM p...
21
  #include <linux/pm_runtime.h>
1da177e4c   Linus Torvalds   Linux-2.6.12-rc2
22

a1bdc7aad   Ben Dooks   [PATCH] drivers/b...
23
  #include "base.h"
4a3ad20cc   Greg Kroah-Hartman   Driver core: codi...
24
25
  #define to_platform_driver(drv)	(container_of((drv), struct platform_driver, \
  				 driver))
00d3dcdd9   Russell King   [DRIVER MODEL] Ad...
26

1da177e4c   Linus Torvalds   Linux-2.6.12-rc2
27
  struct device platform_bus = {
1e0b2cf93   Kay Sievers   driver core: stru...
28
  	.init_name	= "platform",
1da177e4c   Linus Torvalds   Linux-2.6.12-rc2
29
  };
a96b20420   Dmitry Torokhov   [PATCH] Driver Co...
30
  EXPORT_SYMBOL_GPL(platform_bus);
1da177e4c   Linus Torvalds   Linux-2.6.12-rc2
31
32
  
  /**
a77ce8167   Kumar Gala   driver core: Add ...
33
   * arch_setup_pdev_archdata - Allow manipulation of archdata before its used
7de636fa2   Randy Dunlap   driver core: fix ...
34
   * @pdev: platform device
a77ce8167   Kumar Gala   driver core: Add ...
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
   *
   * This is called before platform_device_add() such that any pdev_archdata may
   * be setup before the platform_notifier is called.  So if a user needs to
   * manipulate any relevant information in the pdev_archdata they can do:
   *
   * 	platform_devic_alloc()
   * 	... manipulate ...
   * 	platform_device_add()
   *
   * And if they don't care they can just call platform_device_register() and
   * everything will just work out.
   */
  void __weak arch_setup_pdev_archdata(struct platform_device *pdev)
  {
  }
  
  /**
4a3ad20cc   Greg Kroah-Hartman   Driver core: codi...
52
53
54
55
   * platform_get_resource - get a resource for a device
   * @dev: platform device
   * @type: resource type
   * @num: resource index
1da177e4c   Linus Torvalds   Linux-2.6.12-rc2
56
   */
4a3ad20cc   Greg Kroah-Hartman   Driver core: codi...
57
58
  struct resource *platform_get_resource(struct platform_device *dev,
  				       unsigned int type, unsigned int num)
1da177e4c   Linus Torvalds   Linux-2.6.12-rc2
59
60
61
62
63
  {
  	int i;
  
  	for (i = 0; i < dev->num_resources; i++) {
  		struct resource *r = &dev->resource[i];
c9f66169f   Magnus Damm   resource: add res...
64
65
  		if (type == resource_type(r) && num-- == 0)
  			return r;
1da177e4c   Linus Torvalds   Linux-2.6.12-rc2
66
67
68
  	}
  	return NULL;
  }
a96b20420   Dmitry Torokhov   [PATCH] Driver Co...
69
  EXPORT_SYMBOL_GPL(platform_get_resource);
1da177e4c   Linus Torvalds   Linux-2.6.12-rc2
70
71
  
  /**
4a3ad20cc   Greg Kroah-Hartman   Driver core: codi...
72
73
74
   * platform_get_irq - get an IRQ for a device
   * @dev: platform device
   * @num: IRQ number index
1da177e4c   Linus Torvalds   Linux-2.6.12-rc2
75
76
77
78
   */
  int platform_get_irq(struct platform_device *dev, unsigned int num)
  {
  	struct resource *r = platform_get_resource(dev, IORESOURCE_IRQ, num);
305b3228f   David Vrabel   [PATCH] driver co...
79
  	return r ? r->start : -ENXIO;
1da177e4c   Linus Torvalds   Linux-2.6.12-rc2
80
  }
a96b20420   Dmitry Torokhov   [PATCH] Driver Co...
81
  EXPORT_SYMBOL_GPL(platform_get_irq);
1da177e4c   Linus Torvalds   Linux-2.6.12-rc2
82
83
  
  /**
4a3ad20cc   Greg Kroah-Hartman   Driver core: codi...
84
85
86
87
   * platform_get_resource_byname - get a resource for a device by name
   * @dev: platform device
   * @type: resource type
   * @name: resource name
1da177e4c   Linus Torvalds   Linux-2.6.12-rc2
88
   */
4a3ad20cc   Greg Kroah-Hartman   Driver core: codi...
89
  struct resource *platform_get_resource_byname(struct platform_device *dev,
c0afe7ba5   Linus Walleij   driver core: Cons...
90
91
  					      unsigned int type,
  					      const char *name)
1da177e4c   Linus Torvalds   Linux-2.6.12-rc2
92
93
94
95
96
  {
  	int i;
  
  	for (i = 0; i < dev->num_resources; i++) {
  		struct resource *r = &dev->resource[i];
c9f66169f   Magnus Damm   resource: add res...
97
98
  		if (type == resource_type(r) && !strcmp(r->name, name))
  			return r;
1da177e4c   Linus Torvalds   Linux-2.6.12-rc2
99
100
101
  	}
  	return NULL;
  }
a96b20420   Dmitry Torokhov   [PATCH] Driver Co...
102
  EXPORT_SYMBOL_GPL(platform_get_resource_byname);
1da177e4c   Linus Torvalds   Linux-2.6.12-rc2
103
104
  
  /**
4a3ad20cc   Greg Kroah-Hartman   Driver core: codi...
105
106
107
   * platform_get_irq - get an IRQ for a device
   * @dev: platform device
   * @name: IRQ name
1da177e4c   Linus Torvalds   Linux-2.6.12-rc2
108
   */
c0afe7ba5   Linus Walleij   driver core: Cons...
109
  int platform_get_irq_byname(struct platform_device *dev, const char *name)
1da177e4c   Linus Torvalds   Linux-2.6.12-rc2
110
  {
4a3ad20cc   Greg Kroah-Hartman   Driver core: codi...
111
112
  	struct resource *r = platform_get_resource_byname(dev, IORESOURCE_IRQ,
  							  name);
1da177e4c   Linus Torvalds   Linux-2.6.12-rc2
113

305b3228f   David Vrabel   [PATCH] driver co...
114
  	return r ? r->start : -ENXIO;
1da177e4c   Linus Torvalds   Linux-2.6.12-rc2
115
  }
a96b20420   Dmitry Torokhov   [PATCH] Driver Co...
116
  EXPORT_SYMBOL_GPL(platform_get_irq_byname);
1da177e4c   Linus Torvalds   Linux-2.6.12-rc2
117
118
  
  /**
4a3ad20cc   Greg Kroah-Hartman   Driver core: codi...
119
120
121
   * platform_add_devices - add a numbers of platform devices
   * @devs: array of platform devices to add
   * @num: number of platform devices in array
1da177e4c   Linus Torvalds   Linux-2.6.12-rc2
122
123
124
125
126
127
128
129
130
131
132
133
134
135
136
137
   */
  int platform_add_devices(struct platform_device **devs, int num)
  {
  	int i, ret = 0;
  
  	for (i = 0; i < num; i++) {
  		ret = platform_device_register(devs[i]);
  		if (ret) {
  			while (--i >= 0)
  				platform_device_unregister(devs[i]);
  			break;
  		}
  	}
  
  	return ret;
  }
a96b20420   Dmitry Torokhov   [PATCH] Driver Co...
138
  EXPORT_SYMBOL_GPL(platform_add_devices);
1da177e4c   Linus Torvalds   Linux-2.6.12-rc2
139

37c12e749   Russell King   [DRIVER MODEL] Im...
140
141
142
143
  struct platform_object {
  	struct platform_device pdev;
  	char name[1];
  };
1da177e4c   Linus Torvalds   Linux-2.6.12-rc2
144
  /**
3c31f07ad   Ben Hutchings   Driver core: Fix ...
145
   * platform_device_put - destroy a platform device
4a3ad20cc   Greg Kroah-Hartman   Driver core: codi...
146
   * @pdev: platform device to free
37c12e749   Russell King   [DRIVER MODEL] Im...
147
   *
4a3ad20cc   Greg Kroah-Hartman   Driver core: codi...
148
149
   * Free all memory associated with a platform device.  This function must
   * _only_ be externally called in error cases.  All other usage is a bug.
37c12e749   Russell King   [DRIVER MODEL] Im...
150
151
152
153
154
155
156
157
158
159
   */
  void platform_device_put(struct platform_device *pdev)
  {
  	if (pdev)
  		put_device(&pdev->dev);
  }
  EXPORT_SYMBOL_GPL(platform_device_put);
  
  static void platform_device_release(struct device *dev)
  {
4a3ad20cc   Greg Kroah-Hartman   Driver core: codi...
160
161
  	struct platform_object *pa = container_of(dev, struct platform_object,
  						  pdev.dev);
37c12e749   Russell King   [DRIVER MODEL] Im...
162

7096d0422   Grant Likely   of/device: Rework...
163
  	of_device_node_put(&pa->pdev.dev);
37c12e749   Russell King   [DRIVER MODEL] Im...
164
  	kfree(pa->pdev.dev.platform_data);
e710d7d5a   Samuel Ortiz   mfd: Fetch cell p...
165
  	kfree(pa->pdev.mfd_cell);
37c12e749   Russell King   [DRIVER MODEL] Im...
166
167
168
169
170
  	kfree(pa->pdev.resource);
  	kfree(pa);
  }
  
  /**
3c31f07ad   Ben Hutchings   Driver core: Fix ...
171
   * platform_device_alloc - create a platform device
4a3ad20cc   Greg Kroah-Hartman   Driver core: codi...
172
173
   * @name: base name of the device we're adding
   * @id: instance id
37c12e749   Russell King   [DRIVER MODEL] Im...
174
   *
4a3ad20cc   Greg Kroah-Hartman   Driver core: codi...
175
176
   * Create a platform device object which can have other objects attached
   * to it, and which will have attached objects freed when it is released.
37c12e749   Russell King   [DRIVER MODEL] Im...
177
   */
1359555eb   Jean Delvare   Driver core: Make...
178
  struct platform_device *platform_device_alloc(const char *name, int id)
37c12e749   Russell King   [DRIVER MODEL] Im...
179
180
181
182
183
184
185
186
187
188
  {
  	struct platform_object *pa;
  
  	pa = kzalloc(sizeof(struct platform_object) + strlen(name), GFP_KERNEL);
  	if (pa) {
  		strcpy(pa->name, name);
  		pa->pdev.name = pa->name;
  		pa->pdev.id = id;
  		device_initialize(&pa->pdev.dev);
  		pa->pdev.dev.release = platform_device_release;
a77ce8167   Kumar Gala   driver core: Add ...
189
  		arch_setup_pdev_archdata(&pa->pdev);
37c12e749   Russell King   [DRIVER MODEL] Im...
190
  	}
93ce3061b   Dmitry Torokhov   [PATCH] Driver Co...
191
  	return pa ? &pa->pdev : NULL;
37c12e749   Russell King   [DRIVER MODEL] Im...
192
193
194
195
  }
  EXPORT_SYMBOL_GPL(platform_device_alloc);
  
  /**
3c31f07ad   Ben Hutchings   Driver core: Fix ...
196
   * platform_device_add_resources - add resources to a platform device
4a3ad20cc   Greg Kroah-Hartman   Driver core: codi...
197
198
199
   * @pdev: platform device allocated by platform_device_alloc to add resources to
   * @res: set of resources that needs to be allocated for the device
   * @num: number of resources
37c12e749   Russell King   [DRIVER MODEL] Im...
200
   *
4a3ad20cc   Greg Kroah-Hartman   Driver core: codi...
201
202
203
   * Add a copy of the resources to the platform device.  The memory
   * associated with the resources will be freed when the platform device is
   * released.
37c12e749   Russell King   [DRIVER MODEL] Im...
204
   */
4a3ad20cc   Greg Kroah-Hartman   Driver core: codi...
205
  int platform_device_add_resources(struct platform_device *pdev,
0b7f1a7ef   Geert Uytterhoeven   platform: Make pl...
206
  				  const struct resource *res, unsigned int num)
37c12e749   Russell King   [DRIVER MODEL] Im...
207
  {
cea896238   Uwe Kleine-König   driver core/platf...
208
  	struct resource *r = NULL;
37c12e749   Russell King   [DRIVER MODEL] Im...
209

cea896238   Uwe Kleine-König   driver core/platf...
210
211
212
213
  	if (res) {
  		r = kmemdup(res, sizeof(struct resource) * num, GFP_KERNEL);
  		if (!r)
  			return -ENOMEM;
37c12e749   Russell King   [DRIVER MODEL] Im...
214
  	}
cea896238   Uwe Kleine-König   driver core/platf...
215

4a03d6f7c   Uwe Kleine-König   driver core/platf...
216
  	kfree(pdev->resource);
cea896238   Uwe Kleine-König   driver core/platf...
217
218
219
  	pdev->resource = r;
  	pdev->num_resources = num;
  	return 0;
37c12e749   Russell King   [DRIVER MODEL] Im...
220
221
222
223
  }
  EXPORT_SYMBOL_GPL(platform_device_add_resources);
  
  /**
3c31f07ad   Ben Hutchings   Driver core: Fix ...
224
   * platform_device_add_data - add platform-specific data to a platform device
4a3ad20cc   Greg Kroah-Hartman   Driver core: codi...
225
226
227
   * @pdev: platform device allocated by platform_device_alloc to add resources to
   * @data: platform specific data for this platform device
   * @size: size of platform specific data
37c12e749   Russell King   [DRIVER MODEL] Im...
228
   *
4a3ad20cc   Greg Kroah-Hartman   Driver core: codi...
229
230
231
   * Add a copy of platform specific data to the platform device's
   * platform_data pointer.  The memory associated with the platform data
   * will be freed when the platform device is released.
37c12e749   Russell King   [DRIVER MODEL] Im...
232
   */
4a3ad20cc   Greg Kroah-Hartman   Driver core: codi...
233
234
  int platform_device_add_data(struct platform_device *pdev, const void *data,
  			     size_t size)
37c12e749   Russell King   [DRIVER MODEL] Im...
235
  {
27a33f9e8   Uwe Kleine-König   driver core/platf...
236
  	void *d = NULL;
5cfc64ceb   Anton Vorontsov   base/platform: Sa...
237

27a33f9e8   Uwe Kleine-König   driver core/platf...
238
239
240
241
  	if (data) {
  		d = kmemdup(data, size, GFP_KERNEL);
  		if (!d)
  			return -ENOMEM;
37c12e749   Russell King   [DRIVER MODEL] Im...
242
  	}
27a33f9e8   Uwe Kleine-König   driver core/platf...
243

251e031d1   Uwe Kleine-König   driver core/platf...
244
  	kfree(pdev->dev.platform_data);
27a33f9e8   Uwe Kleine-König   driver core/platf...
245
246
  	pdev->dev.platform_data = d;
  	return 0;
37c12e749   Russell King   [DRIVER MODEL] Im...
247
248
249
250
  }
  EXPORT_SYMBOL_GPL(platform_device_add_data);
  
  /**
4a3ad20cc   Greg Kroah-Hartman   Driver core: codi...
251
252
   * platform_device_add - add a platform device to device hierarchy
   * @pdev: platform device we're adding
1da177e4c   Linus Torvalds   Linux-2.6.12-rc2
253
   *
4a3ad20cc   Greg Kroah-Hartman   Driver core: codi...
254
255
   * This is part 2 of platform_device_register(), though may be called
   * separately _iff_ pdev was allocated by platform_device_alloc().
1da177e4c   Linus Torvalds   Linux-2.6.12-rc2
256
   */
37c12e749   Russell King   [DRIVER MODEL] Im...
257
  int platform_device_add(struct platform_device *pdev)
1da177e4c   Linus Torvalds   Linux-2.6.12-rc2
258
259
260
261
262
263
264
265
266
267
268
269
  {
  	int i, ret = 0;
  
  	if (!pdev)
  		return -EINVAL;
  
  	if (!pdev->dev.parent)
  		pdev->dev.parent = &platform_bus;
  
  	pdev->dev.bus = &platform_bus_type;
  
  	if (pdev->id != -1)
1e0b2cf93   Kay Sievers   driver core: stru...
270
  		dev_set_name(&pdev->dev, "%s.%d", pdev->name,  pdev->id);
1da177e4c   Linus Torvalds   Linux-2.6.12-rc2
271
  	else
acc0e90fb   Greg Kroah-Hartman   driver core: fix ...
272
  		dev_set_name(&pdev->dev, "%s", pdev->name);
1da177e4c   Linus Torvalds   Linux-2.6.12-rc2
273
274
275
276
277
  
  	for (i = 0; i < pdev->num_resources; i++) {
  		struct resource *p, *r = &pdev->resource[i];
  
  		if (r->name == NULL)
1e0b2cf93   Kay Sievers   driver core: stru...
278
  			r->name = dev_name(&pdev->dev);
1da177e4c   Linus Torvalds   Linux-2.6.12-rc2
279
280
281
  
  		p = r->parent;
  		if (!p) {
c9f66169f   Magnus Damm   resource: add res...
282
  			if (resource_type(r) == IORESOURCE_MEM)
1da177e4c   Linus Torvalds   Linux-2.6.12-rc2
283
  				p = &iomem_resource;
c9f66169f   Magnus Damm   resource: add res...
284
  			else if (resource_type(r) == IORESOURCE_IO)
1da177e4c   Linus Torvalds   Linux-2.6.12-rc2
285
286
  				p = &ioport_resource;
  		}
d960bb4db   Kumar Gala   [PATCH] Allow ove...
287
  		if (p && insert_resource(p, r)) {
1da177e4c   Linus Torvalds   Linux-2.6.12-rc2
288
289
290
  			printk(KERN_ERR
  			       "%s: failed to claim resource %d
  ",
1e0b2cf93   Kay Sievers   driver core: stru...
291
  			       dev_name(&pdev->dev), i);
1da177e4c   Linus Torvalds   Linux-2.6.12-rc2
292
293
294
295
296
297
298
  			ret = -EBUSY;
  			goto failed;
  		}
  	}
  
  	pr_debug("Registering platform device '%s'. Parent at %s
  ",
1e0b2cf93   Kay Sievers   driver core: stru...
299
  		 dev_name(&pdev->dev), dev_name(pdev->dev.parent));
1da177e4c   Linus Torvalds   Linux-2.6.12-rc2
300

e39155322   Russell King   [PATCH] Driver Co...
301
  	ret = device_add(&pdev->dev);
1da177e4c   Linus Torvalds   Linux-2.6.12-rc2
302
303
304
305
  	if (ret == 0)
  		return ret;
  
   failed:
c9f66169f   Magnus Damm   resource: add res...
306
307
308
309
310
311
312
  	while (--i >= 0) {
  		struct resource *r = &pdev->resource[i];
  		unsigned long type = resource_type(r);
  
  		if (type == IORESOURCE_MEM || type == IORESOURCE_IO)
  			release_resource(r);
  	}
1da177e4c   Linus Torvalds   Linux-2.6.12-rc2
313
314
  	return ret;
  }
37c12e749   Russell King   [DRIVER MODEL] Im...
315
316
317
  EXPORT_SYMBOL_GPL(platform_device_add);
  
  /**
4a3ad20cc   Greg Kroah-Hartman   Driver core: codi...
318
319
   * platform_device_del - remove a platform-level device
   * @pdev: platform device we're removing
1da177e4c   Linus Torvalds   Linux-2.6.12-rc2
320
   *
4a3ad20cc   Greg Kroah-Hartman   Driver core: codi...
321
322
323
   * Note that this function will also release all memory- and port-based
   * resources owned by the device (@dev->resource).  This function must
   * _only_ be externally called in error cases.  All other usage is a bug.
1da177e4c   Linus Torvalds   Linux-2.6.12-rc2
324
   */
93ce3061b   Dmitry Torokhov   [PATCH] Driver Co...
325
  void platform_device_del(struct platform_device *pdev)
1da177e4c   Linus Torvalds   Linux-2.6.12-rc2
326
327
328
329
  {
  	int i;
  
  	if (pdev) {
dc4c15d44   Jean Delvare   platform: reorder...
330
  		device_del(&pdev->dev);
1da177e4c   Linus Torvalds   Linux-2.6.12-rc2
331
332
  		for (i = 0; i < pdev->num_resources; i++) {
  			struct resource *r = &pdev->resource[i];
c9f66169f   Magnus Damm   resource: add res...
333
334
335
  			unsigned long type = resource_type(r);
  
  			if (type == IORESOURCE_MEM || type == IORESOURCE_IO)
1da177e4c   Linus Torvalds   Linux-2.6.12-rc2
336
337
  				release_resource(r);
  		}
1da177e4c   Linus Torvalds   Linux-2.6.12-rc2
338
339
  	}
  }
93ce3061b   Dmitry Torokhov   [PATCH] Driver Co...
340
341
342
  EXPORT_SYMBOL_GPL(platform_device_del);
  
  /**
4a3ad20cc   Greg Kroah-Hartman   Driver core: codi...
343
344
   * platform_device_register - add a platform-level device
   * @pdev: platform device we're adding
93ce3061b   Dmitry Torokhov   [PATCH] Driver Co...
345
   */
4a3ad20cc   Greg Kroah-Hartman   Driver core: codi...
346
  int platform_device_register(struct platform_device *pdev)
93ce3061b   Dmitry Torokhov   [PATCH] Driver Co...
347
348
  {
  	device_initialize(&pdev->dev);
a77ce8167   Kumar Gala   driver core: Add ...
349
  	arch_setup_pdev_archdata(pdev);
93ce3061b   Dmitry Torokhov   [PATCH] Driver Co...
350
351
  	return platform_device_add(pdev);
  }
a96b20420   Dmitry Torokhov   [PATCH] Driver Co...
352
  EXPORT_SYMBOL_GPL(platform_device_register);
93ce3061b   Dmitry Torokhov   [PATCH] Driver Co...
353
354
  
  /**
4a3ad20cc   Greg Kroah-Hartman   Driver core: codi...
355
356
   * platform_device_unregister - unregister a platform-level device
   * @pdev: platform device we're unregistering
93ce3061b   Dmitry Torokhov   [PATCH] Driver Co...
357
   *
4a3ad20cc   Greg Kroah-Hartman   Driver core: codi...
358
359
360
   * Unregistration is done in 2 steps. First we release all resources
   * and remove it from the subsystem, then we drop reference count by
   * calling platform_device_put().
93ce3061b   Dmitry Torokhov   [PATCH] Driver Co...
361
   */
4a3ad20cc   Greg Kroah-Hartman   Driver core: codi...
362
  void platform_device_unregister(struct platform_device *pdev)
93ce3061b   Dmitry Torokhov   [PATCH] Driver Co...
363
364
365
366
  {
  	platform_device_del(pdev);
  	platform_device_put(pdev);
  }
a96b20420   Dmitry Torokhov   [PATCH] Driver Co...
367
  EXPORT_SYMBOL_GPL(platform_device_unregister);
1da177e4c   Linus Torvalds   Linux-2.6.12-rc2
368

1da177e4c   Linus Torvalds   Linux-2.6.12-rc2
369
  /**
01dcc60a7   Uwe Kleine-König   new helper to cre...
370
   * platform_device_register_full - add a platform-level device with
44f28bdea   Uwe Kleine-König   Driver core: redu...
371
   * resources and platform-specific data
49a4ec188   David Brownell   fix hotplug for l...
372
   *
01dcc60a7   Uwe Kleine-König   new helper to cre...
373
   * @pdevinfo: data used to create device
d8bf25408   Dmitry Eremin-Solenikov   platform: add new...
374
   *
f0eae0ed3   Jani Nikula   driver-core: docu...
375
   * Returns &struct platform_device pointer on success, or ERR_PTR() on error.
d8bf25408   Dmitry Eremin-Solenikov   platform: add new...
376
   */
01dcc60a7   Uwe Kleine-König   new helper to cre...
377
  struct platform_device *platform_device_register_full(
5a3072be6   Uwe Kleine-König   drivers_base: mak...
378
  		const struct platform_device_info *pdevinfo)
d8bf25408   Dmitry Eremin-Solenikov   platform: add new...
379
  {
44f28bdea   Uwe Kleine-König   Driver core: redu...
380
  	int ret = -ENOMEM;
d8bf25408   Dmitry Eremin-Solenikov   platform: add new...
381
  	struct platform_device *pdev;
d8bf25408   Dmitry Eremin-Solenikov   platform: add new...
382

01dcc60a7   Uwe Kleine-König   new helper to cre...
383
  	pdev = platform_device_alloc(pdevinfo->name, pdevinfo->id);
44f28bdea   Uwe Kleine-König   Driver core: redu...
384
  	if (!pdev)
01dcc60a7   Uwe Kleine-König   new helper to cre...
385
386
387
388
389
390
391
392
393
394
395
396
397
398
399
400
401
402
403
  		goto err_alloc;
  
  	pdev->dev.parent = pdevinfo->parent;
  
  	if (pdevinfo->dma_mask) {
  		/*
  		 * This memory isn't freed when the device is put,
  		 * I don't have a nice idea for that though.  Conceptually
  		 * dma_mask in struct device should not be a pointer.
  		 * See http://thread.gmane.org/gmane.linux.kernel.pci/9081
  		 */
  		pdev->dev.dma_mask =
  			kmalloc(sizeof(*pdev->dev.dma_mask), GFP_KERNEL);
  		if (!pdev->dev.dma_mask)
  			goto err;
  
  		*pdev->dev.dma_mask = pdevinfo->dma_mask;
  		pdev->dev.coherent_dma_mask = pdevinfo->dma_mask;
  	}
d8bf25408   Dmitry Eremin-Solenikov   platform: add new...
404

01dcc60a7   Uwe Kleine-König   new helper to cre...
405
406
  	ret = platform_device_add_resources(pdev,
  			pdevinfo->res, pdevinfo->num_res);
807508c8f   Anton Vorontsov   base/platform: Si...
407
408
  	if (ret)
  		goto err;
44f28bdea   Uwe Kleine-König   Driver core: redu...
409

01dcc60a7   Uwe Kleine-König   new helper to cre...
410
411
  	ret = platform_device_add_data(pdev,
  			pdevinfo->data, pdevinfo->size_data);
807508c8f   Anton Vorontsov   base/platform: Si...
412
413
  	if (ret)
  		goto err;
d8bf25408   Dmitry Eremin-Solenikov   platform: add new...
414

44f28bdea   Uwe Kleine-König   Driver core: redu...
415
416
417
  	ret = platform_device_add(pdev);
  	if (ret) {
  err:
01dcc60a7   Uwe Kleine-König   new helper to cre...
418
419
420
  		kfree(pdev->dev.dma_mask);
  
  err_alloc:
44f28bdea   Uwe Kleine-König   Driver core: redu...
421
422
423
  		platform_device_put(pdev);
  		return ERR_PTR(ret);
  	}
d8bf25408   Dmitry Eremin-Solenikov   platform: add new...
424
425
  
  	return pdev;
d8bf25408   Dmitry Eremin-Solenikov   platform: add new...
426
  }
01dcc60a7   Uwe Kleine-König   new helper to cre...
427
  EXPORT_SYMBOL_GPL(platform_device_register_full);
d8bf25408   Dmitry Eremin-Solenikov   platform: add new...
428

00d3dcdd9   Russell King   [DRIVER MODEL] Ad...
429
430
431
432
433
434
435
  static int platform_drv_probe(struct device *_dev)
  {
  	struct platform_driver *drv = to_platform_driver(_dev->driver);
  	struct platform_device *dev = to_platform_device(_dev);
  
  	return drv->probe(dev);
  }
c67334fbd   David Brownell   Driver core: plat...
436
437
438
439
  static int platform_drv_probe_fail(struct device *_dev)
  {
  	return -ENXIO;
  }
00d3dcdd9   Russell King   [DRIVER MODEL] Ad...
440
441
442
443
444
445
446
447
448
449
450
451
452
453
454
  static int platform_drv_remove(struct device *_dev)
  {
  	struct platform_driver *drv = to_platform_driver(_dev->driver);
  	struct platform_device *dev = to_platform_device(_dev);
  
  	return drv->remove(dev);
  }
  
  static void platform_drv_shutdown(struct device *_dev)
  {
  	struct platform_driver *drv = to_platform_driver(_dev->driver);
  	struct platform_device *dev = to_platform_device(_dev);
  
  	drv->shutdown(dev);
  }
00d3dcdd9   Russell King   [DRIVER MODEL] Ad...
455
  /**
3c31f07ad   Ben Hutchings   Driver core: Fix ...
456
   * platform_driver_register - register a driver for platform-level devices
4a3ad20cc   Greg Kroah-Hartman   Driver core: codi...
457
   * @drv: platform driver structure
00d3dcdd9   Russell King   [DRIVER MODEL] Ad...
458
459
460
461
462
463
464
465
466
467
   */
  int platform_driver_register(struct platform_driver *drv)
  {
  	drv->driver.bus = &platform_bus_type;
  	if (drv->probe)
  		drv->driver.probe = platform_drv_probe;
  	if (drv->remove)
  		drv->driver.remove = platform_drv_remove;
  	if (drv->shutdown)
  		drv->driver.shutdown = platform_drv_shutdown;
783ea7d4e   Magnus Damm   Driver Core: Rewo...
468

00d3dcdd9   Russell King   [DRIVER MODEL] Ad...
469
470
471
472
473
  	return driver_register(&drv->driver);
  }
  EXPORT_SYMBOL_GPL(platform_driver_register);
  
  /**
3c31f07ad   Ben Hutchings   Driver core: Fix ...
474
   * platform_driver_unregister - unregister a driver for platform-level devices
4a3ad20cc   Greg Kroah-Hartman   Driver core: codi...
475
   * @drv: platform driver structure
00d3dcdd9   Russell King   [DRIVER MODEL] Ad...
476
477
478
479
480
481
   */
  void platform_driver_unregister(struct platform_driver *drv)
  {
  	driver_unregister(&drv->driver);
  }
  EXPORT_SYMBOL_GPL(platform_driver_unregister);
c67334fbd   David Brownell   Driver core: plat...
482
483
484
485
486
487
488
489
490
491
492
493
494
495
496
497
498
  /**
   * platform_driver_probe - register driver for non-hotpluggable device
   * @drv: platform driver structure
   * @probe: the driver probe routine, probably from an __init section
   *
   * Use this instead of platform_driver_register() when you know the device
   * is not hotpluggable and has already been registered, and you want to
   * remove its run-once probe() infrastructure from memory after the driver
   * has bound to the device.
   *
   * One typical use for this would be with drivers for controllers integrated
   * into system-on-chip processors, where the controller devices have been
   * configured as part of board setup.
   *
   * Returns zero if the driver registered and bound to a device, else returns
   * a negative error code and with the driver not registered.
   */
c63e07834   Andrew Morton   Driver core: "pla...
499
  int __init_or_module platform_driver_probe(struct platform_driver *drv,
c67334fbd   David Brownell   Driver core: plat...
500
501
502
  		int (*probe)(struct platform_device *))
  {
  	int retval, code;
1a6f2a751   Dmitry Torokhov   Driver core: allo...
503
504
  	/* make sure driver won't have bind/unbind attributes */
  	drv->driver.suppress_bind_attrs = true;
c67334fbd   David Brownell   Driver core: plat...
505
506
507
  	/* temporary section violation during probe() */
  	drv->probe = probe;
  	retval = code = platform_driver_register(drv);
1a6f2a751   Dmitry Torokhov   Driver core: allo...
508
509
  	/*
  	 * Fixup that section violation, being paranoid about code scanning
c67334fbd   David Brownell   Driver core: plat...
510
511
512
513
  	 * the list of drivers in order to probe new devices.  Check to see
  	 * if the probe was successful, and make sure any forced probes of
  	 * new devices fail.
  	 */
d79d32440   Patrick Pannuto   driver core: plat...
514
  	spin_lock(&drv->driver.bus->p->klist_drivers.k_lock);
c67334fbd   David Brownell   Driver core: plat...
515
  	drv->probe = NULL;
e5dd12784   Greg Kroah-Hartman   Driver core: move...
516
  	if (code == 0 && list_empty(&drv->driver.p->klist_devices.k_list))
c67334fbd   David Brownell   Driver core: plat...
517
518
  		retval = -ENODEV;
  	drv->driver.probe = platform_drv_probe_fail;
d79d32440   Patrick Pannuto   driver core: plat...
519
  	spin_unlock(&drv->driver.bus->p->klist_drivers.k_lock);
c67334fbd   David Brownell   Driver core: plat...
520
521
522
523
524
525
  
  	if (code != retval)
  		platform_driver_unregister(drv);
  	return retval;
  }
  EXPORT_SYMBOL_GPL(platform_driver_probe);
1da177e4c   Linus Torvalds   Linux-2.6.12-rc2
526

ecdf6ceb8   Dmitry Torokhov   Driver core: add ...
527
528
529
530
531
532
533
534
535
536
537
  /**
   * platform_create_bundle - register driver and create corresponding device
   * @driver: platform driver structure
   * @probe: the driver probe routine, probably from an __init section
   * @res: set of resources that needs to be allocated for the device
   * @n_res: number of resources
   * @data: platform specific data for this platform device
   * @size: size of platform specific data
   *
   * Use this in legacy-style modules that probe hardware directly and
   * register a single platform device and corresponding platform driver.
f0eae0ed3   Jani Nikula   driver-core: docu...
538
539
   *
   * Returns &struct platform_device pointer on success, or ERR_PTR() on error.
ecdf6ceb8   Dmitry Torokhov   Driver core: add ...
540
541
542
543
544
545
546
547
548
549
550
551
552
553
554
   */
  struct platform_device * __init_or_module platform_create_bundle(
  			struct platform_driver *driver,
  			int (*probe)(struct platform_device *),
  			struct resource *res, unsigned int n_res,
  			const void *data, size_t size)
  {
  	struct platform_device *pdev;
  	int error;
  
  	pdev = platform_device_alloc(driver->driver.name, -1);
  	if (!pdev) {
  		error = -ENOMEM;
  		goto err_out;
  	}
807508c8f   Anton Vorontsov   base/platform: Si...
555
556
557
  	error = platform_device_add_resources(pdev, res, n_res);
  	if (error)
  		goto err_pdev_put;
ecdf6ceb8   Dmitry Torokhov   Driver core: add ...
558

807508c8f   Anton Vorontsov   base/platform: Si...
559
560
561
  	error = platform_device_add_data(pdev, data, size);
  	if (error)
  		goto err_pdev_put;
ecdf6ceb8   Dmitry Torokhov   Driver core: add ...
562
563
564
565
566
567
568
569
570
571
572
573
574
575
576
577
578
579
580
  
  	error = platform_device_add(pdev);
  	if (error)
  		goto err_pdev_put;
  
  	error = platform_driver_probe(driver, probe);
  	if (error)
  		goto err_pdev_del;
  
  	return pdev;
  
  err_pdev_del:
  	platform_device_del(pdev);
  err_pdev_put:
  	platform_device_put(pdev);
  err_out:
  	return ERR_PTR(error);
  }
  EXPORT_SYMBOL_GPL(platform_create_bundle);
a0245f7ad   David Brownell   [PATCH] platform_...
581
582
583
584
585
586
  /* modalias support enables more hands-off userspace setup:
   * (a) environment variable lets new-style hotplug events work once system is
   *     fully running:  "modprobe $MODALIAS"
   * (b) sysfs attribute lets new-style coldplug recover from hotplug events
   *     mishandled before system is fully running:  "modprobe $(cat modalias)"
   */
4a3ad20cc   Greg Kroah-Hartman   Driver core: codi...
587
588
  static ssize_t modalias_show(struct device *dev, struct device_attribute *a,
  			     char *buf)
a0245f7ad   David Brownell   [PATCH] platform_...
589
590
  {
  	struct platform_device	*pdev = to_platform_device(dev);
43cc71eed   Kay Sievers   platform: prefix ...
591
592
  	int len = snprintf(buf, PAGE_SIZE, "platform:%s
  ", pdev->name);
a0245f7ad   David Brownell   [PATCH] platform_...
593
594
595
596
597
598
599
600
  
  	return (len >= PAGE_SIZE) ? (PAGE_SIZE - 1) : len;
  }
  
  static struct device_attribute platform_dev_attrs[] = {
  	__ATTR_RO(modalias),
  	__ATTR_NULL,
  };
7eff2e7a8   Kay Sievers   Driver core: chan...
601
  static int platform_uevent(struct device *dev, struct kobj_uevent_env *env)
a0245f7ad   David Brownell   [PATCH] platform_...
602
603
  {
  	struct platform_device	*pdev = to_platform_device(dev);
eca393016   Grant Likely   of: Merge of_plat...
604
605
606
607
608
609
  	int rc;
  
  	/* Some devices have extra OF data and an OF-style MODALIAS */
  	rc = of_device_uevent(dev,env);
  	if (rc != -ENODEV)
  		return rc;
a0245f7ad   David Brownell   [PATCH] platform_...
610

57fee4a58   Eric Miao   platform: introdu...
611
  	add_uevent_var(env, "MODALIAS=%s%s", PLATFORM_MODULE_PREFIX,
0a26813c9   Sebastian Andrzej Siewior   drivers_base: pla...
612
  			pdev->name);
a0245f7ad   David Brownell   [PATCH] platform_...
613
614
  	return 0;
  }
57fee4a58   Eric Miao   platform: introdu...
615
  static const struct platform_device_id *platform_match_id(
831fad2f7   Uwe Kleine-König   Driver core: make...
616
  			const struct platform_device_id *id,
57fee4a58   Eric Miao   platform: introdu...
617
618
619
620
621
622
623
624
625
626
627
  			struct platform_device *pdev)
  {
  	while (id->name[0]) {
  		if (strcmp(pdev->name, id->name) == 0) {
  			pdev->id_entry = id;
  			return id;
  		}
  		id++;
  	}
  	return NULL;
  }
1da177e4c   Linus Torvalds   Linux-2.6.12-rc2
628
  /**
4a3ad20cc   Greg Kroah-Hartman   Driver core: codi...
629
630
631
   * platform_match - bind platform device to platform driver.
   * @dev: device.
   * @drv: driver.
1da177e4c   Linus Torvalds   Linux-2.6.12-rc2
632
   *
4a3ad20cc   Greg Kroah-Hartman   Driver core: codi...
633
634
635
636
637
638
639
   * Platform device IDs are assumed to be encoded like this:
   * "<name><instance>", where <name> is a short description of the type of
   * device, like "pci" or "floppy", and <instance> is the enumerated
   * instance of the device, like '0' or '42'.  Driver IDs are simply
   * "<name>".  So, extract the <name> from the platform_device structure,
   * and compare it against the name of the driver. Return whether they match
   * or not.
1da177e4c   Linus Torvalds   Linux-2.6.12-rc2
640
   */
4a3ad20cc   Greg Kroah-Hartman   Driver core: codi...
641
  static int platform_match(struct device *dev, struct device_driver *drv)
1da177e4c   Linus Torvalds   Linux-2.6.12-rc2
642
  {
71b3e0c1a   Eric Miao   platform: make be...
643
  	struct platform_device *pdev = to_platform_device(dev);
57fee4a58   Eric Miao   platform: introdu...
644
  	struct platform_driver *pdrv = to_platform_driver(drv);
05212157e   Grant Likely   drivercore/of: Ad...
645
646
647
648
649
  	/* Attempt an OF style match first */
  	if (of_driver_match_device(dev, drv))
  		return 1;
  
  	/* Then try to match against the id table */
57fee4a58   Eric Miao   platform: introdu...
650
651
  	if (pdrv->id_table)
  		return platform_match_id(pdrv->id_table, pdev) != NULL;
1da177e4c   Linus Torvalds   Linux-2.6.12-rc2
652

57fee4a58   Eric Miao   platform: introdu...
653
  	/* fall-back to driver name match */
1e0b2cf93   Kay Sievers   driver core: stru...
654
  	return (strcmp(pdev->name, drv->name) == 0);
1da177e4c   Linus Torvalds   Linux-2.6.12-rc2
655
  }
25e18499e   Rafael J. Wysocki   Implement new sus...
656
657
658
  #ifdef CONFIG_PM_SLEEP
  
  static int platform_legacy_suspend(struct device *dev, pm_message_t mesg)
1da177e4c   Linus Torvalds   Linux-2.6.12-rc2
659
  {
783ea7d4e   Magnus Damm   Driver Core: Rewo...
660
661
  	struct platform_driver *pdrv = to_platform_driver(dev->driver);
  	struct platform_device *pdev = to_platform_device(dev);
1da177e4c   Linus Torvalds   Linux-2.6.12-rc2
662
  	int ret = 0;
783ea7d4e   Magnus Damm   Driver Core: Rewo...
663
664
  	if (dev->driver && pdrv->suspend)
  		ret = pdrv->suspend(pdev, mesg);
386415d88   David Brownell   PM: platform_bus ...
665
666
667
  
  	return ret;
  }
25e18499e   Rafael J. Wysocki   Implement new sus...
668
  static int platform_legacy_resume(struct device *dev)
1da177e4c   Linus Torvalds   Linux-2.6.12-rc2
669
  {
783ea7d4e   Magnus Damm   Driver Core: Rewo...
670
671
  	struct platform_driver *pdrv = to_platform_driver(dev->driver);
  	struct platform_device *pdev = to_platform_device(dev);
1da177e4c   Linus Torvalds   Linux-2.6.12-rc2
672
  	int ret = 0;
783ea7d4e   Magnus Damm   Driver Core: Rewo...
673
674
  	if (dev->driver && pdrv->resume)
  		ret = pdrv->resume(pdev);
9480e307c   Russell King   [PATCH] DRIVER MO...
675

1da177e4c   Linus Torvalds   Linux-2.6.12-rc2
676
677
  	return ret;
  }
69c9dd1ec   Rafael J. Wysocki   PM: Export platfo...
678
  #endif /* CONFIG_PM_SLEEP */
9d7302299   Magnus Damm   PM: Run-time PM p...
679

25e18499e   Rafael J. Wysocki   Implement new sus...
680
  #ifdef CONFIG_SUSPEND
69c9dd1ec   Rafael J. Wysocki   PM: Export platfo...
681
  int platform_pm_suspend(struct device *dev)
25e18499e   Rafael J. Wysocki   Implement new sus...
682
683
684
  {
  	struct device_driver *drv = dev->driver;
  	int ret = 0;
adf094931   Rafael J. Wysocki   PM: Simplify the ...
685
686
687
688
  	if (!drv)
  		return 0;
  
  	if (drv->pm) {
25e18499e   Rafael J. Wysocki   Implement new sus...
689
690
691
692
693
694
695
696
  		if (drv->pm->suspend)
  			ret = drv->pm->suspend(dev);
  	} else {
  		ret = platform_legacy_suspend(dev, PMSG_SUSPEND);
  	}
  
  	return ret;
  }
69c9dd1ec   Rafael J. Wysocki   PM: Export platfo...
697
  int platform_pm_resume(struct device *dev)
25e18499e   Rafael J. Wysocki   Implement new sus...
698
699
700
  {
  	struct device_driver *drv = dev->driver;
  	int ret = 0;
adf094931   Rafael J. Wysocki   PM: Simplify the ...
701
702
703
704
  	if (!drv)
  		return 0;
  
  	if (drv->pm) {
25e18499e   Rafael J. Wysocki   Implement new sus...
705
706
707
708
709
710
711
712
  		if (drv->pm->resume)
  			ret = drv->pm->resume(dev);
  	} else {
  		ret = platform_legacy_resume(dev);
  	}
  
  	return ret;
  }
69c9dd1ec   Rafael J. Wysocki   PM: Export platfo...
713
  #endif /* CONFIG_SUSPEND */
25e18499e   Rafael J. Wysocki   Implement new sus...
714

1f112cee0   Rafael J. Wysocki   PM / Hibernate: I...
715
  #ifdef CONFIG_HIBERNATE_CALLBACKS
25e18499e   Rafael J. Wysocki   Implement new sus...
716

69c9dd1ec   Rafael J. Wysocki   PM: Export platfo...
717
  int platform_pm_freeze(struct device *dev)
25e18499e   Rafael J. Wysocki   Implement new sus...
718
719
720
721
722
723
724
725
726
727
728
729
730
731
732
733
  {
  	struct device_driver *drv = dev->driver;
  	int ret = 0;
  
  	if (!drv)
  		return 0;
  
  	if (drv->pm) {
  		if (drv->pm->freeze)
  			ret = drv->pm->freeze(dev);
  	} else {
  		ret = platform_legacy_suspend(dev, PMSG_FREEZE);
  	}
  
  	return ret;
  }
69c9dd1ec   Rafael J. Wysocki   PM: Export platfo...
734
  int platform_pm_thaw(struct device *dev)
25e18499e   Rafael J. Wysocki   Implement new sus...
735
736
737
  {
  	struct device_driver *drv = dev->driver;
  	int ret = 0;
adf094931   Rafael J. Wysocki   PM: Simplify the ...
738
739
740
741
  	if (!drv)
  		return 0;
  
  	if (drv->pm) {
25e18499e   Rafael J. Wysocki   Implement new sus...
742
743
744
745
746
747
748
749
  		if (drv->pm->thaw)
  			ret = drv->pm->thaw(dev);
  	} else {
  		ret = platform_legacy_resume(dev);
  	}
  
  	return ret;
  }
69c9dd1ec   Rafael J. Wysocki   PM: Export platfo...
750
  int platform_pm_poweroff(struct device *dev)
25e18499e   Rafael J. Wysocki   Implement new sus...
751
752
753
  {
  	struct device_driver *drv = dev->driver;
  	int ret = 0;
adf094931   Rafael J. Wysocki   PM: Simplify the ...
754
755
756
757
  	if (!drv)
  		return 0;
  
  	if (drv->pm) {
25e18499e   Rafael J. Wysocki   Implement new sus...
758
759
760
761
762
763
764
765
  		if (drv->pm->poweroff)
  			ret = drv->pm->poweroff(dev);
  	} else {
  		ret = platform_legacy_suspend(dev, PMSG_HIBERNATE);
  	}
  
  	return ret;
  }
69c9dd1ec   Rafael J. Wysocki   PM: Export platfo...
766
  int platform_pm_restore(struct device *dev)
25e18499e   Rafael J. Wysocki   Implement new sus...
767
768
769
  {
  	struct device_driver *drv = dev->driver;
  	int ret = 0;
adf094931   Rafael J. Wysocki   PM: Simplify the ...
770
771
772
773
  	if (!drv)
  		return 0;
  
  	if (drv->pm) {
25e18499e   Rafael J. Wysocki   Implement new sus...
774
775
776
777
778
779
780
781
  		if (drv->pm->restore)
  			ret = drv->pm->restore(dev);
  	} else {
  		ret = platform_legacy_resume(dev);
  	}
  
  	return ret;
  }
69c9dd1ec   Rafael J. Wysocki   PM: Export platfo...
782
  #endif /* CONFIG_HIBERNATE_CALLBACKS */
25e18499e   Rafael J. Wysocki   Implement new sus...
783

d9ab77161   Dmitry Torokhov   Driver Core: Make...
784
  static const struct dev_pm_ops platform_dev_pm_ops = {
8b313a38e   Rafael J. Wysocki   PM / Platform: Us...
785
786
787
  	.runtime_suspend = pm_generic_runtime_suspend,
  	.runtime_resume = pm_generic_runtime_resume,
  	.runtime_idle = pm_generic_runtime_idle,
69c9dd1ec   Rafael J. Wysocki   PM: Export platfo...
788
  	USE_PLATFORM_PM_SLEEP_OPS
25e18499e   Rafael J. Wysocki   Implement new sus...
789
  };
1da177e4c   Linus Torvalds   Linux-2.6.12-rc2
790
791
  struct bus_type platform_bus_type = {
  	.name		= "platform",
a0245f7ad   David Brownell   [PATCH] platform_...
792
  	.dev_attrs	= platform_dev_attrs,
1da177e4c   Linus Torvalds   Linux-2.6.12-rc2
793
  	.match		= platform_match,
a0245f7ad   David Brownell   [PATCH] platform_...
794
  	.uevent		= platform_uevent,
9d7302299   Magnus Damm   PM: Run-time PM p...
795
  	.pm		= &platform_dev_pm_ops,
1da177e4c   Linus Torvalds   Linux-2.6.12-rc2
796
  };
a96b20420   Dmitry Torokhov   [PATCH] Driver Co...
797
  EXPORT_SYMBOL_GPL(platform_bus_type);
1da177e4c   Linus Torvalds   Linux-2.6.12-rc2
798
799
800
  
  int __init platform_bus_init(void)
  {
fbfb14455   Cornelia Huck   driver core fixes...
801
  	int error;
13977091a   Magnus Damm   Driver Core: earl...
802
  	early_platform_cleanup();
fbfb14455   Cornelia Huck   driver core fixes...
803
804
805
806
807
808
809
  	error = device_register(&platform_bus);
  	if (error)
  		return error;
  	error =  bus_register(&platform_bus_type);
  	if (error)
  		device_unregister(&platform_bus);
  	return error;
1da177e4c   Linus Torvalds   Linux-2.6.12-rc2
810
811
812
813
814
815
816
817
818
819
820
821
822
823
824
825
826
827
828
  }
  
  #ifndef ARCH_HAS_DMA_GET_REQUIRED_MASK
  u64 dma_get_required_mask(struct device *dev)
  {
  	u32 low_totalram = ((max_pfn - 1) << PAGE_SHIFT);
  	u32 high_totalram = ((max_pfn - 1) >> (32 - PAGE_SHIFT));
  	u64 mask;
  
  	if (!high_totalram) {
  		/* convert to mask just covering totalram */
  		low_totalram = (1 << (fls(low_totalram) - 1));
  		low_totalram += low_totalram - 1;
  		mask = low_totalram;
  	} else {
  		high_totalram = (1 << (fls(high_totalram) - 1));
  		high_totalram += high_totalram - 1;
  		mask = (((u64)high_totalram) << 32) + 0xffffffff;
  	}
e88a0c2ca   James Bottomley   drivers: fix dma_...
829
  	return mask;
1da177e4c   Linus Torvalds   Linux-2.6.12-rc2
830
831
832
  }
  EXPORT_SYMBOL_GPL(dma_get_required_mask);
  #endif
13977091a   Magnus Damm   Driver Core: earl...
833
834
835
836
837
  
  static __initdata LIST_HEAD(early_platform_driver_list);
  static __initdata LIST_HEAD(early_platform_device_list);
  
  /**
4d26e139f   Magnus Damm   Driver core: Earl...
838
   * early_platform_driver_register - register early platform driver
d86c1302c   Randy Dunlap   Driver core: plat...
839
   * @epdrv: early_platform driver structure
13977091a   Magnus Damm   Driver Core: earl...
840
   * @buf: string passed from early_param()
4d26e139f   Magnus Damm   Driver core: Earl...
841
842
   *
   * Helper function for early_platform_init() / early_platform_init_buffer()
13977091a   Magnus Damm   Driver Core: earl...
843
844
845
846
   */
  int __init early_platform_driver_register(struct early_platform_driver *epdrv,
  					  char *buf)
  {
c60e0504c   Magnus Damm   Driver Core: Earl...
847
  	char *tmp;
13977091a   Magnus Damm   Driver Core: earl...
848
849
850
851
852
853
854
855
856
857
858
859
860
861
862
863
864
  	int n;
  
  	/* Simply add the driver to the end of the global list.
  	 * Drivers will by default be put on the list in compiled-in order.
  	 */
  	if (!epdrv->list.next) {
  		INIT_LIST_HEAD(&epdrv->list);
  		list_add_tail(&epdrv->list, &early_platform_driver_list);
  	}
  
  	/* If the user has specified device then make sure the driver
  	 * gets prioritized. The driver of the last device specified on
  	 * command line will be put first on the list.
  	 */
  	n = strlen(epdrv->pdrv->driver.name);
  	if (buf && !strncmp(buf, epdrv->pdrv->driver.name, n)) {
  		list_move(&epdrv->list, &early_platform_driver_list);
c60e0504c   Magnus Damm   Driver Core: Earl...
865
866
  		/* Allow passing parameters after device name */
  		if (buf[n] == '\0' || buf[n] == ',')
13977091a   Magnus Damm   Driver Core: earl...
867
  			epdrv->requested_id = -1;
c60e0504c   Magnus Damm   Driver Core: Earl...
868
869
870
871
872
873
874
875
876
877
878
879
880
881
882
883
884
885
886
  		else {
  			epdrv->requested_id = simple_strtoul(&buf[n + 1],
  							     &tmp, 10);
  
  			if (buf[n] != '.' || (tmp == &buf[n + 1])) {
  				epdrv->requested_id = EARLY_PLATFORM_ID_ERROR;
  				n = 0;
  			} else
  				n += strcspn(&buf[n + 1], ",") + 1;
  		}
  
  		if (buf[n] == ',')
  			n++;
  
  		if (epdrv->bufsize) {
  			memcpy(epdrv->buffer, &buf[n],
  			       min_t(int, epdrv->bufsize, strlen(&buf[n]) + 1));
  			epdrv->buffer[epdrv->bufsize - 1] = '\0';
  		}
13977091a   Magnus Damm   Driver Core: earl...
887
888
889
890
891
892
  	}
  
  	return 0;
  }
  
  /**
4d26e139f   Magnus Damm   Driver core: Earl...
893
   * early_platform_add_devices - adds a number of early platform devices
13977091a   Magnus Damm   Driver Core: earl...
894
895
   * @devs: array of early platform devices to add
   * @num: number of early platform devices in array
4d26e139f   Magnus Damm   Driver core: Earl...
896
897
898
   *
   * Used by early architecture code to register early platform devices and
   * their platform data.
13977091a   Magnus Damm   Driver Core: earl...
899
900
901
902
903
904
905
906
907
908
909
910
911
912
913
914
915
916
917
   */
  void __init early_platform_add_devices(struct platform_device **devs, int num)
  {
  	struct device *dev;
  	int i;
  
  	/* simply add the devices to list */
  	for (i = 0; i < num; i++) {
  		dev = &devs[i]->dev;
  
  		if (!dev->devres_head.next) {
  			INIT_LIST_HEAD(&dev->devres_head);
  			list_add_tail(&dev->devres_head,
  				      &early_platform_device_list);
  		}
  	}
  }
  
  /**
4d26e139f   Magnus Damm   Driver core: Earl...
918
   * early_platform_driver_register_all - register early platform drivers
13977091a   Magnus Damm   Driver Core: earl...
919
   * @class_str: string to identify early platform driver class
4d26e139f   Magnus Damm   Driver core: Earl...
920
921
922
923
   *
   * Used by architecture code to register all early platform drivers
   * for a certain class. If omitted then only early platform drivers
   * with matching kernel command line class parameters will be registered.
13977091a   Magnus Damm   Driver Core: earl...
924
925
926
927
928
929
930
931
932
933
934
935
936
937
938
939
940
941
942
943
944
   */
  void __init early_platform_driver_register_all(char *class_str)
  {
  	/* The "class_str" parameter may or may not be present on the kernel
  	 * command line. If it is present then there may be more than one
  	 * matching parameter.
  	 *
  	 * Since we register our early platform drivers using early_param()
  	 * we need to make sure that they also get registered in the case
  	 * when the parameter is missing from the kernel command line.
  	 *
  	 * We use parse_early_options() to make sure the early_param() gets
  	 * called at least once. The early_param() may be called more than
  	 * once since the name of the preferred device may be specified on
  	 * the kernel command line. early_platform_driver_register() handles
  	 * this case for us.
  	 */
  	parse_early_options(class_str);
  }
  
  /**
4d26e139f   Magnus Damm   Driver core: Earl...
945
   * early_platform_match - find early platform device matching driver
d86c1302c   Randy Dunlap   Driver core: plat...
946
   * @epdrv: early platform driver structure
13977091a   Magnus Damm   Driver Core: earl...
947
948
949
950
951
952
953
954
955
956
957
958
959
960
961
962
   * @id: id to match against
   */
  static  __init struct platform_device *
  early_platform_match(struct early_platform_driver *epdrv, int id)
  {
  	struct platform_device *pd;
  
  	list_for_each_entry(pd, &early_platform_device_list, dev.devres_head)
  		if (platform_match(&pd->dev, &epdrv->pdrv->driver))
  			if (pd->id == id)
  				return pd;
  
  	return NULL;
  }
  
  /**
4d26e139f   Magnus Damm   Driver core: Earl...
963
   * early_platform_left - check if early platform driver has matching devices
d86c1302c   Randy Dunlap   Driver core: plat...
964
   * @epdrv: early platform driver structure
13977091a   Magnus Damm   Driver Core: earl...
965
966
967
968
969
970
971
972
973
974
975
976
977
978
979
980
   * @id: return true if id or above exists
   */
  static  __init int early_platform_left(struct early_platform_driver *epdrv,
  				       int id)
  {
  	struct platform_device *pd;
  
  	list_for_each_entry(pd, &early_platform_device_list, dev.devres_head)
  		if (platform_match(&pd->dev, &epdrv->pdrv->driver))
  			if (pd->id >= id)
  				return 1;
  
  	return 0;
  }
  
  /**
4d26e139f   Magnus Damm   Driver core: Earl...
981
   * early_platform_driver_probe_id - probe drivers matching class_str and id
13977091a   Magnus Damm   Driver Core: earl...
982
983
984
985
986
987
988
989
990
991
992
993
994
995
996
997
998
999
1000
1001
1002
1003
1004
1005
1006
1007
1008
1009
1010
1011
1012
1013
1014
1015
1016
1017
1018
1019
1020
1021
1022
1023
1024
1025
1026
1027
1028
1029
1030
1031
1032
1033
   * @class_str: string to identify early platform driver class
   * @id: id to match against
   * @nr_probe: number of platform devices to successfully probe before exiting
   */
  static int __init early_platform_driver_probe_id(char *class_str,
  						 int id,
  						 int nr_probe)
  {
  	struct early_platform_driver *epdrv;
  	struct platform_device *match;
  	int match_id;
  	int n = 0;
  	int left = 0;
  
  	list_for_each_entry(epdrv, &early_platform_driver_list, list) {
  		/* only use drivers matching our class_str */
  		if (strcmp(class_str, epdrv->class_str))
  			continue;
  
  		if (id == -2) {
  			match_id = epdrv->requested_id;
  			left = 1;
  
  		} else {
  			match_id = id;
  			left += early_platform_left(epdrv, id);
  
  			/* skip requested id */
  			switch (epdrv->requested_id) {
  			case EARLY_PLATFORM_ID_ERROR:
  			case EARLY_PLATFORM_ID_UNSET:
  				break;
  			default:
  				if (epdrv->requested_id == id)
  					match_id = EARLY_PLATFORM_ID_UNSET;
  			}
  		}
  
  		switch (match_id) {
  		case EARLY_PLATFORM_ID_ERROR:
  			pr_warning("%s: unable to parse %s parameter
  ",
  				   class_str, epdrv->pdrv->driver.name);
  			/* fall-through */
  		case EARLY_PLATFORM_ID_UNSET:
  			match = NULL;
  			break;
  		default:
  			match = early_platform_match(epdrv, match_id);
  		}
  
  		if (match) {
a636ee7fb   Paul Mundt   driver core: Earl...
1034
1035
1036
1037
1038
  			/*
  			 * Set up a sensible init_name to enable
  			 * dev_name() and others to be used before the
  			 * rest of the driver core is initialized.
  			 */
06fe53beb   Paul Mundt   driver core: Earl...
1039
  			if (!match->dev.init_name && slab_is_available()) {
a636ee7fb   Paul Mundt   driver core: Earl...
1040
  				if (match->id != -1)
bd05086bb   Paul Mundt   driver core: Conv...
1041
1042
1043
1044
  					match->dev.init_name =
  						kasprintf(GFP_KERNEL, "%s.%d",
  							  match->name,
  							  match->id);
a636ee7fb   Paul Mundt   driver core: Earl...
1045
  				else
bd05086bb   Paul Mundt   driver core: Conv...
1046
1047
1048
  					match->dev.init_name =
  						kasprintf(GFP_KERNEL, "%s",
  							  match->name);
a636ee7fb   Paul Mundt   driver core: Earl...
1049

a636ee7fb   Paul Mundt   driver core: Earl...
1050
1051
1052
  				if (!match->dev.init_name)
  					return -ENOMEM;
  			}
bd05086bb   Paul Mundt   driver core: Conv...
1053

13977091a   Magnus Damm   Driver Core: earl...
1054
1055
1056
1057
1058
1059
1060
1061
1062
1063
1064
1065
1066
1067
1068
1069
1070
1071
1072
  			if (epdrv->pdrv->probe(match))
  				pr_warning("%s: unable to probe %s early.
  ",
  					   class_str, match->name);
  			else
  				n++;
  		}
  
  		if (n >= nr_probe)
  			break;
  	}
  
  	if (left)
  		return n;
  	else
  		return -ENODEV;
  }
  
  /**
4d26e139f   Magnus Damm   Driver core: Earl...
1073
   * early_platform_driver_probe - probe a class of registered drivers
13977091a   Magnus Damm   Driver Core: earl...
1074
1075
1076
   * @class_str: string to identify early platform driver class
   * @nr_probe: number of platform devices to successfully probe before exiting
   * @user_only: only probe user specified early platform devices
4d26e139f   Magnus Damm   Driver core: Earl...
1077
1078
1079
1080
   *
   * Used by architecture code to probe registered early platform drivers
   * within a certain class. For probe to happen a registered early platform
   * device matching a registered early platform driver is needed.
13977091a   Magnus Damm   Driver Core: earl...
1081
1082
1083
1084
1085
1086
1087
1088
1089
1090
1091
1092
1093
1094
1095
1096
1097
1098
1099
1100
1101
1102
1103
1104
1105
1106
1107
1108
1109
1110
1111
1112
1113
1114
1115
1116
1117
   */
  int __init early_platform_driver_probe(char *class_str,
  				       int nr_probe,
  				       int user_only)
  {
  	int k, n, i;
  
  	n = 0;
  	for (i = -2; n < nr_probe; i++) {
  		k = early_platform_driver_probe_id(class_str, i, nr_probe - n);
  
  		if (k < 0)
  			break;
  
  		n += k;
  
  		if (user_only)
  			break;
  	}
  
  	return n;
  }
  
  /**
   * early_platform_cleanup - clean up early platform code
   */
  void __init early_platform_cleanup(void)
  {
  	struct platform_device *pd, *pd2;
  
  	/* clean up the devres list used to chain devices */
  	list_for_each_entry_safe(pd, pd2, &early_platform_device_list,
  				 dev.devres_head) {
  		list_del(&pd->dev.devres_head);
  		memset(&pd->dev.devres_head, 0, sizeof(pd->dev.devres_head));
  	}
  }