core.c 43.4 KB
Newer Older
L
Linus Torvalds 已提交
1 2 3 4 5
/*
 * drivers/base/core.c - core driver model code (device registration, etc)
 *
 * Copyright (c) 2002-3 Patrick Mochel
 * Copyright (c) 2002-3 Open Source Development Labs
6 7
 * Copyright (c) 2006 Greg Kroah-Hartman <gregkh@suse.de>
 * Copyright (c) 2006 Novell, Inc.
L
Linus Torvalds 已提交
8 9 10 11 12 13 14 15 16 17 18
 *
 * This file is released under the GPLv2
 *
 */

#include <linux/device.h>
#include <linux/err.h>
#include <linux/init.h>
#include <linux/module.h>
#include <linux/slab.h>
#include <linux/string.h>
19
#include <linux/kdev_t.h>
20
#include <linux/notifier.h>
21
#include <linux/genhd.h>
22
#include <linux/kallsyms.h>
23
#include <linux/semaphore.h>
24
#include <linux/mutex.h>
25
#include <linux/async.h>
L
Linus Torvalds 已提交
26 27 28 29

#include "base.h"
#include "power/power.h"

30 31
int (*platform_notify)(struct device *dev) = NULL;
int (*platform_notify_remove)(struct device *dev) = NULL;
32 33 34
static struct kobject *dev_kobj;
struct kobject *sysfs_dev_char_kobj;
struct kobject *sysfs_dev_block_kobj;
L
Linus Torvalds 已提交
35

36 37 38 39 40 41 42 43 44 45 46
#ifdef CONFIG_BLOCK
static inline int device_is_not_partition(struct device *dev)
{
	return !(dev->type == &part_type);
}
#else
static inline int device_is_not_partition(struct device *dev)
{
	return 1;
}
#endif
L
Linus Torvalds 已提交
47

48 49 50 51 52 53 54 55 56
/**
 * dev_driver_string - Return a device's driver name, if at all possible
 * @dev: struct device to get the name of
 *
 * Will return the device's driver's name if it is bound to a device.  If
 * the device is not bound to a device, it will return the name of the bus
 * it is attached to.  If it is not attached to a bus either, an empty
 * string will be returned.
 */
57
const char *dev_driver_string(const struct device *dev)
58 59
{
	return dev->driver ? dev->driver->name :
60 61
			(dev->bus ? dev->bus->name :
			(dev->class ? dev->class->name : ""));
62
}
M
Matthew Wilcox 已提交
63
EXPORT_SYMBOL(dev_driver_string);
64

L
Linus Torvalds 已提交
65 66 67
#define to_dev(obj) container_of(obj, struct device, kobj)
#define to_dev_attr(_attr) container_of(_attr, struct device_attribute, attr)

68 69
static ssize_t dev_attr_show(struct kobject *kobj, struct attribute *attr,
			     char *buf)
L
Linus Torvalds 已提交
70
{
71 72
	struct device_attribute *dev_attr = to_dev_attr(attr);
	struct device *dev = to_dev(kobj);
73
	ssize_t ret = -EIO;
L
Linus Torvalds 已提交
74 75

	if (dev_attr->show)
76
		ret = dev_attr->show(dev, dev_attr, buf);
77 78 79 80
	if (ret >= (ssize_t)PAGE_SIZE) {
		print_symbol("dev_attr_show: %s returned bad count\n",
				(unsigned long)dev_attr->show);
	}
L
Linus Torvalds 已提交
81 82 83
	return ret;
}

84 85
static ssize_t dev_attr_store(struct kobject *kobj, struct attribute *attr,
			      const char *buf, size_t count)
L
Linus Torvalds 已提交
86
{
87 88
	struct device_attribute *dev_attr = to_dev_attr(attr);
	struct device *dev = to_dev(kobj);
89
	ssize_t ret = -EIO;
L
Linus Torvalds 已提交
90 91

	if (dev_attr->store)
92
		ret = dev_attr->store(dev, dev_attr, buf, count);
L
Linus Torvalds 已提交
93 94 95 96 97 98 99 100 101 102 103 104 105 106 107 108 109
	return ret;
}

static struct sysfs_ops dev_sysfs_ops = {
	.show	= dev_attr_show,
	.store	= dev_attr_store,
};


/**
 *	device_release - free device structure.
 *	@kobj:	device's kobject.
 *
 *	This is called once the reference count for the object
 *	reaches 0. We forward the call to the device's release
 *	method, which should handle actually freeing the structure.
 */
110
static void device_release(struct kobject *kobj)
L
Linus Torvalds 已提交
111
{
112
	struct device *dev = to_dev(kobj);
113
	struct device_private *p = dev->p;
L
Linus Torvalds 已提交
114 115 116

	if (dev->release)
		dev->release(dev);
117 118
	else if (dev->type && dev->type->release)
		dev->type->release(dev);
119 120
	else if (dev->class && dev->class->dev_release)
		dev->class->dev_release(dev);
A
Arjan van de Ven 已提交
121 122
	else
		WARN(1, KERN_ERR "Device '%s' does not have a release() "
123
			"function, it is broken and must be fixed.\n",
124
			dev_name(dev));
125
	kfree(p);
L
Linus Torvalds 已提交
126 127
}

128
static struct kobj_type device_ktype = {
L
Linus Torvalds 已提交
129 130 131 132 133
	.release	= device_release,
	.sysfs_ops	= &dev_sysfs_ops,
};


134
static int dev_uevent_filter(struct kset *kset, struct kobject *kobj)
L
Linus Torvalds 已提交
135 136 137
{
	struct kobj_type *ktype = get_ktype(kobj);

138
	if (ktype == &device_ktype) {
L
Linus Torvalds 已提交
139 140 141
		struct device *dev = to_dev(kobj);
		if (dev->bus)
			return 1;
142 143
		if (dev->class)
			return 1;
L
Linus Torvalds 已提交
144 145 146 147
	}
	return 0;
}

148
static const char *dev_uevent_name(struct kset *kset, struct kobject *kobj)
L
Linus Torvalds 已提交
149 150 151
{
	struct device *dev = to_dev(kobj);

152 153 154 155 156
	if (dev->bus)
		return dev->bus->name;
	if (dev->class)
		return dev->class->name;
	return NULL;
L
Linus Torvalds 已提交
157 158
}

159 160
static int dev_uevent(struct kset *kset, struct kobject *kobj,
		      struct kobj_uevent_env *env)
