forked from mirrors/linux
		
	 3b470ac43f
			
		
	
	
		3b470ac43f
		
	
	
	
	
		
			
			* git://git.kernel.org/pub/scm/linux/kernel/git/gregkh/driver-2.6: PPC: Fix powerpc vio_find_name to not use devices_subsys Driver core: add bus_find_device_by_name function Module: check to see if we have a built in module with the same name x86: fix runtime error in arch/x86/kernel/cpu/mcheck/mce_amd_64.c Driver core: Fix up build when CONFIG_BLOCK=N
		
			
				
	
	
		
			1035 lines
		
	
	
	
		
			25 KiB
		
	
	
	
		
			C
		
	
	
	
	
	
			
		
		
	
	
			1035 lines
		
	
	
	
		
			25 KiB
		
	
	
	
		
			C
		
	
	
	
	
	
| /*
 | |
|  * class.c - basic device class management
 | |
|  *
 | |
|  * Copyright (c) 2002-3 Patrick Mochel
 | |
|  * Copyright (c) 2002-3 Open Source Development Labs
 | |
|  * Copyright (c) 2003-2004 Greg Kroah-Hartman
 | |
|  * Copyright (c) 2003-2004 IBM Corp.
 | |
|  *
 | |
|  * This file is released under the GPLv2
 | |
|  *
 | |
|  */
 | |
| 
 | |
| #include <linux/device.h>
 | |
| #include <linux/module.h>
 | |
| #include <linux/init.h>
 | |
| #include <linux/string.h>
 | |
| #include <linux/kdev_t.h>
 | |
| #include <linux/err.h>
 | |
| #include <linux/slab.h>
 | |
| #include <linux/genhd.h>
 | |
| #include "base.h"
 | |
| 
 | |
| #define to_class_attr(_attr) container_of(_attr, struct class_attribute, attr)
 | |
| #define to_class(obj) container_of(obj, struct class, subsys.kobj)
 | |
| 
 | |
| static ssize_t class_attr_show(struct kobject *kobj, struct attribute *attr,
 | |
| 			       char *buf)
 | |
| {
 | |
| 	struct class_attribute *class_attr = to_class_attr(attr);
 | |
| 	struct class *dc = to_class(kobj);
 | |
| 	ssize_t ret = -EIO;
 | |
| 
 | |
| 	if (class_attr->show)
 | |
| 		ret = class_attr->show(dc, buf);
 | |
| 	return ret;
 | |
| }
 | |
| 
 | |
| static ssize_t class_attr_store(struct kobject *kobj, struct attribute *attr,
 | |
| 				const char *buf, size_t count)
 | |
| {
 | |
| 	struct class_attribute *class_attr = to_class_attr(attr);
 | |
| 	struct class *dc = to_class(kobj);
 | |
| 	ssize_t ret = -EIO;
 | |
| 
 | |
| 	if (class_attr->store)
 | |
| 		ret = class_attr->store(dc, buf, count);
 | |
| 	return ret;
 | |
| }
 | |
| 
 | |
| static void class_release(struct kobject *kobj)
 | |
| {
 | |
| 	struct class *class = to_class(kobj);
 | |
| 
 | |
| 	pr_debug("class '%s': release.\n", class->name);
 | |
| 
 | |
| 	if (class->class_release)
 | |
| 		class->class_release(class);
 | |
| 	else
 | |
| 		pr_debug("class '%s' does not have a release() function, "
 | |
| 			 "be careful\n", class->name);
 | |
| }
 | |
| 
 | |
| static struct sysfs_ops class_sysfs_ops = {
 | |
| 	.show	= class_attr_show,
 | |
| 	.store	= class_attr_store,
 | |
| };
 | |
| 
 | |
| static struct kobj_type class_ktype = {
 | |
| 	.sysfs_ops	= &class_sysfs_ops,
 | |
| 	.release	= class_release,
 | |
| };
 | |
| 
 | |
| /* Hotplug events for classes go to the class_obj subsys */
 | |
| static struct kset *class_kset;
 | |
| 
 | |
| 
 | |
| int class_create_file(struct class *cls, const struct class_attribute *attr)
 | |
| {
 | |
| 	int error;
 | |
| 	if (cls)
 | |
| 		error = sysfs_create_file(&cls->subsys.kobj, &attr->attr);
 | |
| 	else
 | |
| 		error = -EINVAL;
 | |
| 	return error;
 | |
| }
 | |
| 
 | |
| void class_remove_file(struct class *cls, const struct class_attribute *attr)
 | |
| {
 | |
| 	if (cls)
 | |
| 		sysfs_remove_file(&cls->subsys.kobj, &attr->attr);
 | |
| }
 | |
| 
 | |
| static struct class *class_get(struct class *cls)
 | |
| {
 | |
| 	if (cls)
 | |
| 		return container_of(kset_get(&cls->subsys),
 | |
| 				    struct class, subsys);
 | |
| 	return NULL;
 | |
| }
 | |
| 
 | |
| static void class_put(struct class *cls)
 | |
| {
 | |
| 	if (cls)
 | |
| 		kset_put(&cls->subsys);
 | |
| }
 | |
| 
 | |
| static int add_class_attrs(struct class *cls)
 | |
| {
 | |
| 	int i;
 | |
| 	int error = 0;
 | |
| 
 | |
| 	if (cls->class_attrs) {
 | |
| 		for (i = 0; attr_name(cls->class_attrs[i]); i++) {
 | |
| 			error = class_create_file(cls, &cls->class_attrs[i]);
 | |
| 			if (error)
 | |
| 				goto error;
 | |
| 		}
 | |
| 	}
 | |
| done:
 | |
| 	return error;
 | |
| error:
 | |
| 	while (--i >= 0)
 | |
| 		class_remove_file(cls, &cls->class_attrs[i]);
 | |
| 	goto done;
 | |
| }
 | |
