Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1 | /* |
| 2 | * sys.c - pseudo-bus for system 'devices' (cpus, PICs, timers, etc) |
| 3 | * |
| 4 | * Copyright (c) 2002-3 Patrick Mochel |
| 5 | * 2002-3 Open Source Development Lab |
| 6 | * |
| 7 | * This file is released under the GPLv2 |
| 8 | * |
| 9 | * This exports a 'system' bus type. |
| 10 | * By default, a 'sys' bus gets added to the root of the system. There will |
| 11 | * always be core system devices. Devices can use sysdev_register() to |
| 12 | * add themselves as children of the system bus. |
| 13 | */ |
| 14 | |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 15 | #include <linux/sysdev.h> |
| 16 | #include <linux/err.h> |
| 17 | #include <linux/module.h> |
| 18 | #include <linux/kernel.h> |
| 19 | #include <linux/init.h> |
| 20 | #include <linux/slab.h> |
| 21 | #include <linux/string.h> |
Pavel Machek | 438510f | 2005-04-16 15:25:24 -0700 | [diff] [blame] | 22 | #include <linux/pm.h> |
Adrian Bunk | f67d115 | 2006-01-19 17:30:17 +0100 | [diff] [blame] | 23 | #include <linux/device.h> |
Matthias Kaehlcke | 9f3f776 | 2007-05-23 14:19:42 -0700 | [diff] [blame] | 24 | #include <linux/mutex.h> |
Rafael J. Wysocki | 2ed8d2b | 2009-03-16 22:34:06 +0100 | [diff] [blame] | 25 | #include <linux/interrupt.h> |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 26 | |
Adrian Bunk | f67d115 | 2006-01-19 17:30:17 +0100 | [diff] [blame] | 27 | #include "base.h" |
| 28 | |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 29 | #define to_sysdev(k) container_of(k, struct sys_device, kobj) |
| 30 | #define to_sysdev_attr(a) container_of(a, struct sysdev_attribute, attr) |
| 31 | |
| 32 | |
| 33 | static ssize_t |
Zhenwen Xu | 60530af | 2009-03-03 18:36:02 +0800 | [diff] [blame] | 34 | sysdev_show(struct kobject *kobj, struct attribute *attr, char *buffer) |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 35 | { |
Zhenwen Xu | 60530af | 2009-03-03 18:36:02 +0800 | [diff] [blame] | 36 | struct sys_device *sysdev = to_sysdev(kobj); |
| 37 | struct sysdev_attribute *sysdev_attr = to_sysdev_attr(attr); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 38 | |
| 39 | if (sysdev_attr->show) |
Andi Kleen | 4a0b2b4 | 2008-07-01 18:48:41 +0200 | [diff] [blame] | 40 | return sysdev_attr->show(sysdev, sysdev_attr, buffer); |
Dmitry Torokhov | 4a0c20b | 2005-04-29 01:23:47 -0500 | [diff] [blame] | 41 | return -EIO; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 42 | } |
| 43 | |
| 44 | |
| 45 | static ssize_t |
Zhenwen Xu | 60530af | 2009-03-03 18:36:02 +0800 | [diff] [blame] | 46 | sysdev_store(struct kobject *kobj, struct attribute *attr, |
| 47 | const char *buffer, size_t count) |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 48 | { |
Zhenwen Xu | 60530af | 2009-03-03 18:36:02 +0800 | [diff] [blame] | 49 | struct sys_device *sysdev = to_sysdev(kobj); |
| 50 | struct sysdev_attribute *sysdev_attr = to_sysdev_attr(attr); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 51 | |
| 52 | if (sysdev_attr->store) |
Andi Kleen | 4a0b2b4 | 2008-07-01 18:48:41 +0200 | [diff] [blame] | 53 | return sysdev_attr->store(sysdev, sysdev_attr, buffer, count); |
Dmitry Torokhov | 4a0c20b | 2005-04-29 01:23:47 -0500 | [diff] [blame] | 54 | return -EIO; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 55 | } |
| 56 | |
| 57 | static struct sysfs_ops sysfs_ops = { |
| 58 | .show = sysdev_show, |
| 59 | .store = sysdev_store, |
| 60 | }; |
| 61 | |
| 62 | static struct kobj_type ktype_sysdev = { |
| 63 | .sysfs_ops = &sysfs_ops, |
| 64 | }; |
| 65 | |
| 66 | |
Zhenwen Xu | 60530af | 2009-03-03 18:36:02 +0800 | [diff] [blame] | 67 | int sysdev_create_file(struct sys_device *s, struct sysdev_attribute *a) |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 68 | { |
| 69 | return sysfs_create_file(&s->kobj, &a->attr); |
| 70 | } |
| 71 | |
| 72 | |
Zhenwen Xu | 60530af | 2009-03-03 18:36:02 +0800 | [diff] [blame] | 73 | void sysdev_remove_file(struct sys_device *s, struct sysdev_attribute *a) |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 74 | { |
| 75 | sysfs_remove_file(&s->kobj, &a->attr); |
| 76 | } |
| 77 | |
| 78 | EXPORT_SYMBOL_GPL(sysdev_create_file); |
| 79 | EXPORT_SYMBOL_GPL(sysdev_remove_file); |
| 80 | |
Shaohua Li | 670dd90 | 2006-05-08 13:45:57 +0800 | [diff] [blame] | 81 | #define to_sysdev_class(k) container_of(k, struct sysdev_class, kset.kobj) |
| 82 | #define to_sysdev_class_attr(a) container_of(a, \ |
| 83 | struct sysdev_class_attribute, attr) |
| 84 | |
| 85 | static ssize_t sysdev_class_show(struct kobject *kobj, struct attribute *attr, |
| 86 | char *buffer) |
| 87 | { |
Zhenwen Xu | 60530af | 2009-03-03 18:36:02 +0800 | [diff] [blame] | 88 | struct sysdev_class *class = to_sysdev_class(kobj); |
Shaohua Li | 670dd90 | 2006-05-08 13:45:57 +0800 | [diff] [blame] | 89 | struct sysdev_class_attribute *class_attr = to_sysdev_class_attr(attr); |
| 90 | |
| 91 | if (class_attr->show) |
| 92 | return class_attr->show(class, buffer); |
| 93 | return -EIO; |
| 94 | } |
| 95 | |
| 96 | static ssize_t sysdev_class_store(struct kobject *kobj, struct attribute *attr, |
| 97 | const char *buffer, size_t count) |
| 98 | { |
Zhenwen Xu | 60530af | 2009-03-03 18:36:02 +0800 | [diff] [blame] | 99 | struct sysdev_class *class = to_sysdev_class(kobj); |
| 100 | struct sysdev_class_attribute *class_attr = to_sysdev_class_attr(attr); |
Shaohua Li | 670dd90 | 2006-05-08 13:45:57 +0800 | [diff] [blame] | 101 | |
| 102 | if (class_attr->store) |
| 103 | return class_attr->store(class, buffer, count); |
| 104 | return -EIO; |
| 105 | } |
| 106 | |
| 107 | static struct sysfs_ops sysfs_class_ops = { |
| 108 | .show = sysdev_class_show, |
| 109 | .store = sysdev_class_store, |
| 110 | }; |
| 111 | |
| 112 | static struct kobj_type ktype_sysdev_class = { |
| 113 | .sysfs_ops = &sysfs_class_ops, |
| 114 | }; |
| 115 | |
| 116 | int sysdev_class_create_file(struct sysdev_class *c, |
| 117 | struct sysdev_class_attribute *a) |
| 118 | { |
| 119 | return sysfs_create_file(&c->kset.kobj, &a->attr); |
| 120 | } |
| 121 | EXPORT_SYMBOL_GPL(sysdev_class_create_file); |
| 122 | |
| 123 | void sysdev_class_remove_file(struct sysdev_class *c, |
| 124 | struct sysdev_class_attribute *a) |
| 125 | { |
| 126 | sysfs_remove_file(&c->kset.kobj, &a->attr); |
| 127 | } |
| 128 | EXPORT_SYMBOL_GPL(sysdev_class_remove_file); |
| 129 | |
Greg Kroah-Hartman | aade404 | 2007-11-01 09:29:06 -0600 | [diff] [blame] | 130 | static struct kset *system_kset; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 131 | |
Zhenwen Xu | 60530af | 2009-03-03 18:36:02 +0800 | [diff] [blame] | 132 | int sysdev_class_register(struct sysdev_class *cls) |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 133 | { |
Dave Young | 9227c47 | 2009-05-11 14:18:55 +0800 | [diff] [blame] | 134 | int retval; |
| 135 | |
Ben Dooks | 838ea8e | 2008-06-12 19:00:34 +0100 | [diff] [blame] | 136 | pr_debug("Registering sysdev class '%s'\n", cls->name); |
| 137 | |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 138 | INIT_LIST_HEAD(&cls->drivers); |
Greg Kroah-Hartman | ef79df2 | 2008-03-09 03:37:16 +0530 | [diff] [blame] | 139 | memset(&cls->kset.kobj, 0x00, sizeof(struct kobject)); |
Greg Kroah-Hartman | aade404 | 2007-11-01 09:29:06 -0600 | [diff] [blame] | 140 | cls->kset.kobj.parent = &system_kset->kobj; |
Greg Kroah-Hartman | 3514fac | 2007-10-16 10:11:44 -0600 | [diff] [blame] | 141 | cls->kset.kobj.ktype = &ktype_sysdev_class; |
Greg Kroah-Hartman | aade404 | 2007-11-01 09:29:06 -0600 | [diff] [blame] | 142 | cls->kset.kobj.kset = system_kset; |
Dave Young | 9227c47 | 2009-05-11 14:18:55 +0800 | [diff] [blame] | 143 | |
Greg Kroah-Hartman | acc0e90 | 2009-06-02 15:39:55 -0700 | [diff] [blame] | 144 | retval = kobject_set_name(&cls->kset.kobj, "%s", cls->name); |
Dave Young | 9227c47 | 2009-05-11 14:18:55 +0800 | [diff] [blame] | 145 | if (retval) |
| 146 | return retval; |
| 147 | |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 148 | return kset_register(&cls->kset); |
| 149 | } |
| 150 | |
Zhenwen Xu | 60530af | 2009-03-03 18:36:02 +0800 | [diff] [blame] | 151 | void sysdev_class_unregister(struct sysdev_class *cls) |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 152 | { |
| 153 | pr_debug("Unregistering sysdev class '%s'\n", |
| 154 | kobject_name(&cls->kset.kobj)); |
| 155 | kset_unregister(&cls->kset); |
| 156 | } |
| 157 | |
| 158 | EXPORT_SYMBOL_GPL(sysdev_class_register); |
| 159 | EXPORT_SYMBOL_GPL(sysdev_class_unregister); |
| 160 | |
Matthias Kaehlcke | 9f3f776 | 2007-05-23 14:19:42 -0700 | [diff] [blame] | 161 | static DEFINE_MUTEX(sysdev_drivers_lock); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 162 | |
| 163 | /** |
| 164 | * sysdev_driver_register - Register auxillary driver |
Akinobu Mita | 44b760a | 2007-08-19 16:51:14 +0900 | [diff] [blame] | 165 | * @cls: Device class driver belongs to. |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 166 | * @drv: Driver. |
| 167 | * |
Akinobu Mita | 44b760a | 2007-08-19 16:51:14 +0900 | [diff] [blame] | 168 | * @drv is inserted into @cls->drivers to be |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 169 | * called on each operation on devices of that class. The refcount |
| 170 | * of @cls is incremented. |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 171 | */ |
| 172 | |
Akinobu Mita | 44b760a | 2007-08-19 16:51:14 +0900 | [diff] [blame] | 173 | int sysdev_driver_register(struct sysdev_class *cls, struct sysdev_driver *drv) |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 174 | { |
Akinobu Mita | 44b760a | 2007-08-19 16:51:14 +0900 | [diff] [blame] | 175 | int err = 0; |
| 176 | |
Ben Dooks | da009f3 | 2008-03-04 15:09:06 -0800 | [diff] [blame] | 177 | if (!cls) { |
Arjan van de Ven | f810a5c | 2008-07-25 19:45:39 -0700 | [diff] [blame] | 178 | WARN(1, KERN_WARNING "sysdev: invalid class passed to " |
Ben Dooks | da009f3 | 2008-03-04 15:09:06 -0800 | [diff] [blame] | 179 | "sysdev_driver_register!\n"); |
Ben Dooks | da009f3 | 2008-03-04 15:09:06 -0800 | [diff] [blame] | 180 | return -EINVAL; |
| 181 | } |
| 182 | |
| 183 | /* Check whether this driver has already been added to a class. */ |
Arjan van de Ven | f810a5c | 2008-07-25 19:45:39 -0700 | [diff] [blame] | 184 | if (drv->entry.next && !list_empty(&drv->entry)) |
| 185 | WARN(1, KERN_WARNING "sysdev: class %s: driver (%p) has already" |
Ben Dooks | da009f3 | 2008-03-04 15:09:06 -0800 | [diff] [blame] | 186 | " been registered to a class, something is wrong, but " |
| 187 | "will forge on!\n", cls->name, drv); |
Ben Dooks | da009f3 | 2008-03-04 15:09:06 -0800 | [diff] [blame] | 188 | |
Matthias Kaehlcke | 9f3f776 | 2007-05-23 14:19:42 -0700 | [diff] [blame] | 189 | mutex_lock(&sysdev_drivers_lock); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 190 | if (cls && kset_get(&cls->kset)) { |
| 191 | list_add_tail(&drv->entry, &cls->drivers); |
| 192 | |
| 193 | /* If devices of this class already exist, tell the driver */ |
| 194 | if (drv->add) { |
| 195 | struct sys_device *dev; |
| 196 | list_for_each_entry(dev, &cls->kset.list, kobj.entry) |
| 197 | drv->add(dev); |
| 198 | } |
Akinobu Mita | 44b760a | 2007-08-19 16:51:14 +0900 | [diff] [blame] | 199 | } else { |
| 200 | err = -EINVAL; |
Arjan van de Ven | f810a5c | 2008-07-25 19:45:39 -0700 | [diff] [blame] | 201 | WARN(1, KERN_ERR "%s: invalid device class\n", __func__); |
Akinobu Mita | 44b760a | 2007-08-19 16:51:14 +0900 | [diff] [blame] | 202 | } |
Matthias Kaehlcke | 9f3f776 | 2007-05-23 14:19:42 -0700 | [diff] [blame] | 203 | mutex_unlock(&sysdev_drivers_lock); |
Akinobu Mita | 44b760a | 2007-08-19 16:51:14 +0900 | [diff] [blame] | 204 | return err; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 205 | } |
| 206 | |
| 207 | |
| 208 | /** |
| 209 | * sysdev_driver_unregister - Remove an auxillary driver. |
| 210 | * @cls: Class driver belongs to. |
| 211 | * @drv: Driver. |
| 212 | */ |
Zhenwen Xu | 60530af | 2009-03-03 18:36:02 +0800 | [diff] [blame] | 213 | void sysdev_driver_unregister(struct sysdev_class *cls, |
| 214 | struct sysdev_driver *drv) |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 215 | { |
Matthias Kaehlcke | 9f3f776 | 2007-05-23 14:19:42 -0700 | [diff] [blame] | 216 | mutex_lock(&sysdev_drivers_lock); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 217 | list_del_init(&drv->entry); |
| 218 | if (cls) { |
| 219 | if (drv->remove) { |
| 220 | struct sys_device *dev; |
| 221 | list_for_each_entry(dev, &cls->kset.list, kobj.entry) |
| 222 | drv->remove(dev); |
| 223 | } |
| 224 | kset_put(&cls->kset); |
| 225 | } |
Matthias Kaehlcke | 9f3f776 | 2007-05-23 14:19:42 -0700 | [diff] [blame] | 226 | mutex_unlock(&sysdev_drivers_lock); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 227 | } |
| 228 | |
| 229 | EXPORT_SYMBOL_GPL(sysdev_driver_register); |
| 230 | EXPORT_SYMBOL_GPL(sysdev_driver_unregister); |
| 231 | |
| 232 | |
| 233 | |
| 234 | /** |
| 235 | * sysdev_register - add a system device to the tree |
| 236 | * @sysdev: device in question |
| 237 | * |
| 238 | */ |
Zhenwen Xu | 60530af | 2009-03-03 18:36:02 +0800 | [diff] [blame] | 239 | int sysdev_register(struct sys_device *sysdev) |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 240 | { |
| 241 | int error; |
Zhenwen Xu | 60530af | 2009-03-03 18:36:02 +0800 | [diff] [blame] | 242 | struct sysdev_class *cls = sysdev->cls; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 243 | |
| 244 | if (!cls) |
| 245 | return -EINVAL; |
| 246 | |
Ben Dooks | 838ea8e | 2008-06-12 19:00:34 +0100 | [diff] [blame] | 247 | pr_debug("Registering sys device of class '%s'\n", |
| 248 | kobject_name(&cls->kset.kobj)); |
Greg Kroah-Hartman | 61030bf | 2007-12-17 15:54:39 -0400 | [diff] [blame] | 249 | |
Greg Kroah-Hartman | ef79df2 | 2008-03-09 03:37:16 +0530 | [diff] [blame] | 250 | /* initialize the kobject to 0, in case it had previously been used */ |
| 251 | memset(&sysdev->kobj, 0x00, sizeof(struct kobject)); |
| 252 | |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 253 | /* Make sure the kset is set */ |
| 254 | sysdev->kobj.kset = &cls->kset; |
| 255 | |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 256 | /* Register the object */ |
Greg Kroah-Hartman | 61030bf | 2007-12-17 15:54:39 -0400 | [diff] [blame] | 257 | error = kobject_init_and_add(&sysdev->kobj, &ktype_sysdev, NULL, |
| 258 | "%s%d", kobject_name(&cls->kset.kobj), |
| 259 | sysdev->id); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 260 | |
| 261 | if (!error) { |
Zhenwen Xu | 60530af | 2009-03-03 18:36:02 +0800 | [diff] [blame] | 262 | struct sysdev_driver *drv; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 263 | |
Ben Dooks | 838ea8e | 2008-06-12 19:00:34 +0100 | [diff] [blame] | 264 | pr_debug("Registering sys device '%s'\n", |
| 265 | kobject_name(&sysdev->kobj)); |
| 266 | |
Matthias Kaehlcke | 9f3f776 | 2007-05-23 14:19:42 -0700 | [diff] [blame] | 267 | mutex_lock(&sysdev_drivers_lock); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 268 | /* Generic notification is implicit, because it's that |
| 269 | * code that should have called us. |
| 270 | */ |
| 271 | |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 272 | /* Notify class auxillary drivers */ |
| 273 | list_for_each_entry(drv, &cls->drivers, entry) { |
| 274 | if (drv->add) |
| 275 | drv->add(sysdev); |
| 276 | } |
Matthias Kaehlcke | 9f3f776 | 2007-05-23 14:19:42 -0700 | [diff] [blame] | 277 | mutex_unlock(&sysdev_drivers_lock); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 278 | } |
Ben Dooks | 838ea8e | 2008-06-12 19:00:34 +0100 | [diff] [blame] | 279 | |
Greg Kroah-Hartman | 61030bf | 2007-12-17 15:54:39 -0400 | [diff] [blame] | 280 | kobject_uevent(&sysdev->kobj, KOBJ_ADD); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 281 | return error; |
| 282 | } |
| 283 | |
Zhenwen Xu | 60530af | 2009-03-03 18:36:02 +0800 | [diff] [blame] | 284 | void sysdev_unregister(struct sys_device *sysdev) |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 285 | { |
Zhenwen Xu | 60530af | 2009-03-03 18:36:02 +0800 | [diff] [blame] | 286 | struct sysdev_driver *drv; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 287 | |
Matthias Kaehlcke | 9f3f776 | 2007-05-23 14:19:42 -0700 | [diff] [blame] | 288 | mutex_lock(&sysdev_drivers_lock); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 289 | list_for_each_entry(drv, &sysdev->cls->drivers, entry) { |
| 290 | if (drv->remove) |
| 291 | drv->remove(sysdev); |
| 292 | } |
Matthias Kaehlcke | 9f3f776 | 2007-05-23 14:19:42 -0700 | [diff] [blame] | 293 | mutex_unlock(&sysdev_drivers_lock); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 294 | |
Greg Kroah-Hartman | c10997f | 2007-12-20 08:13:05 -0800 | [diff] [blame] | 295 | kobject_put(&sysdev->kobj); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 296 | } |
| 297 | |
| 298 | |
| 299 | |
| 300 | /** |
| 301 | * sysdev_shutdown - Shut down all system devices. |
| 302 | * |
| 303 | * Loop over each class of system devices, and the devices in each |
| 304 | * of those classes. For each device, we call the shutdown method for |
Akinobu Mita | 44b760a | 2007-08-19 16:51:14 +0900 | [diff] [blame] | 305 | * each driver registered for the device - the auxillaries, |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 306 | * and the class driver. |
| 307 | * |
| 308 | * Note: The list is iterated in reverse order, so that we shut down |
Uwe Kleine-Koenig | ee6921f | 2009-01-12 23:35:46 +0100 | [diff] [blame] | 309 | * child devices before we shut down their parents. The list ordering |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 310 | * is guaranteed by virtue of the fact that child devices are registered |
| 311 | * after their parents. |
| 312 | */ |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 313 | void sysdev_shutdown(void) |
| 314 | { |
Zhenwen Xu | 60530af | 2009-03-03 18:36:02 +0800 | [diff] [blame] | 315 | struct sysdev_class *cls; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 316 | |
| 317 | pr_debug("Shutting Down System Devices\n"); |
| 318 | |
Matthias Kaehlcke | 9f3f776 | 2007-05-23 14:19:42 -0700 | [diff] [blame] | 319 | mutex_lock(&sysdev_drivers_lock); |
Greg Kroah-Hartman | aade404 | 2007-11-01 09:29:06 -0600 | [diff] [blame] | 320 | list_for_each_entry_reverse(cls, &system_kset->list, kset.kobj.entry) { |
Zhenwen Xu | 60530af | 2009-03-03 18:36:02 +0800 | [diff] [blame] | 321 | struct sys_device *sysdev; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 322 | |
| 323 | pr_debug("Shutting down type '%s':\n", |
| 324 | kobject_name(&cls->kset.kobj)); |
| 325 | |
| 326 | list_for_each_entry(sysdev, &cls->kset.list, kobj.entry) { |
Zhenwen Xu | 60530af | 2009-03-03 18:36:02 +0800 | [diff] [blame] | 327 | struct sysdev_driver *drv; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 328 | pr_debug(" %s\n", kobject_name(&sysdev->kobj)); |
| 329 | |
Akinobu Mita | 44b760a | 2007-08-19 16:51:14 +0900 | [diff] [blame] | 330 | /* Call auxillary drivers first */ |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 331 | list_for_each_entry(drv, &cls->drivers, entry) { |
| 332 | if (drv->shutdown) |
| 333 | drv->shutdown(sysdev); |
| 334 | } |
| 335 | |
| 336 | /* Now call the generic one */ |
| 337 | if (cls->shutdown) |
| 338 | cls->shutdown(sysdev); |
| 339 | } |
| 340 | } |
Matthias Kaehlcke | 9f3f776 | 2007-05-23 14:19:42 -0700 | [diff] [blame] | 341 | mutex_unlock(&sysdev_drivers_lock); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 342 | } |
| 343 | |
Shaohua Li | ceaeade | 2005-08-11 10:37:39 +0800 | [diff] [blame] | 344 | static void __sysdev_resume(struct sys_device *dev) |
| 345 | { |
| 346 | struct sysdev_class *cls = dev->cls; |
| 347 | struct sysdev_driver *drv; |
| 348 | |
| 349 | /* First, call the class-specific one */ |
| 350 | if (cls->resume) |
| 351 | cls->resume(dev); |
Rafael J. Wysocki | 62b0124 | 2009-04-18 13:45:13 +0200 | [diff] [blame] | 352 | WARN_ONCE(!irqs_disabled(), |
| 353 | "Interrupts enabled after %pF\n", cls->resume); |
Shaohua Li | ceaeade | 2005-08-11 10:37:39 +0800 | [diff] [blame] | 354 | |
| 355 | /* Call auxillary drivers next. */ |
| 356 | list_for_each_entry(drv, &cls->drivers, entry) { |
| 357 | if (drv->resume) |
| 358 | drv->resume(dev); |
Rafael J. Wysocki | 62b0124 | 2009-04-18 13:45:13 +0200 | [diff] [blame] | 359 | WARN_ONCE(!irqs_disabled(), |
| 360 | "Interrupts enabled after %pF\n", drv->resume); |
Shaohua Li | ceaeade | 2005-08-11 10:37:39 +0800 | [diff] [blame] | 361 | } |
Shaohua Li | ceaeade | 2005-08-11 10:37:39 +0800 | [diff] [blame] | 362 | } |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 363 | |
| 364 | /** |
| 365 | * sysdev_suspend - Suspend all system devices. |
| 366 | * @state: Power state to enter. |
| 367 | * |
Qinghuang Feng | 6515136 | 2008-10-13 18:05:04 +0800 | [diff] [blame] | 368 | * We perform an almost identical operation as sysdev_shutdown() |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 369 | * above, though calling ->suspend() instead. Interrupts are disabled |
| 370 | * when this called. Devices are responsible for both saving state and |
| 371 | * quiescing or powering down the device. |
| 372 | * |
| 373 | * This is only called by the device PM core, so we let them handle |
| 374 | * all synchronization. |
| 375 | */ |
Pavel Machek | 438510f | 2005-04-16 15:25:24 -0700 | [diff] [blame] | 376 | int sysdev_suspend(pm_message_t state) |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 377 | { |
Zhenwen Xu | 60530af | 2009-03-03 18:36:02 +0800 | [diff] [blame] | 378 | struct sysdev_class *cls; |
Shaohua Li | ceaeade | 2005-08-11 10:37:39 +0800 | [diff] [blame] | 379 | struct sys_device *sysdev, *err_dev; |
| 380 | struct sysdev_driver *drv, *err_drv; |
| 381 | int ret; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 382 | |
Rafael J. Wysocki | 2ed8d2b | 2009-03-16 22:34:06 +0100 | [diff] [blame] | 383 | pr_debug("Checking wake-up interrupts\n"); |
| 384 | |
| 385 | /* Return error code if there are any wake-up interrupts pending */ |
| 386 | ret = check_wakeup_irqs(); |
| 387 | if (ret) |
| 388 | return ret; |
| 389 | |
Rafael J. Wysocki | 62b0124 | 2009-04-18 13:45:13 +0200 | [diff] [blame] | 390 | WARN_ONCE(!irqs_disabled(), |
| 391 | "Interrupts enabled while suspending system devices\n"); |
| 392 | |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 393 | pr_debug("Suspending System Devices\n"); |
| 394 | |
Greg Kroah-Hartman | aade404 | 2007-11-01 09:29:06 -0600 | [diff] [blame] | 395 | list_for_each_entry_reverse(cls, &system_kset->list, kset.kobj.entry) { |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 396 | pr_debug("Suspending type '%s':\n", |
| 397 | kobject_name(&cls->kset.kobj)); |
| 398 | |
| 399 | list_for_each_entry(sysdev, &cls->kset.list, kobj.entry) { |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 400 | pr_debug(" %s\n", kobject_name(&sysdev->kobj)); |
| 401 | |
Akinobu Mita | 44b760a | 2007-08-19 16:51:14 +0900 | [diff] [blame] | 402 | /* Call auxillary drivers first */ |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 403 | list_for_each_entry(drv, &cls->drivers, entry) { |
Shaohua Li | ceaeade | 2005-08-11 10:37:39 +0800 | [diff] [blame] | 404 | if (drv->suspend) { |
| 405 | ret = drv->suspend(sysdev, state); |
| 406 | if (ret) |
| 407 | goto aux_driver; |
| 408 | } |
Rafael J. Wysocki | 62b0124 | 2009-04-18 13:45:13 +0200 | [diff] [blame] | 409 | WARN_ONCE(!irqs_disabled(), |
| 410 | "Interrupts enabled after %pF\n", |
| 411 | drv->suspend); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 412 | } |
| 413 | |
| 414 | /* Now call the generic one */ |
Shaohua Li | ceaeade | 2005-08-11 10:37:39 +0800 | [diff] [blame] | 415 | if (cls->suspend) { |
| 416 | ret = cls->suspend(sysdev, state); |
| 417 | if (ret) |
| 418 | goto cls_driver; |
Rafael J. Wysocki | 62b0124 | 2009-04-18 13:45:13 +0200 | [diff] [blame] | 419 | WARN_ONCE(!irqs_disabled(), |
| 420 | "Interrupts enabled after %pF\n", |
| 421 | cls->suspend); |
Shaohua Li | ceaeade | 2005-08-11 10:37:39 +0800 | [diff] [blame] | 422 | } |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 423 | } |
| 424 | } |
| 425 | return 0; |
Shaohua Li | ceaeade | 2005-08-11 10:37:39 +0800 | [diff] [blame] | 426 | /* resume current sysdev */ |
| 427 | cls_driver: |
| 428 | drv = NULL; |
| 429 | printk(KERN_ERR "Class suspend failed for %s\n", |
| 430 | kobject_name(&sysdev->kobj)); |
| 431 | |
| 432 | aux_driver: |
| 433 | if (drv) |
| 434 | printk(KERN_ERR "Class driver suspend failed for %s\n", |
| 435 | kobject_name(&sysdev->kobj)); |
| 436 | list_for_each_entry(err_drv, &cls->drivers, entry) { |
| 437 | if (err_drv == drv) |
| 438 | break; |
| 439 | if (err_drv->resume) |
| 440 | err_drv->resume(sysdev); |
| 441 | } |
Shaohua Li | ceaeade | 2005-08-11 10:37:39 +0800 | [diff] [blame] | 442 | |
Shaohua Li | ceaeade | 2005-08-11 10:37:39 +0800 | [diff] [blame] | 443 | /* resume other sysdevs in current class */ |
| 444 | list_for_each_entry(err_dev, &cls->kset.list, kobj.entry) { |
| 445 | if (err_dev == sysdev) |
| 446 | break; |
| 447 | pr_debug(" %s\n", kobject_name(&err_dev->kobj)); |
| 448 | __sysdev_resume(err_dev); |
| 449 | } |
| 450 | |
| 451 | /* resume other classes */ |
Greg Kroah-Hartman | aade404 | 2007-11-01 09:29:06 -0600 | [diff] [blame] | 452 | list_for_each_entry_continue(cls, &system_kset->list, kset.kobj.entry) { |
Shaohua Li | ceaeade | 2005-08-11 10:37:39 +0800 | [diff] [blame] | 453 | list_for_each_entry(err_dev, &cls->kset.list, kobj.entry) { |
| 454 | pr_debug(" %s\n", kobject_name(&err_dev->kobj)); |
| 455 | __sysdev_resume(err_dev); |
| 456 | } |
| 457 | } |
| 458 | return ret; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 459 | } |
Ingo Molnar | 0f99fed | 2009-02-22 22:07:03 +0100 | [diff] [blame] | 460 | EXPORT_SYMBOL_GPL(sysdev_suspend); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 461 | |
| 462 | /** |
| 463 | * sysdev_resume - Bring system devices back to life. |
| 464 | * |
Qinghuang Feng | 6515136 | 2008-10-13 18:05:04 +0800 | [diff] [blame] | 465 | * Similar to sysdev_suspend(), but we iterate the list forwards |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 466 | * to guarantee that parent devices are resumed before their children. |
| 467 | * |
| 468 | * Note: Interrupts are disabled when called. |
| 469 | */ |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 470 | int sysdev_resume(void) |
| 471 | { |
Zhenwen Xu | 60530af | 2009-03-03 18:36:02 +0800 | [diff] [blame] | 472 | struct sysdev_class *cls; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 473 | |
Rafael J. Wysocki | 62b0124 | 2009-04-18 13:45:13 +0200 | [diff] [blame] | 474 | WARN_ONCE(!irqs_disabled(), |
| 475 | "Interrupts enabled while resuming system devices\n"); |
| 476 | |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 477 | pr_debug("Resuming System Devices\n"); |
| 478 | |
Greg Kroah-Hartman | aade404 | 2007-11-01 09:29:06 -0600 | [diff] [blame] | 479 | list_for_each_entry(cls, &system_kset->list, kset.kobj.entry) { |
Zhenwen Xu | 60530af | 2009-03-03 18:36:02 +0800 | [diff] [blame] | 480 | struct sys_device *sysdev; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 481 | |
| 482 | pr_debug("Resuming type '%s':\n", |
| 483 | kobject_name(&cls->kset.kobj)); |
| 484 | |
| 485 | list_for_each_entry(sysdev, &cls->kset.list, kobj.entry) { |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 486 | pr_debug(" %s\n", kobject_name(&sysdev->kobj)); |
| 487 | |
Shaohua Li | ceaeade | 2005-08-11 10:37:39 +0800 | [diff] [blame] | 488 | __sysdev_resume(sysdev); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 489 | } |
| 490 | } |
| 491 | return 0; |
| 492 | } |
Ingo Molnar | 0f99fed | 2009-02-22 22:07:03 +0100 | [diff] [blame] | 493 | EXPORT_SYMBOL_GPL(sysdev_resume); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 494 | |
| 495 | int __init system_bus_init(void) |
| 496 | { |
Greg Kroah-Hartman | aade404 | 2007-11-01 09:29:06 -0600 | [diff] [blame] | 497 | system_kset = kset_create_and_add("system", NULL, &devices_kset->kobj); |
| 498 | if (!system_kset) |
| 499 | return -ENOMEM; |
| 500 | return 0; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 501 | } |
| 502 | |
| 503 | EXPORT_SYMBOL_GPL(sysdev_register); |
| 504 | EXPORT_SYMBOL_GPL(sysdev_unregister); |
Andi Kleen | 9800794 | 2008-07-01 18:48:42 +0200 | [diff] [blame] | 505 | |
| 506 | #define to_ext_attr(x) container_of(x, struct sysdev_ext_attribute, attr) |
| 507 | |
| 508 | ssize_t sysdev_store_ulong(struct sys_device *sysdev, |
| 509 | struct sysdev_attribute *attr, |
| 510 | const char *buf, size_t size) |
| 511 | { |
| 512 | struct sysdev_ext_attribute *ea = to_ext_attr(attr); |
| 513 | char *end; |
| 514 | unsigned long new = simple_strtoul(buf, &end, 0); |
| 515 | if (end == buf) |
| 516 | return -EINVAL; |
| 517 | *(unsigned long *)(ea->var) = new; |
Andi Kleen | 4e318d7 | 2008-10-13 12:03:03 +0200 | [diff] [blame] | 518 | /* Always return full write size even if we didn't consume all */ |
| 519 | return size; |
Andi Kleen | 9800794 | 2008-07-01 18:48:42 +0200 | [diff] [blame] | 520 | } |
| 521 | EXPORT_SYMBOL_GPL(sysdev_store_ulong); |
| 522 | |
| 523 | ssize_t sysdev_show_ulong(struct sys_device *sysdev, |
| 524 | struct sysdev_attribute *attr, |
| 525 | char *buf) |
| 526 | { |
| 527 | struct sysdev_ext_attribute *ea = to_ext_attr(attr); |
| 528 | return snprintf(buf, PAGE_SIZE, "%lx\n", *(unsigned long *)(ea->var)); |
| 529 | } |
| 530 | EXPORT_SYMBOL_GPL(sysdev_show_ulong); |
| 531 | |
| 532 | ssize_t sysdev_store_int(struct sys_device *sysdev, |
| 533 | struct sysdev_attribute *attr, |
| 534 | const char *buf, size_t size) |
| 535 | { |
| 536 | struct sysdev_ext_attribute *ea = to_ext_attr(attr); |
| 537 | char *end; |
| 538 | long new = simple_strtol(buf, &end, 0); |
| 539 | if (end == buf || new > INT_MAX || new < INT_MIN) |
| 540 | return -EINVAL; |
| 541 | *(int *)(ea->var) = new; |
Andi Kleen | 4e318d7 | 2008-10-13 12:03:03 +0200 | [diff] [blame] | 542 | /* Always return full write size even if we didn't consume all */ |
| 543 | return size; |
Andi Kleen | 9800794 | 2008-07-01 18:48:42 +0200 | [diff] [blame] | 544 | } |
| 545 | EXPORT_SYMBOL_GPL(sysdev_store_int); |
| 546 | |
| 547 | ssize_t sysdev_show_int(struct sys_device *sysdev, |
| 548 | struct sysdev_attribute *attr, |
| 549 | char *buf) |
| 550 | { |
| 551 | struct sysdev_ext_attribute *ea = to_ext_attr(attr); |
| 552 | return snprintf(buf, PAGE_SIZE, "%d\n", *(int *)(ea->var)); |
| 553 | } |
| 554 | EXPORT_SYMBOL_GPL(sysdev_show_int); |
| 555 | |