L
Linus Torvalds 已提交
161 162 163 164
{
	struct device *dev = to_dev(kobj);
	int retval = 0;

165
	/* add device node properties if present */
166
	if (MAJOR(dev->devt)) {
167 168
		const char *tmp;
		const char *name;
169
		mode_t mode = 0;
170

171 172
		add_uevent_var(env, "MAJOR=%u", MAJOR(dev->devt));
		add_uevent_var(env, "MINOR=%u", MINOR(dev->devt));
173
		name = device_get_devnode(dev, &mode, &tmp);
174 175 176
		if (name) {
			add_uevent_var(env, "DEVNAME=%s", name);
			kfree(tmp);
177 178
			if (mode)
				add_uevent_var(env, "DEVMODE=%#o", mode & 0777);
179
		}
180 181
	}

182
	if (dev->type && dev->type->name)
183
		add_uevent_var(env, "DEVTYPE=%s", dev->type->name);
184

185
	if (dev->driver)
186
		add_uevent_var(env, "DRIVER=%s", dev->driver->name);
187

188
#ifdef CONFIG_SYSFS_DEPRECATED
189 190 191 192 193 194 195 196 197 198
	if (dev->class) {
		struct device *parent = dev->parent;

		/* find first bus device in parent chain */
		while (parent && !parent->bus)
			parent = parent->parent;
		if (parent && parent->bus) {
			const char *path;

			path = kobject_get_path(&parent->kobj, GFP_KERNEL);
199
			if (path) {
200
				add_uevent_var(env, "PHYSDEVPATH=%s", path);
201 202
				kfree(path);
			}
203

204
			add_uevent_var(env, "PHYSDEVBUS=%s", parent->bus->name);
205 206

			if (parent->driver)
207 208
				add_uevent_var(env, "PHYSDEVDRIVER=%s",
					       parent->driver->name);
209 210
		}
	} else if (dev->bus) {
211
		add_uevent_var(env, "PHYSDEVBUS=%s", dev->bus->name);
212 213

		if (dev->driver)
214 215
			add_uevent_var(env, "PHYSDEVDRIVER=%s",
				       dev->driver->name);
K
Kay Sievers 已提交
216
	}
217
#endif
L
Linus Torvalds 已提交
218

219
	/* have the bus specific function add its stuff */
220
	if (dev->bus && dev->bus->uevent) {
221
		retval = dev->bus->uevent(dev, env);
222
		if (retval)
223
			pr_debug("device: '%s': %s: bus uevent() returned %d\n",
224
				 dev_name(dev), __func__, retval);
L
Linus Torvalds 已提交
225 226
	}

227
	/* have the class specific function add its stuff */
228
	if (dev->class && dev->class->dev_uevent) {
229
		retval = dev->class->dev_uevent(dev, env);
230
		if (retval)
231
			pr_debug("device: '%s': %s: class uevent() "
232
				 "returned %d\n", dev_name(dev),
233
				 __func__, retval);
234 235
	}

236
	/* have the device type specific fuction add its stuff */
237
	if (dev->type && dev->type->uevent) {
238
		retval = dev->type->uevent(dev, env);
239
		if (retval)
240
			pr_debug("device: '%s': %s: dev_type uevent() "
241
				 "returned %d\n", dev_name(dev),
242
				 __func__, retval);
243 244
	}

L
Linus Torvalds 已提交
245 246 247
	return retval;
}

248 249 250 251
static struct kset_uevent_ops device_uevent_ops = {
	.filter =	dev_uevent_filter,
	.name =		dev_uevent_name,
	.uevent =	dev_uevent,
L
Linus Torvalds 已提交
252 253
};

254 255 256 257 258
static ssize_t show_uevent(struct device *dev, struct device_attribute *attr,
			   char *buf)
{
	struct kobject *top_kobj;
	struct kset *kset;
259
	struct kobj_uevent_env *env = NULL;
260 261 262 263 264 265
	int i;
	size_t count = 0;
	int retval;

	/* search the kset, the device belongs to */
	top_kobj = &dev->kobj;
266 267
	while (!top_kobj->kset && top_kobj->parent)
		top_kobj = top_kobj->parent;
268 269
	if (!top_kobj->kset)
		goto out;
270

271 272 273 274 275 276 277 278 279
	kset = top_kobj->kset;
	if (!kset->uevent_ops || !kset->uevent_ops->uevent)
		goto out;

	/* respect filter */
	if (kset->uevent_ops && kset->uevent_ops->filter)
		if (!kset->uevent_ops->filter(kset, &dev->kobj))
			goto out;

280 281
	env = kzalloc(sizeof(struct kobj_uevent_env), GFP_KERNEL);
	if (!env)
282 283
		return -ENOMEM;

284
	/* let the kset specific function add its keys */
285
	retval = kset->uevent_ops->uevent(kset, &dev->kobj, env);
286 287 288 289
	if (retval)
		goto out;

	/* copy keys to file */
290 291
	for (i = 0; i < env->envp_idx; i++)
		count += sprintf(&buf[count], "%s\n", env->envp[i]);
292
out:
293
	kfree(env);
294 295 296
	return count;
}

297 298 299
static ssize_t store_uevent(struct device *dev, struct device_attribute *attr,
			    const char *buf, size_t count)
{
300 301
	enum kobject_action action;

302
	if (kobject_action_type(buf, count, &action) == 0) {
303 304 305 306 307 308
		kobject_uevent(&dev->kobj, action);
		goto out;
	}

	dev_err(dev, "uevent: unsupported action-string; this will "
		     "be ignored in a future kernel version\n");
309
	kobject_uevent(&dev->kobj, KOBJ_ADD);
310
out:
311 312 313
	return count;
}

314 315 316
static struct device_attribute uevent_attr =
	__ATTR(uevent, S_IRUGO | S_IWUSR, show_uevent, store_uevent);

317 318
static int device_add_attributes(struct device *dev,
				 struct device_attribute *attrs)
319
{
320
	int error = 0;
321
	int i;
322 323 324 325 326 327 328 329 330 331 332 333 334 335 336 337 338 339 340 341 342 343 344 345 346

	if (attrs) {
		for (i = 0; attr_name(attrs[i]); i++) {
			error = device_create_file(dev, &attrs[i]);
			if (error)
				break;
		}
		if (error)
			while (--i >= 0)
				device_remove_file(dev, &attrs[i]);
	}
	return error;
}

static void device_remove_attributes(struct device *dev,
				     struct device_attribute *attrs)
{
	int i;

	if (attrs)
		for (i = 0; attr_name(attrs[i]); i++)
			device_remove_file(dev, &attrs[i]);
}

static int device_add_groups(struct device *dev,
347
			     const struct attribute_group **groups)
348
{
349
	int error = 0;
350
	int i;
351

352 353 354
	if (groups) {
		for (i = 0; groups[i]; i++) {
			error = sysfs_create_group(&dev->kobj, groups[i]);
355 356
			if (error) {
				while (--i >= 0)
357 358
					sysfs_remove_group(&dev->kobj,
							   groups[i]);
359
				break;
360 361 362 363 364 365
			}
		}
	}
	return error;
}

366
static void device_remove_groups(struct device *dev,
367
				 const struct attribute_group **groups)
368 369
{
	int i;
370 371 372 373

	if (groups)
		for (i = 0; groups[i]; i++)
			sysfs_remove_group(&dev->kobj, groups[i]);
374 375
}

376 377 378
static int device_add_attrs(struct device *dev)
{
	struct class *class = dev->class;
379
	struct device_type *type = dev->type;
380
	int error;
381

382 383
	if (class) {
		error = device_add_attributes(dev, class->dev_attrs);
384
		if (error)
385
			return error;
386
	}
387

388 389
	if (type) {
		error = device_add_groups(dev, type->groups);
390
		if (error)
391
			goto err_remove_class_attrs;
392 393
	}

394 395 396 397 398 399 400 401 402 403 404 405 406
	error = device_add_groups(dev, dev->groups);
	if (error)
		goto err_remove_type_groups;

	return 0;

 err_remove_type_groups:
	if (type)
		device_remove_groups(dev, type->groups);
 err_remove_class_attrs:
	if (class)
		device_remove_attributes(dev, class->dev_attrs);

407 408 409 410 411 412
	return error;
}

static void device_remove_attrs(struct device *dev)
{
	struct class *class = dev->class;
413
	struct device_type *type = dev->type;
414

415
	device_remove_groups(dev, dev->groups);
416

417 418 419 420 421
	if (type)
		device_remove_groups(dev, type->groups);

	if (class)
		device_remove_attributes(dev, class->dev_attrs);
422 423 424
}


425 426 427 428 429 430
static ssize_t show_dev(struct device *dev, struct device_attribute *attr,
			char *buf)
{
	return print_dev_t(buf, dev->devt);
}

431 432 433
static struct device_attribute devt_attr =
	__ATTR(dev, S_IRUGO, show_dev, NULL);

434 435
/* kset to create /sys/devices/  */
struct kset *devices_kset;
L
Linus Torvalds 已提交
436 437

/**
438 439 440
 * device_create_file - create sysfs attribute file for device.
 * @dev: device.
 * @attr: device attribute descriptor.
L
Linus Torvalds 已提交
441
 */
442
int device_create_file(struct device *dev, struct device_attribute *attr)
L
Linus Torvalds 已提交
443 444
{
	int error = 0;
445
	if (dev)
L
Linus Torvalds 已提交
446 447 448 449 450
		error = sysfs_create_file(&dev->kobj, &attr->attr);
	return error;
}