| 
 | |
| static void remove_class_attrs(struct class *cls)
 | |
| {
 | |
| 	int i;
 | |
| 
 | |
| 	if (cls->class_attrs) {
 | |
| 		for (i = 0; attr_name(cls->class_attrs[i]); i++)
 | |
| 			class_remove_file(cls, &cls->class_attrs[i]);
 | |
| 	}
 | |
| }
 | |
| 
 | |
| int class_register(struct class *cls)
 | |
| {
 | |
| 	int error;
 | |
| 
 | |
| 	pr_debug("device class '%s': registering\n", cls->name);
 | |
| 
 | |
| 	INIT_LIST_HEAD(&cls->children);
 | |
| 	INIT_LIST_HEAD(&cls->devices);
 | |
| 	INIT_LIST_HEAD(&cls->interfaces);
 | |
| 	kset_init(&cls->class_dirs);
 | |
| 	init_MUTEX(&cls->sem);
 | |
| 	error = kobject_set_name(&cls->subsys.kobj, "%s", cls->name);
 | |
| 	if (error)
 | |
| 		return error;
 | |
| 
 | |
| #if defined(CONFIG_SYSFS_DEPRECATED) && defined(CONFIG_BLOCK)
 | |
| 	/* let the block class directory show up in the root of sysfs */
 | |
| 	if (cls != &block_class)
 | |
| 		cls->subsys.kobj.kset = class_kset;
 | |
| #else
 | |
| 	cls->subsys.kobj.kset = class_kset;
 | |
| #endif
 | |
| 	cls->subsys.kobj.ktype = &class_ktype;
 | |
| 
 | |
| 	error = kset_register(&cls->subsys);
 | |
| 	if (!error) {
 | |
| 		error = add_class_attrs(class_get(cls));
 | |
| 		class_put(cls);
 | |
| 	}
 | |
| 	return error;
 | |
| }
 | |
| 
 | |
| void class_unregister(struct class *cls)
 | |
| {
 | |
| 	pr_debug("device class '%s': unregistering\n", cls->name);
 | |
| 	remove_class_attrs(cls);
 | |
| 	kset_unregister(&cls->subsys);
 | |
| }
 | |
| 
 | |
| static void class_create_release(struct class *cls)
 | |
| {
 | |
| 	pr_debug("%s called for %s\n", __FUNCTION__, cls->name);
 | |
| 	kfree(cls);
 | |
| }
 | |
| 
 | |
| static void class_device_create_release(struct class_device *class_dev)
 | |
| {
 | |
| 	pr_debug("%s called for %s\n", __FUNCTION__, class_dev->class_id);
 | |
| 	kfree(class_dev);
 | |
| }
 | |
| 
 | |
| /* needed to allow these devices to have parent class devices */
 | |
| static int class_device_create_uevent(struct class_device *class_dev,
 | |
| 				      struct kobj_uevent_env *env)
 | |
| {
 | |
| 	pr_debug("%s called for %s\n", __FUNCTION__, class_dev->class_id);
 | |
| 	return 0;
 | |
| }
 | |
| 
 | |
| /**
 | |
|  * class_create - create a struct class structure
 | |
|  * @owner: pointer to the module that is to "own" this struct class
 | |
|  * @name: pointer to a string for the name of this class.
 | |
|  *
 | |
|  * This is used to create a struct class pointer that can then be used
 | |
|  * in calls to class_device_create().
 | |
|  *
 | |
|  * Note, the pointer created here is to be destroyed when finished by
 | |
|  * making a call to class_destroy().
 | |
|  */
 | |
| struct class *class_create(struct module *owner, const char *name)
 | |
| {
 | |
| 	struct class *cls;
 | |
| 	int retval;
 | |
| 
 | |
| 	cls = kzalloc(sizeof(*cls), GFP_KERNEL);
 | |
| 	if (!cls) {
 | |
| 		retval = -ENOMEM;
 | |
| 		goto error;
 | |
| 	}
 | |
| 
 | |
| 	cls->name = name;
 | |
| 	cls->owner = owner;
 | |
| 	cls->class_release = class_create_release;
 | |
| 	cls->release = class_device_create_release;
 | |
| 
 | |
| 	retval = class_register(cls);
 | |
| 	if (retval)
 | |
| 		goto error;
 | |
| 
 | |
| 	return cls;
 | |
| 
 | |
| error:
 | |
| 	kfree(cls);
 | |
| 	return ERR_PTR(retval);
 | |
| }
 | |
| 
 | |
| /**
 | |
|  * class_destroy - destroys a struct class structure
 | |
|  * @cls: pointer to the struct class that is to be destroyed
 | |
|  *
 | |
|  * Note, the pointer to be destroyed must have been created with a call
 | |
|  * to class_create().
 | |
|  */
 | |
| void class_destroy(struct class *cls)
 | |
| {
 | |
| 	if ((cls == NULL) || (IS_ERR(cls)))
 | |
| 		return;
 | |
| 
 | |
| 	class_unregister(cls);
 | |
| }
 | |
| 
 | |
| /* Class Device Stuff */
 | |
| 
 | |
| int class_device_create_file(struct class_device *class_dev,
 | |
| 			     const struct class_device_attribute *attr)
 | |