/**
451 452 453
 * device_remove_file - remove sysfs attribute file.
 * @dev: device.
 * @attr: device attribute descriptor.
L
Linus Torvalds 已提交
454
 */
455
void device_remove_file(struct device *dev, struct device_attribute *attr)
L
Linus Torvalds 已提交
456
{
457
	if (dev)
L
Linus Torvalds 已提交
458 459 460
		sysfs_remove_file(&dev->kobj, &attr->attr);
}

461 462 463 464 465 466 467 468 469 470 471 472 473 474 475 476 477 478 479 480 481 482 483 484 485 486
/**
 * device_create_bin_file - create sysfs binary attribute file for device.
 * @dev: device.
 * @attr: device binary attribute descriptor.
 */
int device_create_bin_file(struct device *dev, struct bin_attribute *attr)
{
	int error = -EINVAL;
	if (dev)
		error = sysfs_create_bin_file(&dev->kobj, attr);
	return error;
}
EXPORT_SYMBOL_GPL(device_create_bin_file);

/**
 * device_remove_bin_file - remove sysfs binary attribute file
 * @dev: device.
 * @attr: device binary attribute descriptor.
 */
void device_remove_bin_file(struct device *dev, struct bin_attribute *attr)
{
	if (dev)
		sysfs_remove_bin_file(&dev->kobj, attr);
}
EXPORT_SYMBOL_GPL(device_remove_bin_file);

487
/**
488
 * device_schedule_callback_owner - helper to schedule a callback for a device
489 490
 * @dev: device.
 * @func: callback function to invoke later.
491
 * @owner: module owning the callback routine
492 493 494 495 496 497 498 499 500 501
 *
 * Attribute methods must not unregister themselves or their parent device
 * (which would amount to the same thing).  Attempts to do so will deadlock,
 * since unregistration is mutually exclusive with driver callbacks.
 *
 * Instead methods can call this routine, which will attempt to allocate
 * and schedule a workqueue request to call back @func with @dev as its
 * argument in the workqueue's process context.  @dev will be pinned until
 * @func returns.
 *
502 503 504
 * This routine is usually called via the inline device_schedule_callback(),
 * which automatically sets @owner to THIS_MODULE.
 *
505
 * Returns 0 if the request was submitted, -ENOMEM if storage could not
506
 * be allocated, -ENODEV if a reference to @owner isn't available.
507 508 509 510 511
 *
 * NOTE: This routine won't work if CONFIG_SYSFS isn't set!  It uses an
 * underlying sysfs routine (since it is intended for use by attribute
 * methods), and if sysfs isn't available you'll get nothing but -ENOSYS.
 */
512 513
int device_schedule_callback_owner(struct device *dev,
		void (*func)(struct device *), struct module *owner)
514 515
{
	return sysfs_schedule_callback(&dev->kobj,
516
			(void (*)(void *)) func, dev, owner);
517
}
518
EXPORT_SYMBOL_GPL(device_schedule_callback_owner);
519

520 521
static void klist_children_get(struct klist_node *n)
{
522 523
	struct device_private *p = to_device_private_parent(n);
	struct device *dev = p->device;
524 525 526 527 528 529

	get_device(dev);
}

static void klist_children_put(struct klist_node *n)
{
530 531
	struct device_private *p = to_device_private_parent(n);
	struct device *dev = p->device;
532 533 534 535

	put_device(dev);
}

L
Linus Torvalds 已提交
536
/**
537 538
 * device_initialize - init device structure.
 * @dev: device.
L
Linus Torvalds 已提交
539
 *
540 541
 * This prepares the device for use by other layers by initializing
 * its fields.
542
 * It is the first half of device_register(), if called by
543 544 545 546 547 548 549
 * that function, though it can also be called separately, so one
 * may use @dev's fields. In particular, get_device()/put_device()
 * may be used for reference counting of @dev after calling this
 * function.
 *
 * NOTE: Use put_device() to give up your reference instead of freeing
 * @dev directly once you have called this function.
L
Linus Torvalds 已提交
550 551 552
 */
void device_initialize(struct device *dev)
{
553
	dev->kobj.kset = devices_kset;
554
	kobject_init(&dev->kobj, &device_ktype);
L
Linus Torvalds 已提交
555
	INIT_LIST_HEAD(&dev->dma_pools);
556
	init_MUTEX(&dev->sem);
T
Tejun Heo 已提交
557 558
	spin_lock_init(&dev->devres_lock);
	INIT_LIST_HEAD(&dev->devres_head);
D
David Brownell 已提交
559
	device_init_wakeup(dev, 0);
560
	device_pm_init(dev);
561
	set_dev_node(dev, -1);
L
Linus Torvalds 已提交
562 563
}

564
#ifdef CONFIG_SYSFS_DEPRECATED
565 566
static struct kobject *get_device_parent(struct device *dev,
					 struct device *parent)
567
{
568
	/* class devices without a parent live in /sys/class/<classname>/ */
569
	if (dev->class && (!parent || parent->class != dev->class))
570
		return &dev->class->p->class_subsys.kobj;
571
	/* all other devices keep their parent */
572
	else if (parent)
573
		return &parent->kobj;
574

575
	return NULL;
576
}
577 578

static inline void cleanup_device_parent(struct device *dev) {}
579 580
static inline void cleanup_glue_dir(struct device *dev,
				    struct kobject *glue_dir) {}
581
#else
582
static struct kobject *virtual_device_parent(struct device *dev)
583
{
584
	static struct kobject *virtual_dir = NULL;
585

586
	if (!virtual_dir)
587
		virtual_dir = kobject_create_and_add("virtual",
588
						     &devices_kset->kobj);
589

590
	return virtual_dir;
591 592
}

593 594
static struct kobject *get_device_parent(struct device *dev,
					 struct device *parent)
595
{
596 597
	int retval;

598 599 600 601 602 603 604
	if (dev->class) {
		struct kobject *kobj = NULL;
		struct kobject *parent_kobj;
		struct kobject *k;

		/*
		 * If we have no parent, we live in "virtual".
605 606
		 * Class-devices with a non class-device as parent, live
		 * in a "glue" directory to prevent namespace collisions.
607 608 609 610 611 612 613 614 615
		 */
		if (parent == NULL)
			parent_kobj = virtual_device_parent(dev);
		else if (parent->class)
			return &parent->kobj;
		else
			parent_kobj = &parent->kobj;

		/* find our class-directory at the parent and reference it */
616 617
		spin_lock(&dev->class->p->class_dirs.list_lock);
		list_for_each_entry(k, &dev->class->p->class_dirs.list, entry)
618 619 620 621
			if (k->parent == parent_kobj) {
				kobj = kobject_get(k);
				break;
			}
622
		spin_unlock(&dev->class->p->class_dirs.list_lock);
623 624 625 626
		if (kobj)
			return kobj;

		/* or create a new class-directory at the parent device */
627 628 629
		k = kobject_create();
		if (!k)
			return NULL;
630
		k->kset = &dev->class->p->class_dirs;
631
		retval = kobject_add(k, parent_kobj, "%s", dev->class->name);
632 633 634 635
		if (retval < 0) {
			kobject_put(k);
			return NULL;
		}
636
		/* do not emit an uevent for this simple "glue" directory */
637
		return k;
638 639 640
	}

	if (parent)
641 642 643
		return &parent->kobj;
	return NULL;
}
644

645
static void cleanup_glue_dir(struct device *dev, struct kobject *glue_dir)
646
{
647
	/* see if we live in a "glue" directory */
648
	if (!glue_dir || !dev->class ||
649
	    glue_dir->kset != &dev->class->p->class_dirs)
650 651
		return;

652
	kobject_put(glue_dir);
653
}
654 655 656 657 658

static void cleanup_device_parent(struct device *dev)
{
	cleanup_glue_dir(dev, dev->kobj.parent);
}
659
#endif
660

661
static void setup_parent(struct device *dev, struct device *parent)
662 663 664 665 666
{
	struct kobject *kobj;
	kobj = get_device_parent(dev, parent);
	if (kobj)
		dev->kobj.parent = kobj;
667 668
}

669 670 671 672 673 674
static int device_add_class_symlinks(struct device *dev)
{
	int error;

	if (!dev->class)
		return 0;
675

676 677
	error = sysfs_create_link(&dev->kobj,
				  &dev->class->p->class_subsys.kobj,
678 679 680
				  "subsystem");
	if (error)
		goto out;
681 682 683

#ifdef CONFIG_SYSFS_DEPRECATED
	/* stacked class devices need a symlink in the class directory */
684
	if (dev->kobj.parent != &dev->class->p->class_subsys.kobj &&
685
	    device_is_not_partition(dev)) {
686
		error = sysfs_create_link(&dev->class->p->class_subsys.kobj,
687
					  &dev->kobj, dev_name(dev));
688 689 690
		if (error)
			goto out_subsys;
	}
691

692
	if (dev->parent && device_is_not_partition(dev)) {
693 694
		struct device *parent = dev->parent;
		char *class_name;
695

696 697 698 699 700 701 702 703 704
		/*
		 * stacked class devices have the 'device' link
		 * pointing to the bus device instead of the parent
		 */
		while (parent->class && !parent->bus && parent->parent)
			parent = parent->parent;

		error = sysfs_create_link(&dev->kobj,
					  &parent->kobj,
705 706 707
					  "device");
		if (error)
			goto out_busid;
708 709 710 711 712 713 714 715 716

		class_name = make_class_name(dev->class->name,
						&dev->kobj);
		if (class_name)
			error = sysfs_create_link(&dev->parent->kobj,
						&dev->kobj, class_name);
		kfree(class_name);
		if (error)
			goto out_device;
717 718 719 720
	}
	return 0;

out_device:
721
	if (dev->parent && device_is_not_partition(dev))
722 723
		sysfs_remove_link(&dev->kobj, "device");
out_busid:
724
	if (dev->kobj.parent != &dev->class->p->class_subsys.kobj &&
725
	    device_is_not_partition(dev))
726
		sysfs_remove_link(&dev->class->p->class_subsys.kobj,
727
				  dev_name(dev));
728 729
#else
	/* link in the class directory pointing to the device */
730
	error = sysfs_create_link(&dev->class->p->class_subsys.kobj,
731
				  &dev->kobj, dev_name(dev));
732 733 734
	if (error)
		goto out_subsys;

735
	if (dev->parent && device_is_not_partition(dev)) {
736 737 738 739 740 741 742 743
		error = sysfs_create_link(&dev->kobj, &dev->parent->kobj,
					  "device");
		if (error)
			goto out_busid;
	}
	return 0;

out_busid:
744
	sysfs_remove_link(&dev->class->p->class_subsys.kobj, dev_name(dev));
745 746
#endif

747 748 749 750 751 752 753 754 755 756
out_subsys:
	sysfs_remove_link(&dev->kobj, "subsystem");
out:
	return error;
}

static void device_remove_class_symlinks(struct device *dev)
{
	if (!dev->class)
		return;
757

758
#ifdef CONFIG_SYSFS_DEPRECATED
759
	if (dev->parent && device_is_not_partition(dev)) {
760 761 762 763 764 765 766 767 768
		char *class_name;

		class_name = make_class_name(dev->class->name, &dev->kobj);
		if (class_name) {
			sysfs_remove_link(&dev->parent->kobj, class_name);
			kfree(class_name);
		}
		sysfs_remove_link(&dev->kobj, "device");
	}
769

770
	if (dev->kobj.parent != &dev->class->p->class_subsys.kobj &&
771
	    device_is_not_partition(dev))
772
		sysfs_remove_link(&dev->class->p->class_subsys.kobj,
773
				  dev_name(dev));
774
#else
775
	if (dev->parent && device_is_not_partition(dev))
776 777
		sysfs_remove_link(&dev->kobj, "device");

778
	sysfs_remove_link(&dev->class->p->class_subsys.kobj, dev_name(dev));
779 780
#endif

781 782 783
	sysfs_remove_link(&dev->kobj, "subsystem");
}

784 785 786
/**
 * dev_set_name - set a device name
 * @dev: device
787
 * @fmt: format string for the device's name
788 789 790 791
 */
int dev_set_name(struct device *dev, const char *fmt, ...)
{
	va_list vargs;
792
	int err;
793 794

	va_start(vargs, fmt);
795
	err = kobject_set_name_vargs(&dev->kobj, fmt, vargs);
796
	va_end(vargs);
797
	return err;
798 799 800
}
EXPORT_SYMBOL_GPL(dev_set_name);

801 802 803 804 805 806 807 808 809 810 811 812 813 814 815 816 817 818 819 820 821 822 823 824 825 826 827 828 829 830 831 832 833 834 835 836 837 838 839 840 841 842 843 844 845 846 847 848
/**
 * device_to_dev_kobj - select a /sys/dev/ directory for the device
 * @dev: device
 *
 * By default we select char/ for new entries.  Setting class->dev_obj
 * to NULL prevents an entry from being created.  class->dev_kobj must
 * be set (or cleared) before any devices are registered to the class
 * otherwise device_create_sys_dev_entry() and
 * device_remove_sys_dev_entry() will disagree about the the presence
 * of the link.
 */
static struct kobject *device_to_dev_kobj(struct device *dev)
{
	struct kobject *kobj;

	if (dev->class)
		kobj = dev->class->dev_kobj;
	else
		kobj = sysfs_dev_char_kobj;

	return kobj;
}

static int device_create_sys_dev_entry(struct device *dev)
{
	struct kobject *kobj = device_to_dev_kobj(dev);
	int error = 0;
	char devt_str[15];

	if (kobj) {
		format_dev_t(devt_str, dev->devt);
		error = sysfs_create_link(kobj, &dev->kobj, devt_str);
	}

	return error;
}

static void device_remove_sys_dev_entry(struct device *dev)
{
	struct kobject *kobj = device_to_dev_kobj(dev);
	char devt_str[15];

	if (kobj) {
		format_dev_t(devt_str, dev->devt);
		sysfs_remove_link(kobj, devt_str);
	}
}

849 850 851 852 853 854 855 856 857 858 859
int device_private_init(struct device *dev)
{
	dev->p = kzalloc(sizeof(*dev->p), GFP_KERNEL);
	if (!dev->p)
		return -ENOMEM;
	dev->p->device = dev;
	klist_init(&dev->p->klist_children, klist_children_get,
		   klist_children_put);
	return 0;
}

L
Linus Torvalds 已提交
860
/**
861 862
 * device_add - add device to device hierarchy.
 * @dev: device.
L
Linus Torvalds 已提交
863
 *
864 865
 * This is part 2 of device_register(), though may be called
 * separately _iff_ device_initialize() has been called separately.
L
Linus Torvalds 已提交
866
 *
867
 * This adds @dev to the kobject hierarchy via kobject_add(), adds it
868 869
 * to the global and sibling lists for the device, then
 * adds it to the other relevant subsystems of the driver model.
870 871 872 873
 *
 * NOTE: _Never_ directly free @dev after calling this function, even
 * if it returned an error! Always use put_device() to give up your
 * reference instead.
L
Linus Torvalds 已提交
874 875 876 877
 */