| {
 | |
| 	int error = -EINVAL;
 | |
| 	if (class_dev)
 | |
| 		error = sysfs_create_file(&class_dev->kobj, &attr->attr);
 | |
| 	return error;
 | |
| }
 | |
| 
 | |
| void class_device_remove_file(struct class_device *class_dev,
 | |
| 			      const struct class_device_attribute *attr)
 | |
| {
 | |
| 	if (class_dev)
 | |
| 		sysfs_remove_file(&class_dev->kobj, &attr->attr);
 | |
| }
 | |
| 
 | |
| int class_device_create_bin_file(struct class_device *class_dev,
 | |
| 				 struct bin_attribute *attr)
 | |
| {
 | |
| 	int error = -EINVAL;
 | |
| 	if (class_dev)
 | |
| 		error = sysfs_create_bin_file(&class_dev->kobj, attr);
 | |
| 	return error;
 | |
| }
 | |
| 
 | |
| void class_device_remove_bin_file(struct class_device *class_dev,
 | |
| 				  struct bin_attribute *attr)
 | |
| {
 | |
| 	if (class_dev)
 | |
| 		sysfs_remove_bin_file(&class_dev->kobj, attr);
 | |
| }
 | |
| 
 | |
| static ssize_t class_device_attr_show(struct kobject *kobj,
 | |
| 				      struct attribute *attr, char *buf)
 | |
| {
 | |
| 	struct class_device_attribute *class_dev_attr = to_class_dev_attr(attr);
 | |
| 	struct class_device *cd = to_class_dev(kobj);
 | |
| 	ssize_t ret = 0;
 | |
| 
 | |
| 	if (class_dev_attr->show)
 | |
| 		ret = class_dev_attr->show(cd, buf);
 | |
| 	return ret;
 | |
| }
 | |
| 
 | |
| static ssize_t class_device_attr_store(struct kobject *kobj,
 | |
| 				       struct attribute *attr,
 | |
| 				       const char *buf, size_t count)
 | |
| {
 | |
| 	struct class_device_attribute *class_dev_attr = to_class_dev_attr(attr);
 | |
| 	struct class_device *cd = to_class_dev(kobj);
 | |
| 	ssize_t ret = 0;
 | |
| 
 | |
| 	if (class_dev_attr->store)
 | |
| 		ret = class_dev_attr->store(cd, buf, count);
 | |
| 	return ret;
 | |
| }
 | |
| 
 | |
| static struct sysfs_ops class_dev_sysfs_ops = {
 | |
| 	.show	= class_device_attr_show,
 | |
| 	.store	= class_device_attr_store,
 | |
| };
 | |
| 
 | |
| static void class_dev_release(struct kobject *kobj)
 | |
| {
 | |
| 	struct class_device *cd = to_class_dev(kobj);
 | |
| 	struct class *cls = cd->class;
 | |
| 
 | |
| 	pr_debug("device class '%s': release.\n", cd->class_id);
 | |
| 
 | |
| 	if (cd->release)
 | |
| 		cd->release(cd);
 | |
| 	else if (cls->release)
 | |
| 		cls->release(cd);
 | |
| 	else {
 | |
| 		printk(KERN_ERR "Class Device '%s' does not have a release() "
 | |
| 			"function, it is broken and must be fixed.\n",
 | |
| 			cd->class_id);
 | |
| 		WARN_ON(1);
 | |
| 	}
 | |
| }
 | |
| 
 | |
| static struct kobj_type class_device_ktype = {
 | |
| 	.sysfs_ops	= &class_dev_sysfs_ops,
 | |
| 	.release	= class_dev_release,
 | |
| };
 | |
| 
 | |
| static int class_uevent_filter(struct kset *kset, struct kobject *kobj)
 | |
| {
 | |
| 	struct kobj_type *ktype = get_ktype(kobj);
 | |
| 
 | |
| 	if (ktype == &class_device_ktype) {
 | |
| 		struct class_device *class_dev = to_class_dev(kobj);
 | |
| 		if (class_dev->class)
 | |
| 			return 1;
 | |
| 	}
 | |
| 	return 0;
 | |
| }
 | |
| 
 | |
| static const char *class_uevent_name(struct kset *kset, struct kobject *kobj)
 | |
| {
 | |
| 	struct class_device *class_dev = to_class_dev(kobj);
 | |
| 
 | |
| 	return class_dev->class->name;
 | |
| }
 | |
| 
 | |
| #ifdef CONFIG_SYSFS_DEPRECATED
 | |
| char *make_class_name(const char *name, struct kobject *kobj)
 | |
| {
 | |
| 	char *class_name;
 | |
| 	int size;
 | |
| 
 | |
| 	size = strlen(name) + strlen(kobject_name(kobj)) + 2;
 | |
| 
 | |
| 	class_name = kmalloc(size, GFP_KERNEL);
 | |
| 	if (!class_name)
 | |
| 		return NULL;
 | |
| 
 | |
| 	strcpy(class_name, name);
 | |
| 	strcat(class_name, ":");
 | |
| 	strcat(class_name, kobject_name(kobj));
 | |
| 	return class_name;
 | |
| }
 | |
| 
 | |
| static int make_deprecated_class_device_links(struct class_device *class_dev)
 | |
| {
 | |
| 	char *class_name;
 | |
| 	int error;
 | |
| 
 | |
| 	if (!class_dev->dev)
 | |
| 		return 0;
 | |
| 
 | |
| 	class_name = make_class_name(class_dev->class->name, &class_dev->kobj);
 | |
| 	if (class_name)
 | |
| 		error = sysfs_create_link(&class_dev->dev->kobj,
 | |
| 					  &class_dev->kobj, class_name);
 | |
| 	else
 | |
| 		error = -ENOMEM;
 | |
| 	kfree(class_name);
 | |
| 	return error;
 | |
| }
 | |