int device_add(struct device *dev)
{
	struct device *parent = NULL;
878
	struct class_interface *class_intf;
879
	int error = -EINVAL;
880

L
Linus Torvalds 已提交
881
	dev = get_device(dev);
882 883 884
	if (!dev)
		goto done;

885
	if (!dev->p) {
886 887 888
		error = device_private_init(dev);
		if (error)
			goto done;
889 890
	}

891 892 893 894 895 896
	/*
	 * for statically allocated devices, which should all be converted
	 * some day, we need to initialize the name. We prevent reading back
	 * the name, and force the use of dev_name()
	 */
	if (dev->init_name) {
897
		dev_set_name(dev, "%s", dev->init_name);
898 899
		dev->init_name = NULL;
	}
900

901
	if (!dev_name(dev))
902
		goto name_error;
L
Linus Torvalds 已提交
903

904
	pr_debug("device: '%s': %s\n", dev_name(dev), __func__);
905

L
Linus Torvalds 已提交
906
	parent = get_device(dev->parent);
907
	setup_parent(dev, parent);
L
Linus Torvalds 已提交
908

909 910 911 912
	/* use parent numa_node */
	if (parent)
		set_dev_node(dev, dev_to_node(parent));

L
Linus Torvalds 已提交
913
	/* first, register with generic layer. */
914 915
	/* we require the name to be set before, and pass NULL */
	error = kobject_add(&dev->kobj, dev->kobj.parent, NULL);
916
	if (error)
L
Linus Torvalds 已提交
917
		goto Error;
918

919 920 921 922
	/* notify platform of device entry */
	if (platform_notify)
		platform_notify(dev);

923
	error = device_create_file(dev, &uevent_attr);
924 925
	if (error)
		goto attrError;
926

927
	if (MAJOR(dev->devt)) {
928 929
		error = device_create_file(dev, &devt_attr);
		if (error)
930
			goto ueventattrError;
931 932 933 934

		error = device_create_sys_dev_entry(dev);
		if (error)
			goto devtattrError;
935 936

		devtmpfs_create_node(dev);
937 938
	}

939 940 941
	error = device_add_class_symlinks(dev);
	if (error)
		goto SymlinkError;
942 943
	error = device_add_attrs(dev);
	if (error)
944
		goto AttrsError;
945 946
	error = bus_add_device(dev);
	if (error)
L
Linus Torvalds 已提交
947
		goto BusError;
948
	error = dpm_sysfs_add(dev);
949
	if (error)
950 951
		goto DPMError;
	device_pm_add(dev);
952 953 954 955 956 957 958 959

	/* Notify clients of device addition.  This call must come
	 * after dpm_sysf_add() and before kobject_uevent().
	 */
	if (dev->bus)
		blocking_notifier_call_chain(&dev->bus->p->bus_notifier,
					     BUS_NOTIFY_ADD_DEVICE, dev);

960
	kobject_uevent(&dev->kobj, KOBJ_ADD);
961
	bus_probe_device(dev);
L
Linus Torvalds 已提交
962
	if (parent)
963 964
		klist_add_tail(&dev->p->knode_parent,
			       &parent->p->klist_children);
L
Linus Torvalds 已提交
965

966
	if (dev->class) {
967
		mutex_lock(&dev->class->p->class_mutex);
968
		/* tie the class to the device */
969 970
		klist_add_tail(&dev->knode_class,
			       &dev->class->p->class_devices);
971 972

		/* notify any interfaces that the device is here */
973 974
		list_for_each_entry(class_intf,
				    &dev->class->p->class_interfaces, node)
975 976
			if (class_intf->add_dev)
				class_intf->add_dev(dev, class_intf);
977
		mutex_unlock(&dev->class->p->class_mutex);
978
	}
979
done:
L
Linus Torvalds 已提交
980 981
	put_device(dev);
	return error;
982
 DPMError:
983 984
	bus_remove_device(dev);
 BusError:
985
	device_remove_attrs(dev);
986
 AttrsError:
987 988
	device_remove_class_symlinks(dev);
 SymlinkError:
989 990 991
	if (MAJOR(dev->devt))
		device_remove_sys_dev_entry(dev);
 devtattrError:
992 993
	if (MAJOR(dev->devt))
		device_remove_file(dev, &devt_attr);
994
 ueventattrError:
995
	device_remove_file(dev, &uevent_attr);
996
 attrError:
997
	kobject_uevent(&dev->kobj, KOBJ_REMOVE);
L
Linus Torvalds 已提交
998 999
	kobject_del(&dev->kobj);
 Error:
1000
	cleanup_device_parent(dev);
L
Linus Torvalds 已提交
1001 1002
	if (parent)
		put_device(parent);
1003 1004 1005
name_error:
	kfree(dev->p);
	dev->p = NULL;
1006
	goto done;
L
Linus Torvalds 已提交
1007 1008 1009
}

/**
1010 1011
 * device_register - register a device with the system.
 * @dev: pointer to the device structure
L
Linus Torvalds 已提交
1012
 *
1013 1014 1015 1016 1017 1018
 * This happens in two clean steps - initialize the device
 * and add it to the system. The two steps can be called
 * separately, but this is the easiest and most common.
 * I.e. you should only call the two helpers separately if
 * have a clearly defined need to use and refcount the device
 * before it is added to the hierarchy.
1019 1020 1021 1022
 *
 * NOTE: _Never_ directly free @dev after calling this function, even
 * if it returned an error! Always use put_device() to give up the
 * reference initialized in this function instead.
L
Linus Torvalds 已提交
1023 1024 1025 1026 1027 1028 1029 1030
 */
int device_register(struct device *dev)
{
	device_initialize(dev);
	return device_add(dev);
}

/**
1031 1032
 * get_device - increment reference count for device.
 * @dev: device.
L
Linus Torvalds 已提交
1033
 *
1034 1035 1036
 * This simply forwards the call to kobject_get(), though
 * we do take care to provide for the case that we get a NULL
 * pointer passed in.
L
Linus Torvalds 已提交
1037
 */
1038
struct device *get_device(struct device *dev)
L
Linus Torvalds 已提交
1039 1040 1041 1042 1043
{
	return dev ? to_dev(kobject_get(&dev->kobj)) : NULL;
}

/**
1044 1045
 * put_device - decrement reference count.
 * @dev: device in question.
L
Linus Torvalds 已提交
1046
 */
1047
void put_device(struct device *dev)
L
Linus Torvalds 已提交
1048
{
1049
	/* might_sleep(); */
L
Linus Torvalds 已提交
1050 1051 1052 1053 1054
	if (dev)
		kobject_put(&dev->kobj);
}

/**
1055 1056
 * device_del - delete device from system.
 * @dev: device.
L
Linus Torvalds 已提交
1057
 *
1058 1059 1060 1061 1062
 * This is the first part of the device unregistration
 * sequence. This removes the device from the lists we control
 * from here, has it removed from the other driver model
 * subsystems it was added to in device_add(), and removes it
 * from the kobject hierarchy.
L
Linus Torvalds 已提交
1063
 *
1064 1065
 * NOTE: this should be called manually _iff_ device_add() was
 * also called manually.
L
Linus Torvalds 已提交
1066
 */
1067
void device_del(struct device *dev)
L
Linus Torvalds 已提交
1068
{
1069
	struct device *parent = dev->parent;
1070
	struct class_interface *class_intf;
L
Linus Torvalds 已提交
1071

1072 1073 1074 1075 1076 1077
	/* Notify clients of device removal.  This call must come
	 * before dpm_sysfs_remove().
	 */
	if (dev->bus)
		blocking_notifier_call_chain(&dev->bus->p->bus_notifier,
					     BUS_NOTIFY_DEL_DEVICE, dev);
1078
	device_pm_remove(dev);
1079
	dpm_sysfs_remove(dev);
L
Linus Torvalds 已提交
1080
	if (parent)
1081
		klist_del(&dev->p->knode_parent);
1082
	if (MAJOR(dev->devt)) {
1083
		devtmpfs_delete_node(dev);
1084
		device_remove_sys_dev_entry(dev);
1085
		device_remove_file(dev, &devt_attr);
1086
	}
1087
	if (dev->class) {
1088
		device_remove_class_symlinks(dev);
1089

1090
		mutex_lock(&dev->class->p->class_mutex);
1091
		/* notify any interfaces that the device is now gone */
1092 1093
		list_for_each_entry(class_intf,
				    &dev->class->p->class_interfaces, node)
1094 1095 1096
			if (class_intf->remove_dev)
				class_intf->remove_dev(dev, class_intf);
		/* remove the device from the class list */
1097
		klist_del(&dev->knode_class);
1098
		mutex_unlock(&dev->class->p->class_mutex);
1099
	}
1100
	device_remove_file(dev, &uevent_attr);
1101
	device_remove_attrs(dev);
1102
	bus_remove_device(dev);
L
Linus Torvalds 已提交
1103

1104 1105 1106 1107 1108 1109 1110
	/*
	 * Some platform devices are driven without driver attached
	 * and managed resources may have been acquired.  Make sure
	 * all resources are released.
	 */
	devres_release_all(dev);

L
Linus Torvalds 已提交
1111 1112 1113 1114 1115
	/* Notify the platform of the removal, in case they
	 * need to do anything...
	 */
	if (platform_notify_remove)
		platform_notify_remove(dev);
1116
	kobject_uevent(&dev->kobj, KOBJ_REMOVE);
1117
	cleanup_device_parent(dev);
L
Linus Torvalds 已提交
1118
	kobject_del(&dev->kobj);
1119
	put_device(parent);
L
Linus Torvalds 已提交
1120 1121 1122
}