| 
 | |
| static void remove_deprecated_class_device_links(struct class_device *class_dev)
 | |
| {
 | |
| 	char *class_name;
 | |
| 
 | |
| 	if (!class_dev->dev)
 | |
| 		return;
 | |
| 
 | |
| 	class_name = make_class_name(class_dev->class->name, &class_dev->kobj);
 | |
| 	if (class_name)
 | |
| 		sysfs_remove_link(&class_dev->dev->kobj, class_name);
 | |
| 	kfree(class_name);
 | |
| }
 | |
| #else
 | |
| static inline int make_deprecated_class_device_links(struct class_device *cd)
 | |
| { return 0; }
 | |
| static void remove_deprecated_class_device_links(struct class_device *cd)
 | |
| { }
 | |
| #endif
 | |
| 
 | |
| static int class_uevent(struct kset *kset, struct kobject *kobj,
 | |
| 			struct kobj_uevent_env *env)
 | |
| {
 | |
| 	struct class_device *class_dev = to_class_dev(kobj);
 | |
| 	struct device *dev = class_dev->dev;
 | |
| 	int retval = 0;
 | |
| 
 | |
| 	pr_debug("%s - name = %s\n", __FUNCTION__, class_dev->class_id);
 | |
| 
 | |
| 	if (MAJOR(class_dev->devt)) {
 | |
| 		add_uevent_var(env, "MAJOR=%u", MAJOR(class_dev->devt));
 | |
| 
 | |
| 		add_uevent_var(env, "MINOR=%u", MINOR(class_dev->devt));
 | |
| 	}
 | |
| 
 | |
| 	if (dev) {
 | |
| 		const char *path = kobject_get_path(&dev->kobj, GFP_KERNEL);
 | |
| 		if (path) {
 | |
| 			add_uevent_var(env, "PHYSDEVPATH=%s", path);
 | |
| 			kfree(path);
 | |
| 		}
 | |
| 
 | |
| 		if (dev->bus)
 | |
| 			add_uevent_var(env, "PHYSDEVBUS=%s", dev->bus->name);
 | |
| 
 | |
| 		if (dev->driver)
 | |
| 			add_uevent_var(env, "PHYSDEVDRIVER=%s",
 | |
| 				       dev->driver->name);
 | |
| 	}
 | |
| 
 | |
| 	if (class_dev->uevent) {
 | |
| 		/* have the class device specific function add its stuff */
 | |
| 		retval = class_dev->uevent(class_dev, env);
 | |
| 		if (retval)
 | |
| 			pr_debug("class_dev->uevent() returned %d\n", retval);
 | |
| 	} else if (class_dev->class->uevent) {
 | |
| 		/* have the class specific function add its stuff */
 | |
| 		retval = class_dev->class->uevent(class_dev, env);
 | |
| 		if (retval)
 | |
| 			pr_debug("class->uevent() returned %d\n", retval);
 | |
| 	}
 | |
| 
 | |
| 	return retval;
 | |
| }
 | |
| 
 | |
| static struct kset_uevent_ops class_uevent_ops = {
 | |
| 	.filter =	class_uevent_filter,
 | |
| 	.name =		class_uevent_name,
 | |
| 	.uevent =	class_uevent,
 | |
| };
 | |
| 
 | |
| /*
 | |
|  * DO NOT copy how this is created, kset_create_and_add() should be
 | |
|  * called, but this is a hold-over from the old-way and will be deleted
 | |
|  * entirely soon.
 | |
|  */
 | |
| static struct kset class_obj_subsys = {
 | |
| 	.uevent_ops = &class_uevent_ops,
 | |
| };
 | |
| 
 | |
| static int class_device_add_attrs(struct class_device *cd)
 | |
| {
 | |
| 	int i;
 | |
| 	int error = 0;
 | |
| 	struct class *cls = cd->class;
 | |
| 
 | |
| 	if (cls->class_dev_attrs) {
 | |
| 		for (i = 0; attr_name(cls->class_dev_attrs[i]); i++) {
 | |
| 			error = class_device_create_file(cd,
 | |
| 						&cls->class_dev_attrs[i]);
 | |
| 			if (error)
 | |
| 				goto err;
 | |
| 		}
 | |
| 	}
 | |
| done:
 | |
| 	return error;
 | |
| err:
 | |
| 	while (--i >= 0)
 | |
| 		class_device_remove_file(cd, &cls->class_dev_attrs[i]);
 | |
| 	goto done;
 | |
| }
 | |
| 
 | |
| static void class_device_remove_attrs(struct class_device *cd)
 | |
| {
 | |
| 	int i;
 | |
| 	struct class *cls = cd->class;
 | |
| 
 | |
| 	if (cls->class_dev_attrs) {
 | |
| 		for (i = 0; attr_name(cls->class_dev_attrs[i]); i++)
 | |
| 			class_device_remove_file(cd, &cls->class_dev_attrs[i]);
 | |
| 	}
 | |
| }
 | |
| 
 | |
| static int class_device_add_groups(struct class_device *cd)
 | |