/**
1123 1124
 * device_unregister - unregister device from system.
 * @dev: device going away.
L
Linus Torvalds 已提交
1125
 *
1126 1127 1128 1129 1130 1131
 * We do this in two parts, like we do device_register(). First,
 * we remove it from all the subsystems with device_del(), then
 * we decrement the reference count via put_device(). If that
 * is the final reference count, the device will be cleaned up
 * via device_release() above. Otherwise, the structure will
 * stick around until the final reference to the device is dropped.
L
Linus Torvalds 已提交
1132
 */
1133
void device_unregister(struct device *dev)
L
Linus Torvalds 已提交
1134
{
1135
	pr_debug("device: '%s': %s\n", dev_name(dev), __func__);
L
Linus Torvalds 已提交
1136 1137 1138 1139
	device_del(dev);
	put_device(dev);
}

1140
static struct device *next_device(struct klist_iter *i)
1141
{
1142
	struct klist_node *n = klist_next(i);
1143 1144 1145 1146 1147 1148 1149 1150
	struct device *dev = NULL;
	struct device_private *p;

	if (n) {
		p = to_device_private_parent(n);
		dev = p->device;
	}
	return dev;
1151 1152
}

1153
/**
1154
 * device_get_devnode - path of device node file
1155
 * @dev: device
1156
 * @mode: returned file access mode
1157 1158 1159 1160 1161 1162 1163
 * @tmp: possibly allocated string
 *
 * Return the relative path of a possible device node.
 * Non-default names may need to allocate a memory to compose
 * a name. This memory is returned in tmp and needs to be
 * freed by the caller.
 */
1164 1165
const char *device_get_devnode(struct device *dev,
			       mode_t *mode, const char **tmp)
1166 1167 1168 1169 1170 1171
{
	char *s;

	*tmp = NULL;

	/* the device type may provide a specific name */
1172 1173
	if (dev->type && dev->type->devnode)
		*tmp = dev->type->devnode(dev, mode);
1174 1175 1176 1177
	if (*tmp)
		return *tmp;

	/* the class may provide a specific name */
1178 1179
	if (dev->class && dev->class->devnode)
		*tmp = dev->class->devnode(dev, mode);
1180 1181 1182 1183 1184 1185 1186 1187 1188 1189 1190 1191 1192 1193 1194 1195
	if (*tmp)
		return *tmp;

	/* return name without allocation, tmp == NULL */
	if (strchr(dev_name(dev), '!') == NULL)
		return dev_name(dev);

	/* replace '!' in the name with '/' */
	*tmp = kstrdup(dev_name(dev), GFP_KERNEL);
	if (!*tmp)
		return NULL;
	while ((s = strchr(*tmp, '!')))
		s[0] = '/';
	return *tmp;
}

L
Linus Torvalds 已提交
1196
/**
1197 1198 1199 1200
 * device_for_each_child - device child iterator.
 * @parent: parent struct device.
 * @data: data for the callback.
 * @fn: function to be called for each device.
L
Linus Torvalds 已提交
1201
 *
1202 1203
 * Iterate over @parent's child devices, and call @fn for each,
 * passing it @data.
L
Linus Torvalds 已提交
1204
 *
1205 1206
 * We check the return of @fn each time. If it returns anything
 * other than 0, we break out and return that value.
L
Linus Torvalds 已提交
1207
 */
1208 1209
int device_for_each_child(struct device *parent, void *data,
			  int (*fn)(struct device *dev, void *data))
L
Linus Torvalds 已提交
1210
{
1211
	struct klist_iter i;
1212
	struct device *child;
L
Linus Torvalds 已提交
1213 1214
	int error = 0;

1215 1216 1217
	if (!parent->p)
		return 0;

1218
	klist_iter_init(&parent->p->klist_children, &i);
1219 1220 1221
	while ((child = next_device(&i)) && !error)
		error = fn(child, data);
	klist_iter_exit(&i);
L
Linus Torvalds 已提交
1222 1223 1224
	return error;
}

1225 1226 1227 1228 1229 1230 1231 1232 1233 1234 1235 1236 1237 1238 1239
/**
 * device_find_child - device iterator for locating a particular device.
 * @parent: parent struct device
 * @data: Data to pass to match function
 * @match: Callback function to check device
 *
 * This is similar to the device_for_each_child() function above, but it
 * returns a reference to a device that is 'found' for later use, as
 * determined by the @match callback.
 *
 * The callback should return 0 if the device doesn't match and non-zero
 * if it does.  If the callback returns non-zero and a reference to the
 * current device can be obtained, this function will return to the caller
 * and not iterate over any more devices.
 */
1240 1241
struct device *device_find_child(struct device *parent, void *data,
				 int (*match)(struct device *dev, void *data))
1242 1243 1244 1245 1246 1247 1248
{
	struct klist_iter i;
	struct device *child;

	if (!parent)
		return NULL;

1249
	klist_iter_init(&parent->p->klist_children, &i);
1250 1251 1252 1253 1254 1255 1256
	while ((child = next_device(&i)))
		if (match(child, data) && get_device(child))
			break;
	klist_iter_exit(&i);
	return child;
}

L
Linus Torvalds 已提交
1257 1258
int __init devices_init(void)
{
1259 1260 1261
	devices_kset = kset_create_and_add("devices", &device_uevent_ops, NULL);
	if (!devices_kset)
		return -ENOMEM;
1262 1263 1264 1265 1266 1267 1268 1269 1270 1271
	dev_kobj = kobject_create_and_add("dev", NULL);
	if (!dev_kobj)
		goto dev_kobj_err;
	sysfs_dev_block_kobj = kobject_create_and_add("block", dev_kobj);
	if (!sysfs_dev_block_kobj)
		goto block_kobj_err;
	sysfs_dev_char_kobj = kobject_create_and_add("char", dev_kobj);
	if (!sysfs_dev_char_kobj)
		goto char_kobj_err;

1272
	return 0;
1273 1274 1275 1276 1277 1278 1279 1280

 char_kobj_err:
	kobject_put(sysfs_dev_block_kobj);
 block_kobj_err:
	kobject_put(dev_kobj);
 dev_kobj_err:
	kset_unregister(devices_kset);
	return -ENOMEM;
L
Linus Torvalds 已提交
1281 1282 1283
}

EXPORT_SYMBOL_GPL(device_for_each_child);
1284
EXPORT_SYMBOL_GPL(device_find_child);
L
Linus Torvalds 已提交
1285 1286 1287 1288 1289 1290 1291 1292 1293 1294 1295 1296

EXPORT_SYMBOL_GPL(device_initialize);
EXPORT_SYMBOL_GPL(device_add);
EXPORT_SYMBOL_GPL(device_register);

EXPORT_SYMBOL_GPL(device_del);
EXPORT_SYMBOL_GPL(device_unregister);
EXPORT_SYMBOL_GPL(get_device);
EXPORT_SYMBOL_GPL(put_device);

EXPORT_SYMBOL_GPL(device_create_file);
EXPORT_SYMBOL_GPL(device_remove_file);
1297