| {
 | |
| 	int i;
 | |
| 	int error = 0;
 | |
| 
 | |
| 	if (cd->groups) {
 | |
| 		for (i = 0; cd->groups[i]; i++) {
 | |
| 			error = sysfs_create_group(&cd->kobj, cd->groups[i]);
 | |
| 			if (error) {
 | |
| 				while (--i >= 0)
 | |
| 					sysfs_remove_group(&cd->kobj,
 | |
| 							   cd->groups[i]);
 | |
| 				goto out;
 | |
| 			}
 | |
| 		}
 | |
| 	}
 | |
| out:
 | |
| 	return error;
 | |
| }
 | |
| 
 | |
| static void class_device_remove_groups(struct class_device *cd)
 | |
| {
 | |
| 	int i;
 | |
| 	if (cd->groups)
 | |
| 		for (i = 0; cd->groups[i]; i++)
 | |
| 			sysfs_remove_group(&cd->kobj, cd->groups[i]);
 | |
| }
 | |
| 
 | |
| static ssize_t show_dev(struct class_device *class_dev, char *buf)
 | |
| {
 | |
| 	return print_dev_t(buf, class_dev->devt);
 | |
| }
 | |
| 
 | |
| static struct class_device_attribute class_devt_attr =
 | |
| 	__ATTR(dev, S_IRUGO, show_dev, NULL);
 | |
| 
 | |
| static ssize_t store_uevent(struct class_device *class_dev,
 | |
| 			    const char *buf, size_t count)
 | |
| {
 | |
| 	kobject_uevent(&class_dev->kobj, KOBJ_ADD);
 | |
| 	return count;
 | |
| }
 | |
| 
 | |
| static struct class_device_attribute class_uevent_attr =
 | |
| 	__ATTR(uevent, S_IWUSR, NULL, store_uevent);
 | |
| 
 | |
| void class_device_initialize(struct class_device *class_dev)
 | |
| {
 | |
| 	class_dev->kobj.kset = &class_obj_subsys;
 | |
| 	kobject_init(&class_dev->kobj, &class_device_ktype);
 | |
| 	INIT_LIST_HEAD(&class_dev->node);
 | |
| }
 | |
| 
 | |
| int class_device_add(struct class_device *class_dev)
 | |
| {
 | |
| 	struct class *parent_class = NULL;
 | |
| 	struct class_device *parent_class_dev = NULL;
 | |
| 	struct class_interface *class_intf;
 | |
| 	int error = -EINVAL;
 | |
| 
 | |
| 	class_dev = class_device_get(class_dev);
 | |
| 	if (!class_dev)
 | |
| 		return -EINVAL;
 | |
| 
 | |
| 	if (!strlen(class_dev->class_id))
 | |
| 		goto out1;
 | |
| 
 | |
| 	parent_class = class_get(class_dev->class);
 | |
| 	if (!parent_class)
 | |
| 		goto out1;
 | |
| 
 | |
| 	parent_class_dev = class_device_get(class_dev->parent);
 | |
| 
 | |
| 	pr_debug("CLASS: registering class device: ID = '%s'\n",
 | |
| 		 class_dev->class_id);
 | |
| 
 | |
| 	/* first, register with generic layer. */
 | |
| 	if (parent_class_dev)
 | |
| 		class_dev->kobj.parent = &parent_class_dev->kobj;
 | |
| 	else
 | |
| 		class_dev->kobj.parent = &parent_class->subsys.kobj;
 | |
| 
 | |
| 	error = kobject_add(&class_dev->kobj, class_dev->kobj.parent,
 | |
| 			    "%s", class_dev->class_id);
 | |
| 	if (error)
 | |
| 		goto out2;
 | |
| 
 | |
| 	/* add the needed attributes to this device */
 | |
| 	error = sysfs_create_link(&class_dev->kobj,
 | |
| 				  &parent_class->subsys.kobj, "subsystem");
 | |
| 	if (error)
 | |
| 		goto out3;
 | |
| 
 | |
| 	error = class_device_create_file(class_dev, &class_uevent_attr);
 | |
| 	if (error)
 | |
| 		goto out3;
 | |
| 
 | |
| 	if (MAJOR(class_dev->devt)) {
 | |
| 		error = class_device_create_file(class_dev, &class_devt_attr);
 | |
| 		if (error)
 | |
| 			goto out4;
 | |
| 	}
 | |
| 
 | |
| 	error = class_device_add_attrs(class_dev);
 | |
| 	if (error)
 | |
| 		goto out5;
 | |
| 
 | |
| 	if (class_dev->dev) {
 | |
| 		error = sysfs_create_link(&class_dev->kobj,
 | |
| 					  &class_dev->dev->kobj, "device");
 | |
| 		if (error)
 | |
| 			goto out6;
 | |
| 	}
 | |
| 
 | |
| 	error = class_device_add_groups(class_dev);
 | |
| 	if (error)
 | |
| 		goto out7;
 | |
| 
 | |
| 	error = make_deprecated_class_device_links(class_dev);
 | |
| 	if (error)
 | |
| 		goto out8;
 | |
| 
 | |
| 	kobject_uevent(&class_dev->kobj, KOBJ_ADD);
 | |
| 
 | |
| 	/* notify any interfaces this device is now here */
 | |
| 	down(&parent_class->sem);
 | |
| 	list_add_tail(&class_dev->node, &parent_class->children);
 | |
| 	list_for_each_entry(class_intf, &parent_class->interfaces, node) {
 | |
| 		if (class_intf->add)
 | |
| 			class_intf->add(class_dev, class_intf);
 | |
| 	}
 | |
| 	up(&parent_class->sem);
 | |
| 
 | |
| 	goto out1;
 | |
| 
 | |
|  out8:
 | |
| 	class_device_remove_groups(class_dev);
 | |
|  out7:
 | |
| 	if (class_dev->dev)
 | |
| 		sysfs_remove_link(&class_dev->kobj, "device");
 | |
|  out6:
 | |
| 	class_device_remove_attrs(class_dev);
 | |
|  out5:
 | |
| 	if (MAJOR(class_dev->devt))
 | |
| 		class_device_remove_file(class_dev, &class_devt_attr);
 | |
|  out4:
 | |
| 	class_device_remove_file(class_dev, &class_uevent_attr);
 | |
|  out3:
 | |
| 	kobject_del(&class_dev->kobj);
 | |
|  out2:
 | |
| 	if (parent_class_dev)
 | |
| 		class_device_put(parent_class_dev);
 | |
| 	class_put(parent_class);
 | |
|  out1:
 | |
| 	class_device_put(class_dev);
 | |
| 	return error;
 | |
| }
 | |