1298 1299 1300 1301 1302 1303 1304 1305 1306 1307 1308 1309 1310 1311 1312 1313 1314 1315 1316 1317 1318 1319 1320 1321 1322 1323 1324 1325 1326 1327 1328 1329 1330 1331 1332 1333 1334 1335 1336 1337 1338 1339
struct root_device
{
	struct device dev;
	struct module *owner;
};

#define to_root_device(dev) container_of(dev, struct root_device, dev)

static void root_device_release(struct device *dev)
{
	kfree(to_root_device(dev));
}

/**
 * __root_device_register - allocate and register a root device
 * @name: root device name
 * @owner: owner module of the root device, usually THIS_MODULE
 *
 * This function allocates a root device and registers it
 * using device_register(). In order to free the returned
 * device, use root_device_unregister().
 *
 * Root devices are dummy devices which allow other devices
 * to be grouped under /sys/devices. Use this function to
 * allocate a root device and then use it as the parent of
 * any device which should appear under /sys/devices/{name}
 *
 * The /sys/devices/{name} directory will also contain a
 * 'module' symlink which points to the @owner directory
 * in sysfs.
 *
 * Note: You probably want to use root_device_register().
 */
struct device *__root_device_register(const char *name, struct module *owner)
{
	struct root_device *root;
	int err = -ENOMEM;

	root = kzalloc(sizeof(struct root_device), GFP_KERNEL);
	if (!root)
		return ERR_PTR(err);

1340
	err = dev_set_name(&root->dev, "%s", name);
1341 1342 1343 1344 1345 1346 1347 1348 1349 1350 1351 1352 1353 1354 1355 1356 1357 1358 1359 1360 1361 1362 1363 1364 1365 1366 1367 1368 1369 1370 1371 1372
	if (err) {
		kfree(root);
		return ERR_PTR(err);
	}

	root->dev.release = root_device_release;

	err = device_register(&root->dev);
	if (err) {
		put_device(&root->dev);
		return ERR_PTR(err);
	}

#ifdef CONFIG_MODULE	/* gotta find a "cleaner" way to do this */
	if (owner) {
		struct module_kobject *mk = &owner->mkobj;

		err = sysfs_create_link(&root->dev.kobj, &mk->kobj, "module");
		if (err) {
			device_unregister(&root->dev);
			return ERR_PTR(err);
		}
		root->owner = owner;
	}
#endif

	return &root->dev;
}
EXPORT_SYMBOL_GPL(__root_device_register);

/**
 * root_device_unregister - unregister and free a root device
1373
 * @dev: device going away
1374 1375 1376 1377 1378 1379 1380 1381 1382 1383 1384 1385 1386 1387 1388
 *
 * This function unregisters and cleans up a device that was created by
 * root_device_register().
 */
void root_device_unregister(struct device *dev)
{
	struct root_device *root = to_root_device(dev);

	if (root->owner)
		sysfs_remove_link(&root->dev.kobj, "module");

	device_unregister(dev);
}
EXPORT_SYMBOL_GPL(root_device_unregister);

1389 1390 1391

static void device_create_release(struct device *dev)
{
1392
	pr_debug("device: '%s': %s\n", dev_name(dev), __func__);
1393 1394 1395 1396
	kfree(dev);
}

/**
1397
 * device_create_vargs - creates a device and registers it with sysfs
1398 1399 1400
 * @class: pointer to the struct class that this device should be registered to
 * @parent: pointer to the parent struct device of this new device, if any
 * @devt: the dev_t for the char device to be added
1401
 * @drvdata: the data to be added to the device for callbacks
1402
 * @fmt: string for the device's name
1403
 * @args: va_list for the device's name
1404 1405 1406
 *
 * This function can be used by char device classes.  A struct device
 * will be created in sysfs, registered to the specified class.
1407 1408 1409
 *
 * A "dev" file will be created, showing the dev_t for the device, if
 * the dev_t is not 0,0.
1410 1411 1412 1413
 * If a pointer to a parent struct device is passed in, the newly created
 * struct device will be a child of that device in sysfs.
 * The pointer to the struct device will be returned from the call.
 * Any further sysfs files that might be required can be created using this
1414 1415 1416 1417 1418
 * pointer.
 *
 * Note: the struct class passed to this function must have previously
 * been created with a call to class_create().
 */
1419 1420 1421
struct device *device_create_vargs(struct class *class, struct device *parent,
				   dev_t devt, void *drvdata, const char *fmt,
				   va_list args)
1422 1423 1424 1425 1426 1427 1428 1429 1430 1431 1432 1433 1434 1435 1436 1437 1438
{
	struct device *dev = NULL;
	int retval = -ENODEV;

	if (class == NULL || IS_ERR(class))
		goto error;

	dev = kzalloc(sizeof(*dev), GFP_KERNEL);
	if (!dev) {
		retval = -ENOMEM;
		goto error;
	}

	dev->devt = devt;
	dev->class = class;
	dev->parent = parent;
	dev->release = device_create_release;
1439
	dev_set_drvdata(dev, drvdata);
1440

1441 1442 1443 1444
	retval = kobject_set_name_vargs(&dev->kobj, fmt, args);
	if (retval)
		goto error;

1445 1446 1447 1448 1449 1450 1451
	retval = device_register(dev);
	if (retval)
		goto error;

	return dev;

error:
1452
	put_device(dev);
1453 1454
	return ERR_PTR(retval);
}
1455 1456 1457
EXPORT_SYMBOL_GPL(device_create_vargs);

/**
1458
 * device_create - creates a device and registers it with sysfs
1459 1460 1461 1462 1463 1464 1465 1466 1467 1468 1469 1470 1471 1472 1473 1474 1475 1476 1477 1478
 * @class: pointer to the struct class that this device should be registered to
 * @parent: pointer to the parent struct device of this new device, if any
 * @devt: the dev_t for the char device to be added
 * @drvdata: the data to be added to the device for callbacks
 * @fmt: string for the device's name
 *
 * This function can be used by char device classes.  A struct device
 * will be created in sysfs, registered to the specified class.
 *
 * A "dev" file will be created, showing the dev_t for the device, if
 * the dev_t is not 0,0.
 * If a pointer to a parent struct device is passed in, the newly created
 * struct device will be a child of that device in sysfs.
 * The pointer to the struct device will be returned from the call.
 * Any further sysfs files that might be required can be created using this
 * pointer.
 *
 * Note: the struct class passed to this function must have previously
 * been created with a call to class_create().
 */
1479 1480
struct device *device_create(struct class *class, struct device *parent,
			     dev_t devt, void *drvdata, const char *fmt, ...)
1481 1482 1483 1484 1485 1486 1487 1488 1489
{
	va_list vargs;
	struct device *dev;

	va_start(vargs, fmt);
	dev = device_create_vargs(class, parent, devt, drvdata, fmt, vargs);
	va_end(vargs);
	return dev;
}
1490
EXPORT_SYMBOL_GPL(device_create);
1491

1492
static int __match_devt(struct device *dev, void *data)
1493
{
1494
	dev_t *devt = data;
1495

1496
	return dev->devt == *devt;
1497 1498 1499 1500 1501 1502 1503 1504 1505 1506 1507 1508 1509
}

/**
 * device_destroy - removes a device that was created with device_create()
 * @class: pointer to the struct class that this device was registered with
 * @devt: the dev_t of the device that was previously registered
 *
 * This call unregisters and cleans up a device that was created with a
 * call to device_create().
 */
void device_destroy(struct class *class, dev_t devt)
{
	struct device *dev;
1510

1511
	dev = class_find_device(class, NULL, &devt, __match_devt);
1512 1513
	if (dev) {
		put_device(dev);
1514
		device_unregister(dev);
1515
	}
1516 1517
}
EXPORT_SYMBOL_GPL(device_destroy);
1518 1519 1520 1521 1522