| 
 | |
| int class_device_register(struct class_device *class_dev)
 | |
| {
 | |
| 	class_device_initialize(class_dev);
 | |
| 	return class_device_add(class_dev);
 | |
| }
 | |
| 
 | |
| /**
 | |
|  * class_device_create - creates a class device and registers it with sysfs
 | |
|  * @cls: pointer to the struct class that this device should be registered to.
 | |
|  * @parent: pointer to the parent struct class_device of this new device, if
 | |
|  * any.
 | |
|  * @devt: the dev_t for the char device to be added.
 | |
|  * @device: a pointer to a struct device that is assiociated with this class
 | |
|  * device.
 | |
|  * @fmt: string for the class device's name
 | |
|  *
 | |
|  * This function can be used by char device classes.  A struct
 | |
|  * class_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 class_device is passed in, the newly
 | |
|  * created struct class_device will be a child of that device in sysfs.
 | |
|  * The pointer to the struct class_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().
 | |
|  */
 | |
| struct class_device *class_device_create(struct class *cls,
 | |
| 					 struct class_device *parent,
 | |
| 					 dev_t devt,
 | |
| 					 struct device *device,
 | |
| 					 const char *fmt, ...)
 | |
| {
 | |
| 	va_list args;
 | |
| 	struct class_device *class_dev = NULL;
 | |
| 	int retval = -ENODEV;
 | |
| 
 | |
| 	if (cls == NULL || IS_ERR(cls))
 | |
| 		goto error;
 | |
| 
 | |
| 	class_dev = kzalloc(sizeof(*class_dev), GFP_KERNEL);
 | |
| 	if (!class_dev) {
 | |
| 		retval = -ENOMEM;
 | |
| 		goto error;
 | |
| 	}
 | |
| 
 | |
| 	class_dev->devt = devt;
 | |
| 	class_dev->dev = device;
 | |
| 	class_dev->class = cls;
 | |
| 	class_dev->parent = parent;
 | |
| 	class_dev->release = class_device_create_release;
 | |
| 	class_dev->uevent = class_device_create_uevent;
 | |
| 
 | |
| 	va_start(args, fmt);
 | |
| 	vsnprintf(class_dev->class_id, BUS_ID_SIZE, fmt, args);
 | |
| 	va_end(args);
 | |
| 	retval = class_device_register(class_dev);
 | |
| 	if (retval)
 | |
| 		goto error;
 | |
| 
 | |
| 	return class_dev;
 | |
| 
 | |
| error:
 | |
| 	kfree(class_dev);
 | |
| 	return ERR_PTR(retval);
 | |
| }
 | |
| 
 | |
| void class_device_del(struct class_device *class_dev)
 | |
| {
 | |
| 	struct class *parent_class = class_dev->class;
 | |
| 	struct class_device *parent_device = class_dev->parent;
 | |
| 	struct class_interface *class_intf;
 | |
| 
 | |
| 	if (parent_class) {
 | |
| 		down(&parent_class->sem);
 | |
| 		list_del_init(&class_dev->node);
 | |
| 		list_for_each_entry(class_intf, &parent_class->interfaces, node)
 | |
| 			if (class_intf->remove)
 | |
| 				class_intf->remove(class_dev, class_intf);
 | |
| 		up(&parent_class->sem);
 | |
| 	}
 | |
| 
 | |
| 	if (class_dev->dev) {
 | |
| 		remove_deprecated_class_device_links(class_dev);
 | |
| 		sysfs_remove_link(&class_dev->kobj, "device");
 | |
| 	}
 | |
| 	sysfs_remove_link(&class_dev->kobj, "subsystem");
 | |
| 	class_device_remove_file(class_dev, &class_uevent_attr);
 | |
| 	if (MAJOR(class_dev->devt))
 | |
| 		class_device_remove_file(class_dev, &class_devt_attr);
 | |
| 	class_device_remove_attrs(class_dev);
 | |
| 	class_device_remove_groups(class_dev);
 | |
| 
 | |
| 	kobject_uevent(&class_dev->kobj, KOBJ_REMOVE);
 | |
| 	kobject_del(&class_dev->kobj);
 | |
| 
 | |
| 	class_device_put(parent_device);
 | |
| 	class_put(parent_class);
 | |
| }
 | |
| 
 | |
| void class_device_unregister(struct class_device *class_dev)
 | |
| {
 | |
| 	pr_debug("CLASS: Unregistering class device. ID = '%s'\n",
 | |
| 		 class_dev->class_id);
 | |
| 	class_device_del(class_dev);
 | |
| 	class_device_put(class_dev);
 | |
| }
 | |
| 
 | |
| /**
 | |
|  * class_device_destroy - removes a class device that was created with class_device_create()
 | |
|  * @cls: the 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 class device that was created with a
 | |
|  * call to class_device_create()
 | |
|  */
 | |
| void class_device_destroy(struct class *cls, dev_t devt)
 | |
| {
 | |
| 	struct class_device *class_dev = NULL;
 | |
| 	struct class_device *class_dev_tmp;
 | |
| 
 | |
| 	down(&cls->sem);
 | |
| 	list_for_each_entry(class_dev_tmp, &cls->children, node) {
 | |
| 		if (class_dev_tmp->devt == devt) {
 | |
| 			class_dev = class_dev_tmp;
 | |
| 			break;
 | |
| 		}
 | |
| 	}
 | |
| 	up(&cls->sem);
 | |
| 
 | |
| 	if (class_dev)
 | |
| 		class_device_unregister(class_dev);
 | |
| }
 | |
| 
 | |
| struct class_device *class_device_get(struct class_device *class_dev)
 | |
| {
 | |
| 	if (class_dev)
 | |
| 		return to_class_dev(kobject_get(&class_dev->kobj));
 | |
| 	return NULL;
 | |
| }
 | |
| 
 | |
| void class_device_put(struct class_device *class_dev)
 | |
| {
 | |
| 	if (class_dev)
 | |
| 		kobject_put(&class_dev->kobj);
 | |
| }
 | |
| 
 | |
| /**
 | |
|  * class_for_each_device - device iterator
 | |
|  * @class: the class we're iterating
 | |
|  * @data: data for the callback
 | |
|  * @fn: function to be called for each device
 | |
|  *
 | |
|  * Iterate over @class's list of devices, and call @fn for each,
 | |
|  * passing it @data.
 | |
|  *
 | |
|  * We check the return of @fn each time. If it returns anything
 | |
|  * other than 0, we break out and return that value.
 | |
|  *
 | |
|  * Note, we hold class->sem in this function, so it can not be
 | |
|  * re-acquired in @fn, otherwise it will self-deadlocking. For
 | |
|  * example, calls to add or remove class members would be verboten.
 | |
|  */
 | |
| int class_for_each_device(struct class *class, void *data,
 | |
| 			   int (*fn)(struct device *, void *))
 | |
| {
 | |
| 	struct device *dev;
 | |
| 	int error = 0;
 | |
| 
 | |
| 	if (!class)
 | |
| 		return -EINVAL;
 | |
| 	down(&class->sem);
 | |
| 	list_for_each_entry(dev, &class->devices, node) {
 | |
| 		dev = get_device(dev);
 | |
| 		if (dev) {
 | |
| 			error = fn(dev, data);
 | |
| 			put_device(dev);
 | |
| 		} else
 | |
| 			error = -ENODEV;
 | |
| 		if (error)
 | |
| 			break;
 | |
| 	}
 | |
| 	up(&class->sem);
 | |
| 
 | |
| 	return error;
 | |
| }
 | |
| EXPORT_SYMBOL_GPL(class_for_each_device);
 | |
| 
 | |
| /**
 | |
|  * class_find_device - device iterator for locating a particular device
 | |
|  * @class: the class we're iterating
 | |
|  * @data: data for the match function
 | |
|  * @match: function to check device
 | |
|  *
 | |
|  * This is similar to the class_for_each_dev() 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, this function will
 | |
|  * return to the caller and not iterate over any more devices.
 | |
|  *
 | |
|  * Note, you will need to drop the reference with put_device() after use.
 | |
|  *
 | |
|  * We hold class->sem in this function, so it can not be
 | |
|  * re-acquired in @match, otherwise it will self-deadlocking. For
 | |
|  * example, calls to add or remove class members would be verboten.
 | |
|  */
 | |
| struct device *class_find_device(struct class *class, void *data,
 | |
| 				   int (*match)(struct device *, void *))
 | |
| {
 | |
| 	struct device *dev;
 | |
| 	int found = 0;
 | |
| 
 | |
| 	if (!class)
 | |
| 		return NULL;
 | |
| 
 | |
| 	down(&class->sem);
 | |
| 	list_for_each_entry(dev, &class->devices, node) {
 | |
| 		dev = get_device(dev);
 | |
| 		if (dev) {
 | |
| 			if (match(dev, data)) {
 | |
| 				found = 1;
 | |
| 				break;
 | |
| 			} else
 | |
| 				put_device(dev);
 | |
| 		} else
 | |
| 			break;
 | |
| 	}
 | |
| 	up(&class->sem);
 | |
| 
 | |
| 	return found ? dev : NULL;
 | |
| }
 | |
| EXPORT_SYMBOL_GPL(class_find_device);
 | |
| 
 | |
| /**
 | |
|  * class_find_child - device iterator for locating a particular class_device
 | |
|  * @class: the class we're iterating
 | |
|  * @data: data for the match function
 | |
|  * @match: function to check class_device
 | |
|  *
 | |
|  * This function returns a reference to a class_device that is 'found' for
 | |
|  * later use, as determined by the @match callback.
 | |
|  *
 | |
|  * The callback should return 0 if the class_device doesn't match and non-zero
 | |
|  * if it does.  If the callback returns non-zero, this function will
 | |
|  * return to the caller and not iterate over any more class_devices.
 | |
|  *
 | |
|  * Note, you will need to drop the reference with class_device_put() after use.
 | |
|  *
 | |
|  * We hold class->sem in this function, so it can not be
 | |
|  * re-acquired in @match, otherwise it will self-deadlocking. For
 | |
|  * example, calls to add or remove class members would be verboten.
 | |
|  */
 | |