/**
 * device_rename - renames a device
 * @dev: the pointer to the struct device to be renamed
 * @new_name: the new name of the device
1523 1524 1525 1526 1527
 *
 * It is the responsibility of the caller to provide mutual
 * exclusion between two different calls of device_rename
 * on the same device to ensure that new_name is valid and
 * won't conflict with other devices.
1528 1529 1530 1531 1532
 */
int device_rename(struct device *dev, char *new_name)
{
	char *old_class_name = NULL;
	char *new_class_name = NULL;
1533
	char *old_device_name = NULL;
1534 1535 1536 1537 1538 1539
	int error;

	dev = get_device(dev);
	if (!dev)
		return -EINVAL;

1540
	pr_debug("device: '%s': %s: renaming to '%s'\n", dev_name(dev),
1541
		 __func__, new_name);
1542

1543
#ifdef CONFIG_SYSFS_DEPRECATED
1544 1545
	if ((dev->class) && (dev->parent))
		old_class_name = make_class_name(dev->class->name, &dev->kobj);
1546
#endif
1547

1548
	old_device_name = kstrdup(dev_name(dev), GFP_KERNEL);
1549 1550 1551
	if (!old_device_name) {
		error = -ENOMEM;
		goto out;
1552 1553 1554
	}

	error = kobject_rename(&dev->kobj, new_name);
1555
	if (error)
1556
		goto out;
1557

1558
#ifdef CONFIG_SYSFS_DEPRECATED
1559 1560 1561
	if (old_class_name) {
		new_class_name = make_class_name(dev->class->name, &dev->kobj);
		if (new_class_name) {
1562 1563 1564
			error = sysfs_create_link_nowarn(&dev->parent->kobj,
							 &dev->kobj,
							 new_class_name);
1565 1566
			if (error)
				goto out;
1567 1568 1569
			sysfs_remove_link(&dev->parent->kobj, old_class_name);
		}
	}
1570
#else
1571
	if (dev->class) {
1572
		error = sysfs_create_link_nowarn(&dev->class->p->class_subsys.kobj,
1573
						 &dev->kobj, dev_name(dev));
1574 1575
		if (error)
			goto out;
1576
		sysfs_remove_link(&dev->class->p->class_subsys.kobj,
1577
				  old_device_name);
1578
	}
1579 1580
#endif

1581
out:
1582 1583 1584
	put_device(dev);

	kfree(new_class_name);
1585
	kfree(old_class_name);
1586
	kfree(old_device_name);
1587 1588 1589

	return error;
}
1590
EXPORT_SYMBOL_GPL(device_rename);
1591 1592 1593 1594 1595

static int device_move_class_links(struct device *dev,
				   struct device *old_parent,
				   struct device *new_parent)
{
1596
	int error = 0;
1597 1598 1599 1600 1601
#ifdef CONFIG_SYSFS_DEPRECATED
	char *class_name;

	class_name = make_class_name(dev->class->name, &dev->kobj);
	if (!class_name) {
1602
		error = -ENOMEM;
1603 1604 1605 1606 1607 1608
		goto out;
	}
	if (old_parent) {
		sysfs_remove_link(&dev->kobj, "device");
		sysfs_remove_link(&old_parent->kobj, class_name);
	}
1609 1610 1611 1612 1613 1614 1615 1616 1617
	if (new_parent) {
		error = sysfs_create_link(&dev->kobj, &new_parent->kobj,
					  "device");
		if (error)
			goto out;
		error = sysfs_create_link(&new_parent->kobj, &dev->kobj,
					  class_name);
		if (error)
			sysfs_remove_link(&dev->kobj, "device");
1618
	} else
1619
		error = 0;
1620 1621 1622 1623
out:
	kfree(class_name);
	return error;
#else
1624 1625 1626 1627 1628 1629
	if (old_parent)
		sysfs_remove_link(&dev->kobj, "device");
	if (new_parent)
		error = sysfs_create_link(&dev->kobj, &new_parent->kobj,
					  "device");
	return error;
1630 1631 1632 1633 1634 1635
#endif
}

/**
 * device_move - moves a device to a new parent
 * @dev: the pointer to the struct device to be moved
1636
 * @new_parent: the new parent of the device (can by NULL)
1637
 * @dpm_order: how to reorder the dpm_list
1638
 */
1639 1640
int device_move(struct device *dev, struct device *new_parent,
		enum dpm_order dpm_order)
1641 1642 1643
{
	int error;
	struct device *old_parent;
1644
	struct kobject *new_parent_kobj;
1645 1646 1647 1648 1649

	dev = get_device(dev);
	if (!dev)
		return -EINVAL;

1650
	device_pm_lock();
1651
	new_parent = get_device(new_parent);
1652
	new_parent_kobj = get_device_parent(dev, new_parent);
1653

1654 1655
	pr_debug("device: '%s': %s: moving to '%s'\n", dev_name(dev),
		 __func__, new_parent ? dev_name(new_parent) : "<NULL>");
1656
	error = kobject_move(&dev->kobj, new_parent_kobj);
1657
	if (error) {
1658
		cleanup_glue_dir(dev, new_parent_kobj);
1659 1660 1661 1662 1663 1664
		put_device(new_parent);
		goto out;
	}
	old_parent = dev->parent;
	dev->parent = new_parent;
	if (old_parent)
1665
		klist_remove(&dev->p->knode_parent);
1666
	if (new_parent) {
1667 1668
		klist_add_tail(&dev->p->knode_parent,
			       &new_parent->p->klist_children);
1669 1670 1671
		set_dev_node(dev, dev_to_node(new_parent));
	}

1672 1673 1674 1675 1676 1677 1678
	if (!dev->class)
		goto out_put;
	error = device_move_class_links(dev, old_parent, new_parent);
	if (error) {
		/* We ignore errors on cleanup since we're hosed anyway... */
		device_move_class_links(dev, new_parent, old_parent);
		if (!kobject_move(&dev->kobj, &old_parent->kobj)) {
1679
			if (new_parent)
1680
				klist_remove(&dev->p->knode_parent);
1681 1682
			dev->parent = old_parent;
			if (old_parent) {
1683 1684
				klist_add_tail(&dev->p->knode_parent,
					       &old_parent->p->klist_children);
1685 1686
				set_dev_node(dev, dev_to_node(old_parent));
			}
1687
		}
1688
		cleanup_glue_dir(dev, new_parent_kobj);
1689 1690 1691
		put_device(new_parent);
		goto out;
	}
1692 1693 1694 1695 1696 1697 1698 1699 1700 1701 1702 1703 1704
	switch (dpm_order) {
	case DPM_ORDER_NONE:
		break;
	case DPM_ORDER_DEV_AFTER_PARENT:
		device_pm_move_after(dev, new_parent);
		break;
	case DPM_ORDER_PARENT_BEFORE_DEV:
		device_pm_move_before(new_parent, dev);
		break;
	case DPM_ORDER_DEV_LAST:
		device_pm_move_last(dev);
		break;
	}
1705 1706 1707
out_put:
	put_device(old_parent);
out:
1708
	device_pm_unlock();
1709 1710 1711 1712
	put_device(dev);
	return error;
}
EXPORT_SYMBOL_GPL(device_move);
1713 1714 1715 1716 1717 1718

/**
 * device_shutdown - call ->shutdown() on each device to shutdown.
 */
void device_shutdown(void)
{
1719
	struct device *dev, *devn;
1720 1721 1722 1723 1724 1725 1726 1727 1728 1729 1730

	list_for_each_entry_safe_reverse(dev, devn, &devices_kset->list,
				kobj.entry) {
		if (dev->bus && dev->bus->shutdown) {
			dev_dbg(dev, "shutdown\n");
			dev->bus->shutdown(dev);
		} else if (dev->driver && dev->driver->shutdown) {
			dev_dbg(dev, "shutdown\n");
			dev->driver->shutdown(dev);
		}
	}
1731 1732 1733
	kobject_put(sysfs_dev_char_kobj);
	kobject_put(sysfs_dev_block_kobj);
	kobject_put(dev_kobj);
1734
	async_synchronize_full();
1735
}