| struct class_device *class_find_child(struct class *class, void *data,
 | |
| 				   int (*match)(struct class_device *, void *))
 | |
| {
 | |
| 	struct class_device *dev;
 | |
| 	int found = 0;
 | |
| 
 | |
| 	if (!class)
 | |
| 		return NULL;
 | |
| 
 | |
| 	down(&class->sem);
 | |
| 	list_for_each_entry(dev, &class->children, node) {
 | |
| 		dev = class_device_get(dev);
 | |
| 		if (dev) {
 | |
| 			if (match(dev, data)) {
 | |
| 				found = 1;
 | |
| 				break;
 | |
| 			} else
 | |
| 				class_device_put(dev);
 | |
| 		} else
 | |
| 			break;
 | |
| 	}
 | |
| 	up(&class->sem);
 | |
| 
 | |
| 	return found ? dev : NULL;
 | |
| }
 | |
| EXPORT_SYMBOL_GPL(class_find_child);
 | |
| 
 | |
| int class_interface_register(struct class_interface *class_intf)
 | |
| {
 | |
| 	struct class *parent;
 | |
| 	struct class_device *class_dev;
 | |
| 	struct device *dev;
 | |
| 
 | |
| 	if (!class_intf || !class_intf->class)
 | |
| 		return -ENODEV;
 | |
| 
 | |
| 	parent = class_get(class_intf->class);
 | |
| 	if (!parent)
 | |
| 		return -EINVAL;
 | |
| 
 | |
| 	down(&parent->sem);
 | |
| 	list_add_tail(&class_intf->node, &parent->interfaces);
 | |
| 	if (class_intf->add) {
 | |
| 		list_for_each_entry(class_dev, &parent->children, node)
 | |
| 			class_intf->add(class_dev, class_intf);
 | |
| 	}
 | |
| 	if (class_intf->add_dev) {
 | |
| 		list_for_each_entry(dev, &parent->devices, node)
 | |
| 			class_intf->add_dev(dev, class_intf);
 | |
| 	}
 | |
| 	up(&parent->sem);
 | |
| 
 | |
| 	return 0;
 | |
| }
 | |
| 
 | |
| void class_interface_unregister(struct class_interface *class_intf)
 | |
| {
 | |
| 	struct class *parent = class_intf->class;
 | |
| 	struct class_device *class_dev;
 | |
| 	struct device *dev;
 | |
| 
 | |
| 	if (!parent)
 | |
| 		return;
 | |
| 
 | |
| 	down(&parent->sem);
 | |
| 	list_del_init(&class_intf->node);
 | |
| 	if (class_intf->remove) {
 | |
| 		list_for_each_entry(class_dev, &parent->children, node)
 | |
| 			class_intf->remove(class_dev, class_intf);
 | |
| 	}
 | |
| 	if (class_intf->remove_dev) {
 | |
| 		list_for_each_entry(dev, &parent->devices, node)
 | |
| 			class_intf->remove_dev(dev, class_intf);
 | |
| 	}
 | |
| 	up(&parent->sem);
 | |
| 
 | |
| 	class_put(parent);
 | |
| }
 | |
| 
 | |
| int __init classes_init(void)
 | |
| {
 | |
| 	class_kset = kset_create_and_add("class", NULL, NULL);
 | |
| 	if (!class_kset)
 | |
| 		return -ENOMEM;
 | |
| 
 | |
| 	/* ick, this is ugly, the things we go through to keep from showing up
 | |
| 	 * in sysfs... */
 | |
| 	kset_init(&class_obj_subsys);
 | |
| 	kobject_set_name(&class_obj_subsys.kobj, "class_obj");
 | |
| 	if (!class_obj_subsys.kobj.parent)
 | |
| 		class_obj_subsys.kobj.parent = &class_obj_subsys.kobj;
 | |
| 	return 0;
 | |
| }
 | |
| 
 | |
| EXPORT_SYMBOL_GPL(class_create_file);
 | |
| EXPORT_SYMBOL_GPL(class_remove_file);
 | |
| EXPORT_SYMBOL_GPL(class_register);
 | |
| EXPORT_SYMBOL_GPL(class_unregister);
 | |
| EXPORT_SYMBOL_GPL(class_create);
 | |
| EXPORT_SYMBOL_GPL(class_destroy);
 | |
| 
 | |
| EXPORT_SYMBOL_GPL(class_device_register);
 | |
| EXPORT_SYMBOL_GPL(class_device_unregister);
 | |
| EXPORT_SYMBOL_GPL(class_device_initialize);
 | |
| EXPORT_SYMBOL_GPL(class_device_add);
 | |
| EXPORT_SYMBOL_GPL(class_device_del);
 | |
| EXPORT_SYMBOL_GPL(class_device_get);
 | |
| EXPORT_SYMBOL_GPL(class_device_put);
 | |
| EXPORT_SYMBOL_GPL(class_device_create);
 | |
| EXPORT_SYMBOL_GPL(class_device_destroy);
 | |
| EXPORT_SYMBOL_GPL(class_device_create_file);
 | |
| EXPORT_SYMBOL_GPL(class_device_remove_file);
 | |
| EXPORT_SYMBOL_GPL(class_device_create_bin_file);
 | |
| EXPORT_SYMBOL_GPL(class_device_remove_bin_file);
 | |
| 
 | |
| EXPORT_SYMBOL_GPL(class_interface_register);
 | |
| EXPORT_SYMBOL_GPL(class_interface_unregister);
 |