Commit | Line | Data |
---|---|---|
ddae41be GKH |
1 | /* |
2 | * drivers/usb/driver.c - most of the driver model stuff for usb | |
3 | * | |
4 | * (C) Copyright 2005 Greg Kroah-Hartman <gregkh@suse.de> | |
5 | * | |
6 | * based on drivers/usb/usb.c which had the following copyrights: | |
7 | * (C) Copyright Linus Torvalds 1999 | |
8 | * (C) Copyright Johannes Erdfelt 1999-2001 | |
9 | * (C) Copyright Andreas Gal 1999 | |
10 | * (C) Copyright Gregory P. Smith 1999 | |
11 | * (C) Copyright Deti Fliegl 1999 (new USB architecture) | |
12 | * (C) Copyright Randy Dunlap 2000 | |
13 | * (C) Copyright David Brownell 2000-2004 | |
14 | * (C) Copyright Yggdrasil Computing, Inc. 2000 | |
15 | * (usb_device_id matching changes by Adam J. Richter) | |
16 | * (C) Copyright Greg Kroah-Hartman 2002-2003 | |
17 | * | |
18 | * NOTE! This is not actually a driver at all, rather this is | |
19 | * just a collection of helper routines that implement the | |
36e56a34 AS |
20 | * matching, probing, releasing, suspending and resuming for |
21 | * real drivers. | |
ddae41be GKH |
22 | * |
23 | */ | |
24 | ||
ddae41be | 25 | #include <linux/device.h> |
5a0e3ad6 | 26 | #include <linux/slab.h> |
ddae41be | 27 | #include <linux/usb.h> |
6bc6cff5 | 28 | #include <linux/usb/quirks.h> |
27729aad | 29 | #include <linux/usb/hcd.h> |
9bbdf1e0 | 30 | #include <linux/pm_runtime.h> |
27729aad | 31 | |
ddae41be GKH |
32 | #include "usb.h" |
33 | ||
20dfdad7 | 34 | |
733260ff GKH |
35 | #ifdef CONFIG_HOTPLUG |
36 | ||
37 | /* | |
38 | * Adds a new dynamic USBdevice ID to this driver, | |
39 | * and cause the driver to probe for all devices again. | |
40 | */ | |
93bacefc GKH |
41 | ssize_t usb_store_new_id(struct usb_dynids *dynids, |
42 | struct device_driver *driver, | |
43 | const char *buf, size_t count) | |
733260ff | 44 | { |
733260ff GKH |
45 | struct usb_dynid *dynid; |
46 | u32 idVendor = 0; | |
47 | u32 idProduct = 0; | |
48 | int fields = 0; | |
1b21d5e1 | 49 | int retval = 0; |
733260ff GKH |
50 | |
51 | fields = sscanf(buf, "%x %x", &idVendor, &idProduct); | |
52 | if (fields < 2) | |
53 | return -EINVAL; | |
54 | ||
55 | dynid = kzalloc(sizeof(*dynid), GFP_KERNEL); | |
56 | if (!dynid) | |
57 | return -ENOMEM; | |
58 | ||
59 | INIT_LIST_HEAD(&dynid->node); | |
60 | dynid->id.idVendor = idVendor; | |
61 | dynid->id.idProduct = idProduct; | |
62 | dynid->id.match_flags = USB_DEVICE_ID_MATCH_DEVICE; | |
63 | ||
93bacefc | 64 | spin_lock(&dynids->lock); |
e5dd0115 | 65 | list_add_tail(&dynid->node, &dynids->list); |
93bacefc | 66 | spin_unlock(&dynids->lock); |
733260ff GKH |
67 | |
68 | if (get_driver(driver)) { | |
1b21d5e1 | 69 | retval = driver_attach(driver); |
733260ff GKH |
70 | put_driver(driver); |
71 | } | |
72 | ||
1b21d5e1 GKH |
73 | if (retval) |
74 | return retval; | |
733260ff GKH |
75 | return count; |
76 | } | |
93bacefc GKH |
77 | EXPORT_SYMBOL_GPL(usb_store_new_id); |
78 | ||
79 | static ssize_t store_new_id(struct device_driver *driver, | |
80 | const char *buf, size_t count) | |
81 | { | |
82 | struct usb_driver *usb_drv = to_usb_driver(driver); | |
83 | ||
84 | return usb_store_new_id(&usb_drv->dynids, driver, buf, count); | |
85 | } | |
733260ff GKH |
86 | static DRIVER_ATTR(new_id, S_IWUSR, NULL, store_new_id); |
87 | ||
0c7a2b72 CR |
88 | /** |
89 | * store_remove_id - remove a USB device ID from this driver | |
90 | * @driver: target device driver | |
91 | * @buf: buffer for scanning device ID data | |
92 | * @count: input size | |
93 | * | |
94 | * Removes a dynamic usb device ID from this driver. | |
95 | */ | |
96 | static ssize_t | |
97 | store_remove_id(struct device_driver *driver, const char *buf, size_t count) | |
98 | { | |
99 | struct usb_dynid *dynid, *n; | |
100 | struct usb_driver *usb_driver = to_usb_driver(driver); | |
101 | u32 idVendor = 0; | |
102 | u32 idProduct = 0; | |
103 | int fields = 0; | |
104 | int retval = 0; | |
105 | ||
106 | fields = sscanf(buf, "%x %x", &idVendor, &idProduct); | |
107 | if (fields < 2) | |
108 | return -EINVAL; | |
109 | ||
110 | spin_lock(&usb_driver->dynids.lock); | |
111 | list_for_each_entry_safe(dynid, n, &usb_driver->dynids.list, node) { | |
112 | struct usb_device_id *id = &dynid->id; | |
113 | if ((id->idVendor == idVendor) && | |
114 | (id->idProduct == idProduct)) { | |
115 | list_del(&dynid->node); | |
116 | kfree(dynid); | |
117 | retval = 0; | |
118 | break; | |
119 | } | |
120 | } | |
121 | spin_unlock(&usb_driver->dynids.lock); | |
122 | ||
123 | if (retval) | |
124 | return retval; | |
125 | return count; | |
126 | } | |
127 | static DRIVER_ATTR(remove_id, S_IWUSR, NULL, store_remove_id); | |
128 | ||
733260ff GKH |
129 | static int usb_create_newid_file(struct usb_driver *usb_drv) |
130 | { | |
131 | int error = 0; | |
132 | ||
ba9dc657 GKH |
133 | if (usb_drv->no_dynamic_id) |
134 | goto exit; | |
135 | ||
733260ff | 136 | if (usb_drv->probe != NULL) |
15147ffd GKH |
137 | error = driver_create_file(&usb_drv->drvwrap.driver, |
138 | &driver_attr_new_id); | |
ba9dc657 | 139 | exit: |
733260ff GKH |
140 | return error; |
141 | } | |
142 | ||
ba9dc657 GKH |
143 | static void usb_remove_newid_file(struct usb_driver *usb_drv) |
144 | { | |
145 | if (usb_drv->no_dynamic_id) | |
146 | return; | |
147 | ||
148 | if (usb_drv->probe != NULL) | |
15147ffd GKH |
149 | driver_remove_file(&usb_drv->drvwrap.driver, |
150 | &driver_attr_new_id); | |
ba9dc657 GKH |
151 | } |
152 | ||
0c7a2b72 CR |
153 | static int |
154 | usb_create_removeid_file(struct usb_driver *drv) | |
155 | { | |
156 | int error = 0; | |
157 | if (drv->probe != NULL) | |
158 | error = driver_create_file(&drv->drvwrap.driver, | |
159 | &driver_attr_remove_id); | |
160 | return error; | |
161 | } | |
162 | ||
163 | static void usb_remove_removeid_file(struct usb_driver *drv) | |
164 | { | |
165 | driver_remove_file(&drv->drvwrap.driver, &driver_attr_remove_id); | |
166 | } | |
167 | ||
733260ff GKH |
168 | static void usb_free_dynids(struct usb_driver *usb_drv) |
169 | { | |
170 | struct usb_dynid *dynid, *n; | |
171 | ||
172 | spin_lock(&usb_drv->dynids.lock); | |
173 | list_for_each_entry_safe(dynid, n, &usb_drv->dynids.list, node) { | |
174 | list_del(&dynid->node); | |
175 | kfree(dynid); | |
176 | } | |
177 | spin_unlock(&usb_drv->dynids.lock); | |
178 | } | |
179 | #else | |
180 | static inline int usb_create_newid_file(struct usb_driver *usb_drv) | |
181 | { | |
182 | return 0; | |
183 | } | |
184 | ||
ba9dc657 GKH |
185 | static void usb_remove_newid_file(struct usb_driver *usb_drv) |
186 | { | |
187 | } | |
188 | ||
0c7a2b72 CR |
189 | static int |
190 | usb_create_removeid_file(struct usb_driver *drv) | |
191 | { | |
192 | return 0; | |
193 | } | |
194 | ||
195 | static void usb_remove_removeid_file(struct usb_driver *drv) | |
196 | { | |
197 | } | |
198 | ||
733260ff GKH |
199 | static inline void usb_free_dynids(struct usb_driver *usb_drv) |
200 | { | |
201 | } | |
202 | #endif | |
203 | ||
204 | static const struct usb_device_id *usb_match_dynamic_id(struct usb_interface *intf, | |
205 | struct usb_driver *drv) | |
206 | { | |
207 | struct usb_dynid *dynid; | |
208 | ||
209 | spin_lock(&drv->dynids.lock); | |
210 | list_for_each_entry(dynid, &drv->dynids.list, node) { | |
211 | if (usb_match_one_id(intf, &dynid->id)) { | |
212 | spin_unlock(&drv->dynids.lock); | |
213 | return &dynid->id; | |
214 | } | |
215 | } | |
216 | spin_unlock(&drv->dynids.lock); | |
217 | return NULL; | |
218 | } | |
219 | ||
220 | ||
8bb54ab5 AS |
221 | /* called from driver core with dev locked */ |
222 | static int usb_probe_device(struct device *dev) | |
223 | { | |
224 | struct usb_device_driver *udriver = to_usb_device_driver(dev->driver); | |
55129666 | 225 | struct usb_device *udev = to_usb_device(dev); |
9bbdf1e0 | 226 | int error = 0; |
8bb54ab5 | 227 | |
441b62c1 | 228 | dev_dbg(dev, "%s\n", __func__); |
8bb54ab5 | 229 | |
8bb54ab5 AS |
230 | /* TODO: Add real matching code */ |
231 | ||
645daaab AS |
232 | /* The device should always appear to be in use |
233 | * unless the driver suports autosuspend. | |
234 | */ | |
9bbdf1e0 AS |
235 | if (!udriver->supports_autosuspend) |
236 | error = usb_autoresume_device(udev); | |
645daaab | 237 | |
9bbdf1e0 AS |
238 | if (!error) |
239 | error = udriver->probe(udev); | |
8bb54ab5 AS |
240 | return error; |
241 | } | |
242 | ||
243 | /* called from driver core with dev locked */ | |
244 | static int usb_unbind_device(struct device *dev) | |
245 | { | |
9bbdf1e0 | 246 | struct usb_device *udev = to_usb_device(dev); |
8bb54ab5 AS |
247 | struct usb_device_driver *udriver = to_usb_device_driver(dev->driver); |
248 | ||
9bbdf1e0 AS |
249 | udriver->disconnect(udev); |
250 | if (!udriver->supports_autosuspend) | |
251 | usb_autosuspend_device(udev); | |
8bb54ab5 AS |
252 | return 0; |
253 | } | |
254 | ||
dc023dce IPG |
255 | /* |
256 | * Cancel any pending scheduled resets | |
257 | * | |
258 | * [see usb_queue_reset_device()] | |
259 | * | |
260 | * Called after unconfiguring / when releasing interfaces. See | |
261 | * comments in __usb_queue_reset_device() regarding | |
262 | * udev->reset_running. | |
263 | */ | |
264 | static void usb_cancel_queued_reset(struct usb_interface *iface) | |
265 | { | |
266 | if (iface->reset_running == 0) | |
267 | cancel_work_sync(&iface->reset_ws); | |
268 | } | |
8bb54ab5 AS |
269 | |
270 | /* called from driver core with dev locked */ | |
ddae41be GKH |
271 | static int usb_probe_interface(struct device *dev) |
272 | { | |
8bb54ab5 | 273 | struct usb_driver *driver = to_usb_driver(dev->driver); |
55129666 KS |
274 | struct usb_interface *intf = to_usb_interface(dev); |
275 | struct usb_device *udev = interface_to_usbdev(intf); | |
ddae41be GKH |
276 | const struct usb_device_id *id; |
277 | int error = -ENODEV; | |
278 | ||
441b62c1 | 279 | dev_dbg(dev, "%s\n", __func__); |
ddae41be | 280 | |
78d9a487 | 281 | intf->needs_binding = 0; |
ddae41be | 282 | |
7cbe5dca | 283 | if (usb_device_is_owned(udev)) |
0f3dda9f | 284 | return error; |
7cbe5dca | 285 | |
2c044a48 GKH |
286 | if (udev->authorized == 0) { |
287 | dev_err(&intf->dev, "Device is not authorized for usage\n"); | |
0f3dda9f | 288 | return error; |
2c044a48 | 289 | } |
72230abb | 290 | |
ddae41be | 291 | id = usb_match_id(intf, driver->id_table); |
733260ff GKH |
292 | if (!id) |
293 | id = usb_match_dynamic_id(intf, driver); | |
0f3dda9f AS |
294 | if (!id) |
295 | return error; | |
55151d7d | 296 | |
0f3dda9f AS |
297 | dev_dbg(dev, "%s - got id\n", __func__); |
298 | ||
299 | error = usb_autoresume_device(udev); | |
300 | if (error) | |
301 | return error; | |
302 | ||
0f3dda9f | 303 | intf->condition = USB_INTERFACE_BINDING; |
645daaab | 304 | |
571dc79d | 305 | /* Probed interfaces are initially active. They are |
9bbdf1e0 AS |
306 | * runtime-PM-enabled only if the driver has autosuspend support. |
307 | * They are sensitive to their children's power states. | |
0f3dda9f | 308 | */ |
9bbdf1e0 AS |
309 | pm_runtime_set_active(dev); |
310 | pm_suspend_ignore_children(dev, false); | |
311 | if (driver->supports_autosuspend) | |
312 | pm_runtime_enable(dev); | |
0f3dda9f AS |
313 | |
314 | /* Carry out a deferred switch to altsetting 0 */ | |
315 | if (intf->needs_altsetting0) { | |
316 | error = usb_set_interface(udev, intf->altsetting[0]. | |
317 | desc.bInterfaceNumber, 0); | |
318 | if (error < 0) | |
319 | goto err; | |
320 | intf->needs_altsetting0 = 0; | |
ddae41be GKH |
321 | } |
322 | ||
0f3dda9f AS |
323 | error = driver->probe(intf, id); |
324 | if (error) | |
325 | goto err; | |
326 | ||
327 | intf->condition = USB_INTERFACE_BOUND; | |
328 | usb_autosuspend_device(udev); | |
ddae41be | 329 | return error; |
1e5ea5e3 | 330 | |
0f3dda9f | 331 | err: |
1e5ea5e3 ON |
332 | intf->needs_remote_wakeup = 0; |
333 | intf->condition = USB_INTERFACE_UNBOUND; | |
334 | usb_cancel_queued_reset(intf); | |
9bbdf1e0 AS |
335 | |
336 | /* Unbound interfaces are always runtime-PM-disabled and -suspended */ | |
337 | pm_runtime_disable(dev); | |
338 | pm_runtime_set_suspended(dev); | |
339 | ||
1e5ea5e3 ON |
340 | usb_autosuspend_device(udev); |
341 | return error; | |
ddae41be GKH |
342 | } |
343 | ||
8bb54ab5 | 344 | /* called from driver core with dev locked */ |
ddae41be GKH |
345 | static int usb_unbind_interface(struct device *dev) |
346 | { | |
8bb54ab5 | 347 | struct usb_driver *driver = to_usb_driver(dev->driver); |
ddae41be | 348 | struct usb_interface *intf = to_usb_interface(dev); |
645daaab | 349 | struct usb_device *udev; |
1e5ea5e3 | 350 | int error, r; |
ddae41be GKH |
351 | |
352 | intf->condition = USB_INTERFACE_UNBINDING; | |
353 | ||
645daaab AS |
354 | /* Autoresume for set_interface call below */ |
355 | udev = interface_to_usbdev(intf); | |
94fcda1f | 356 | error = usb_autoresume_device(udev); |
645daaab | 357 | |
9da82bd4 AS |
358 | /* Terminate all URBs for this interface unless the driver |
359 | * supports "soft" unbinding. | |
360 | */ | |
361 | if (!driver->soft_unbind) | |
ddeac4e7 | 362 | usb_disable_interface(udev, intf, false); |
ddae41be | 363 | |
8bb54ab5 | 364 | driver->disconnect(intf); |
dc023dce | 365 | usb_cancel_queued_reset(intf); |
ddae41be | 366 | |
55151d7d AS |
367 | /* Reset other interface state. |
368 | * We cannot do a Set-Interface if the device is suspended or | |
369 | * if it is prepared for a system sleep (since installing a new | |
370 | * altsetting means creating new endpoint device entries). | |
371 | * When either of these happens, defer the Set-Interface. | |
372 | */ | |
2caf7fcd AS |
373 | if (intf->cur_altsetting->desc.bAlternateSetting == 0) { |
374 | /* Already in altsetting 0 so skip Set-Interface. | |
375 | * Just re-enable it without affecting the endpoint toggles. | |
376 | */ | |
377 | usb_enable_interface(udev, intf, false); | |
1e5ea5e3 ON |
378 | } else if (!error && intf->dev.power.status == DPM_ON) { |
379 | r = usb_set_interface(udev, intf->altsetting[0]. | |
55151d7d | 380 | desc.bInterfaceNumber, 0); |
1e5ea5e3 ON |
381 | if (r < 0) |
382 | intf->needs_altsetting0 = 1; | |
383 | } else { | |
55151d7d | 384 | intf->needs_altsetting0 = 1; |
1e5ea5e3 | 385 | } |
ddae41be | 386 | usb_set_intfdata(intf, NULL); |
645daaab | 387 | |
ddae41be | 388 | intf->condition = USB_INTERFACE_UNBOUND; |
645daaab AS |
389 | intf->needs_remote_wakeup = 0; |
390 | ||
9bbdf1e0 AS |
391 | /* Unbound interfaces are always runtime-PM-disabled and -suspended */ |
392 | pm_runtime_disable(dev); | |
393 | pm_runtime_set_suspended(dev); | |
394 | ||
395 | /* Undo any residual pm_autopm_get_interface_* calls */ | |
396 | for (r = atomic_read(&intf->pm_usage_cnt); r > 0; --r) | |
397 | usb_autopm_put_interface_no_suspend(intf); | |
398 | atomic_set(&intf->pm_usage_cnt, 0); | |
399 | ||
645daaab | 400 | if (!error) |
94fcda1f | 401 | usb_autosuspend_device(udev); |
ddae41be GKH |
402 | |
403 | return 0; | |
404 | } | |
405 | ||
36e56a34 AS |
406 | /** |
407 | * usb_driver_claim_interface - bind a driver to an interface | |
408 | * @driver: the driver to be bound | |
409 | * @iface: the interface to which it will be bound; must be in the | |
410 | * usb device's active configuration | |
411 | * @priv: driver data associated with that interface | |
412 | * | |
413 | * This is used by usb device drivers that need to claim more than one | |
414 | * interface on a device when probing (audio and acm are current examples). | |
415 | * No device driver should directly modify internal usb_interface or | |
416 | * usb_device structure members. | |
417 | * | |
418 | * Few drivers should need to use this routine, since the most natural | |
419 | * way to bind to an interface is to return the private data from | |
420 | * the driver's probe() method. | |
421 | * | |
341487a8 GKH |
422 | * Callers must own the device lock, so driver probe() entries don't need |
423 | * extra locking, but other call contexts may need to explicitly claim that | |
424 | * lock. | |
36e56a34 AS |
425 | */ |
426 | int usb_driver_claim_interface(struct usb_driver *driver, | |
2c044a48 | 427 | struct usb_interface *iface, void *priv) |
36e56a34 AS |
428 | { |
429 | struct device *dev = &iface->dev; | |
1b21d5e1 | 430 | int retval = 0; |
36e56a34 AS |
431 | |
432 | if (dev->driver) | |
433 | return -EBUSY; | |
434 | ||
8bb54ab5 | 435 | dev->driver = &driver->drvwrap.driver; |
36e56a34 | 436 | usb_set_intfdata(iface, priv); |
78d9a487 | 437 | iface->needs_binding = 0; |
645daaab | 438 | |
36e56a34 | 439 | iface->condition = USB_INTERFACE_BOUND; |
9bbdf1e0 | 440 | |
571dc79d | 441 | /* Claimed interfaces are initially inactive (suspended). They are |
9bbdf1e0 AS |
442 | * runtime-PM-enabled only if the driver has autosuspend support. |
443 | * They are sensitive to their children's power states. | |
444 | */ | |
571dc79d | 445 | pm_runtime_set_suspended(dev); |
9bbdf1e0 AS |
446 | pm_suspend_ignore_children(dev, false); |
447 | if (driver->supports_autosuspend) | |
448 | pm_runtime_enable(dev); | |
36e56a34 AS |
449 | |
450 | /* if interface was already added, bind now; else let | |
451 | * the future device_add() bind it, bypassing probe() | |
452 | */ | |
453 | if (device_is_registered(dev)) | |
1b21d5e1 | 454 | retval = device_bind_driver(dev); |
36e56a34 | 455 | |
1b21d5e1 | 456 | return retval; |
36e56a34 | 457 | } |
782e70c6 | 458 | EXPORT_SYMBOL_GPL(usb_driver_claim_interface); |
36e56a34 AS |
459 | |
460 | /** | |
461 | * usb_driver_release_interface - unbind a driver from an interface | |
462 | * @driver: the driver to be unbound | |
463 | * @iface: the interface from which it will be unbound | |
464 | * | |
465 | * This can be used by drivers to release an interface without waiting | |
466 | * for their disconnect() methods to be called. In typical cases this | |
467 | * also causes the driver disconnect() method to be called. | |
468 | * | |
469 | * This call is synchronous, and may not be used in an interrupt context. | |
341487a8 GKH |
470 | * Callers must own the device lock, so driver disconnect() entries don't |
471 | * need extra locking, but other call contexts may need to explicitly claim | |
472 | * that lock. | |
36e56a34 AS |
473 | */ |
474 | void usb_driver_release_interface(struct usb_driver *driver, | |
475 | struct usb_interface *iface) | |
476 | { | |
477 | struct device *dev = &iface->dev; | |
478 | ||
479 | /* this should never happen, don't release something that's not ours */ | |
8bb54ab5 | 480 | if (!dev->driver || dev->driver != &driver->drvwrap.driver) |
36e56a34 AS |
481 | return; |
482 | ||
483 | /* don't release from within disconnect() */ | |
484 | if (iface->condition != USB_INTERFACE_BOUND) | |
485 | return; | |
91f8d063 | 486 | iface->condition = USB_INTERFACE_UNBINDING; |
36e56a34 | 487 | |
91f8d063 AS |
488 | /* Release via the driver core only if the interface |
489 | * has already been registered | |
490 | */ | |
36e56a34 | 491 | if (device_is_registered(dev)) { |
36e56a34 | 492 | device_release_driver(dev); |
dc023dce | 493 | } else { |
8e9394ce | 494 | device_lock(dev); |
91f8d063 AS |
495 | usb_unbind_interface(dev); |
496 | dev->driver = NULL; | |
8e9394ce | 497 | device_unlock(dev); |
36e56a34 | 498 | } |
36e56a34 | 499 | } |
782e70c6 | 500 | EXPORT_SYMBOL_GPL(usb_driver_release_interface); |
36e56a34 | 501 | |
733260ff | 502 | /* returns 0 if no match, 1 if match */ |
bb417020 | 503 | int usb_match_device(struct usb_device *dev, const struct usb_device_id *id) |
733260ff | 504 | { |
733260ff GKH |
505 | if ((id->match_flags & USB_DEVICE_ID_MATCH_VENDOR) && |
506 | id->idVendor != le16_to_cpu(dev->descriptor.idVendor)) | |
507 | return 0; | |
508 | ||
509 | if ((id->match_flags & USB_DEVICE_ID_MATCH_PRODUCT) && | |
510 | id->idProduct != le16_to_cpu(dev->descriptor.idProduct)) | |
511 | return 0; | |
512 | ||
513 | /* No need to test id->bcdDevice_lo != 0, since 0 is never | |
514 | greater than any unsigned number. */ | |
515 | if ((id->match_flags & USB_DEVICE_ID_MATCH_DEV_LO) && | |
516 | (id->bcdDevice_lo > le16_to_cpu(dev->descriptor.bcdDevice))) | |
517 | return 0; | |
518 | ||
519 | if ((id->match_flags & USB_DEVICE_ID_MATCH_DEV_HI) && | |
520 | (id->bcdDevice_hi < le16_to_cpu(dev->descriptor.bcdDevice))) | |
521 | return 0; | |
522 | ||
523 | if ((id->match_flags & USB_DEVICE_ID_MATCH_DEV_CLASS) && | |
524 | (id->bDeviceClass != dev->descriptor.bDeviceClass)) | |
525 | return 0; | |
526 | ||
527 | if ((id->match_flags & USB_DEVICE_ID_MATCH_DEV_SUBCLASS) && | |
2c044a48 | 528 | (id->bDeviceSubClass != dev->descriptor.bDeviceSubClass)) |
733260ff GKH |
529 | return 0; |
530 | ||
531 | if ((id->match_flags & USB_DEVICE_ID_MATCH_DEV_PROTOCOL) && | |
532 | (id->bDeviceProtocol != dev->descriptor.bDeviceProtocol)) | |
533 | return 0; | |
534 | ||
bb417020 GKH |
535 | return 1; |
536 | } | |
537 | ||
538 | /* returns 0 if no match, 1 if match */ | |
539 | int usb_match_one_id(struct usb_interface *interface, | |
540 | const struct usb_device_id *id) | |
541 | { | |
542 | struct usb_host_interface *intf; | |
543 | struct usb_device *dev; | |
544 | ||
545 | /* proc_connectinfo in devio.c may call us with id == NULL. */ | |
546 | if (id == NULL) | |
547 | return 0; | |
548 | ||
549 | intf = interface->cur_altsetting; | |
550 | dev = interface_to_usbdev(interface); | |
551 | ||
552 | if (!usb_match_device(dev, id)) | |
553 | return 0; | |
554 | ||
93c8bf45 AS |
555 | /* The interface class, subclass, and protocol should never be |
556 | * checked for a match if the device class is Vendor Specific, | |
557 | * unless the match record specifies the Vendor ID. */ | |
558 | if (dev->descriptor.bDeviceClass == USB_CLASS_VENDOR_SPEC && | |
559 | !(id->match_flags & USB_DEVICE_ID_MATCH_VENDOR) && | |
560 | (id->match_flags & (USB_DEVICE_ID_MATCH_INT_CLASS | | |
561 | USB_DEVICE_ID_MATCH_INT_SUBCLASS | | |
562 | USB_DEVICE_ID_MATCH_INT_PROTOCOL))) | |
563 | return 0; | |
564 | ||
733260ff GKH |
565 | if ((id->match_flags & USB_DEVICE_ID_MATCH_INT_CLASS) && |
566 | (id->bInterfaceClass != intf->desc.bInterfaceClass)) | |
567 | return 0; | |
568 | ||
569 | if ((id->match_flags & USB_DEVICE_ID_MATCH_INT_SUBCLASS) && | |
570 | (id->bInterfaceSubClass != intf->desc.bInterfaceSubClass)) | |
571 | return 0; | |
572 | ||
573 | if ((id->match_flags & USB_DEVICE_ID_MATCH_INT_PROTOCOL) && | |
574 | (id->bInterfaceProtocol != intf->desc.bInterfaceProtocol)) | |
575 | return 0; | |
576 | ||
577 | return 1; | |
578 | } | |
93bacefc GKH |
579 | EXPORT_SYMBOL_GPL(usb_match_one_id); |
580 | ||
ddae41be GKH |
581 | /** |
582 | * usb_match_id - find first usb_device_id matching device or interface | |
583 | * @interface: the interface of interest | |
584 | * @id: array of usb_device_id structures, terminated by zero entry | |
585 | * | |
586 | * usb_match_id searches an array of usb_device_id's and returns | |
587 | * the first one matching the device or interface, or null. | |
588 | * This is used when binding (or rebinding) a driver to an interface. | |
589 | * Most USB device drivers will use this indirectly, through the usb core, | |
590 | * but some layered driver frameworks use it directly. | |
591 | * These device tables are exported with MODULE_DEVICE_TABLE, through | |
592 | * modutils, to support the driver loading functionality of USB hotplugging. | |
593 | * | |
594 | * What Matches: | |
595 | * | |
596 | * The "match_flags" element in a usb_device_id controls which | |
597 | * members are used. If the corresponding bit is set, the | |
598 | * value in the device_id must match its corresponding member | |
599 | * in the device or interface descriptor, or else the device_id | |
600 | * does not match. | |
601 | * | |
602 | * "driver_info" is normally used only by device drivers, | |
603 | * but you can create a wildcard "matches anything" usb_device_id | |
604 | * as a driver's "modules.usbmap" entry if you provide an id with | |
605 | * only a nonzero "driver_info" field. If you do this, the USB device | |
606 | * driver's probe() routine should use additional intelligence to | |
607 | * decide whether to bind to the specified interface. | |
608 | * | |
609 | * What Makes Good usb_device_id Tables: | |
610 | * | |
611 | * The match algorithm is very simple, so that intelligence in | |
612 | * driver selection must come from smart driver id records. | |
613 | * Unless you have good reasons to use another selection policy, | |
614 | * provide match elements only in related groups, and order match | |
615 | * specifiers from specific to general. Use the macros provided | |
616 | * for that purpose if you can. | |
617 | * | |
618 | * The most specific match specifiers use device descriptor | |
619 | * data. These are commonly used with product-specific matches; | |
620 | * the USB_DEVICE macro lets you provide vendor and product IDs, | |
621 | * and you can also match against ranges of product revisions. | |
622 | * These are widely used for devices with application or vendor | |
623 | * specific bDeviceClass values. | |
624 | * | |
625 | * Matches based on device class/subclass/protocol specifications | |
626 | * are slightly more general; use the USB_DEVICE_INFO macro, or | |
627 | * its siblings. These are used with single-function devices | |
628 | * where bDeviceClass doesn't specify that each interface has | |
629 | * its own class. | |
630 | * | |
631 | * Matches based on interface class/subclass/protocol are the | |
632 | * most general; they let drivers bind to any interface on a | |
633 | * multiple-function device. Use the USB_INTERFACE_INFO | |
634 | * macro, or its siblings, to match class-per-interface style | |
93c8bf45 AS |
635 | * devices (as recorded in bInterfaceClass). |
636 | * | |
637 | * Note that an entry created by USB_INTERFACE_INFO won't match | |
638 | * any interface if the device class is set to Vendor-Specific. | |
639 | * This is deliberate; according to the USB spec the meanings of | |
640 | * the interface class/subclass/protocol for these devices are also | |
641 | * vendor-specific, and hence matching against a standard product | |
642 | * class wouldn't work anyway. If you really want to use an | |
643 | * interface-based match for such a device, create a match record | |
644 | * that also specifies the vendor ID. (Unforunately there isn't a | |
645 | * standard macro for creating records like this.) | |
ddae41be GKH |
646 | * |
647 | * Within those groups, remember that not all combinations are | |
648 | * meaningful. For example, don't give a product version range | |
649 | * without vendor and product IDs; or specify a protocol without | |
650 | * its associated class and subclass. | |
651 | */ | |
652 | const struct usb_device_id *usb_match_id(struct usb_interface *interface, | |
653 | const struct usb_device_id *id) | |
654 | { | |
ddae41be GKH |
655 | /* proc_connectinfo in devio.c may call us with id == NULL. */ |
656 | if (id == NULL) | |
657 | return NULL; | |
658 | ||
ddae41be GKH |
659 | /* It is important to check that id->driver_info is nonzero, |
660 | since an entry that is all zeroes except for a nonzero | |
661 | id->driver_info is the way to create an entry that | |
662 | indicates that the driver want to examine every | |
663 | device and interface. */ | |
de6f92b9 GKH |
664 | for (; id->idVendor || id->idProduct || id->bDeviceClass || |
665 | id->bInterfaceClass || id->driver_info; id++) { | |
733260ff GKH |
666 | if (usb_match_one_id(interface, id)) |
667 | return id; | |
ddae41be GKH |
668 | } |
669 | ||
670 | return NULL; | |
671 | } | |
782e70c6 | 672 | EXPORT_SYMBOL_GPL(usb_match_id); |
ddae41be | 673 | |
8bb22d2b | 674 | static int usb_device_match(struct device *dev, struct device_driver *drv) |
ddae41be | 675 | { |
8bb54ab5 AS |
676 | /* devices and interfaces are handled separately */ |
677 | if (is_usb_device(dev)) { | |
ddae41be | 678 | |
8bb54ab5 AS |
679 | /* interface drivers never match devices */ |
680 | if (!is_usb_device_driver(drv)) | |
681 | return 0; | |
ddae41be | 682 | |
8bb54ab5 | 683 | /* TODO: Add real matching code */ |
ddae41be GKH |
684 | return 1; |
685 | ||
55129666 | 686 | } else if (is_usb_interface(dev)) { |
8bb54ab5 AS |
687 | struct usb_interface *intf; |
688 | struct usb_driver *usb_drv; | |
689 | const struct usb_device_id *id; | |
690 | ||
691 | /* device drivers never match interfaces */ | |
692 | if (is_usb_device_driver(drv)) | |
693 | return 0; | |
694 | ||
695 | intf = to_usb_interface(dev); | |
696 | usb_drv = to_usb_driver(drv); | |
697 | ||
698 | id = usb_match_id(intf, usb_drv->id_table); | |
699 | if (id) | |
700 | return 1; | |
701 | ||
702 | id = usb_match_dynamic_id(intf, usb_drv); | |
703 | if (id) | |
704 | return 1; | |
705 | } | |
706 | ||
ddae41be GKH |
707 | return 0; |
708 | } | |
709 | ||
36e56a34 | 710 | #ifdef CONFIG_HOTPLUG |
7eff2e7a | 711 | static int usb_uevent(struct device *dev, struct kobj_uevent_env *env) |
36e56a34 | 712 | { |
36e56a34 | 713 | struct usb_device *usb_dev; |
36e56a34 | 714 | |
55129666 | 715 | if (is_usb_device(dev)) { |
782da727 | 716 | usb_dev = to_usb_device(dev); |
55129666 | 717 | } else if (is_usb_interface(dev)) { |
9f8b17e6 | 718 | struct usb_interface *intf = to_usb_interface(dev); |
55129666 | 719 | |
8bb54ab5 | 720 | usb_dev = interface_to_usbdev(intf); |
55129666 KS |
721 | } else { |
722 | return 0; | |
8bb54ab5 | 723 | } |
36e56a34 AS |
724 | |
725 | if (usb_dev->devnum < 0) { | |
cceffe93 | 726 | /* driver is often null here; dev_dbg() would oops */ |
7071a3ce | 727 | pr_debug("usb %s: already deleted?\n", dev_name(dev)); |
36e56a34 AS |
728 | return -ENODEV; |
729 | } | |
730 | if (!usb_dev->bus) { | |
7071a3ce | 731 | pr_debug("usb %s: bus removed?\n", dev_name(dev)); |
36e56a34 AS |
732 | return -ENODEV; |
733 | } | |
734 | ||
735 | #ifdef CONFIG_USB_DEVICEFS | |
736 | /* If this is available, userspace programs can directly read | |
737 | * all the device descriptors we don't tell them about. Or | |
9f8b17e6 | 738 | * act as usermode drivers. |
36e56a34 | 739 | */ |
7eff2e7a | 740 | if (add_uevent_var(env, "DEVICE=/proc/bus/usb/%03d/%03d", |
36e56a34 AS |
741 | usb_dev->bus->busnum, usb_dev->devnum)) |
742 | return -ENOMEM; | |
743 | #endif | |
744 | ||
745 | /* per-device configurations are common */ | |
7eff2e7a | 746 | if (add_uevent_var(env, "PRODUCT=%x/%x/%x", |
36e56a34 AS |
747 | le16_to_cpu(usb_dev->descriptor.idVendor), |
748 | le16_to_cpu(usb_dev->descriptor.idProduct), | |
749 | le16_to_cpu(usb_dev->descriptor.bcdDevice))) | |
750 | return -ENOMEM; | |
751 | ||
752 | /* class-based driver binding models */ | |
7eff2e7a | 753 | if (add_uevent_var(env, "TYPE=%d/%d/%d", |
36e56a34 AS |
754 | usb_dev->descriptor.bDeviceClass, |
755 | usb_dev->descriptor.bDeviceSubClass, | |
756 | usb_dev->descriptor.bDeviceProtocol)) | |
757 | return -ENOMEM; | |
758 | ||
36e56a34 AS |
759 | return 0; |
760 | } | |
761 | ||
762 | #else | |
763 | ||
7eff2e7a | 764 | static int usb_uevent(struct device *dev, struct kobj_uevent_env *env) |
36e56a34 AS |
765 | { |
766 | return -ENODEV; | |
767 | } | |
36e56a34 AS |
768 | #endif /* CONFIG_HOTPLUG */ |
769 | ||
ddae41be | 770 | /** |
8bb54ab5 AS |
771 | * usb_register_device_driver - register a USB device (not interface) driver |
772 | * @new_udriver: USB operations for the device driver | |
2143acc6 | 773 | * @owner: module owner of this driver. |
ddae41be | 774 | * |
8bb54ab5 AS |
775 | * Registers a USB device driver with the USB core. The list of |
776 | * unattached devices will be rescanned whenever a new driver is | |
777 | * added, allowing the new driver to attach to any recognized devices. | |
778 | * Returns a negative error code on failure and 0 on success. | |
779 | */ | |
780 | int usb_register_device_driver(struct usb_device_driver *new_udriver, | |
781 | struct module *owner) | |
782 | { | |
783 | int retval = 0; | |
784 | ||
785 | if (usb_disabled()) | |
786 | return -ENODEV; | |
787 | ||
788 | new_udriver->drvwrap.for_devices = 1; | |
789 | new_udriver->drvwrap.driver.name = (char *) new_udriver->name; | |
790 | new_udriver->drvwrap.driver.bus = &usb_bus_type; | |
791 | new_udriver->drvwrap.driver.probe = usb_probe_device; | |
792 | new_udriver->drvwrap.driver.remove = usb_unbind_device; | |
793 | new_udriver->drvwrap.driver.owner = owner; | |
794 | ||
795 | retval = driver_register(&new_udriver->drvwrap.driver); | |
796 | ||
797 | if (!retval) { | |
798 | pr_info("%s: registered new device driver %s\n", | |
799 | usbcore_name, new_udriver->name); | |
800 | usbfs_update_special(); | |
801 | } else { | |
802 | printk(KERN_ERR "%s: error %d registering device " | |
803 | " driver %s\n", | |
804 | usbcore_name, retval, new_udriver->name); | |
805 | } | |
806 | ||
807 | return retval; | |
808 | } | |
809 | EXPORT_SYMBOL_GPL(usb_register_device_driver); | |
810 | ||
811 | /** | |
812 | * usb_deregister_device_driver - unregister a USB device (not interface) driver | |
813 | * @udriver: USB operations of the device driver to unregister | |
814 | * Context: must be able to sleep | |
815 | * | |
816 | * Unlinks the specified driver from the internal USB driver list. | |
817 | */ | |
818 | void usb_deregister_device_driver(struct usb_device_driver *udriver) | |
819 | { | |
820 | pr_info("%s: deregistering device driver %s\n", | |
821 | usbcore_name, udriver->name); | |
822 | ||
823 | driver_unregister(&udriver->drvwrap.driver); | |
824 | usbfs_update_special(); | |
825 | } | |
826 | EXPORT_SYMBOL_GPL(usb_deregister_device_driver); | |
827 | ||
828 | /** | |
829 | * usb_register_driver - register a USB interface driver | |
830 | * @new_driver: USB operations for the interface driver | |
831 | * @owner: module owner of this driver. | |
892705a1 | 832 | * @mod_name: module name string |
8bb54ab5 AS |
833 | * |
834 | * Registers a USB interface driver with the USB core. The list of | |
835 | * unattached interfaces will be rescanned whenever a new driver is | |
836 | * added, allowing the new driver to attach to any recognized interfaces. | |
ddae41be GKH |
837 | * Returns a negative error code on failure and 0 on success. |
838 | * | |
839 | * NOTE: if you want your driver to use the USB major number, you must call | |
840 | * usb_register_dev() to enable that functionality. This function no longer | |
841 | * takes care of that. | |
842 | */ | |
80f745fb GKH |
843 | int usb_register_driver(struct usb_driver *new_driver, struct module *owner, |
844 | const char *mod_name) | |
ddae41be GKH |
845 | { |
846 | int retval = 0; | |
847 | ||
848 | if (usb_disabled()) | |
849 | return -ENODEV; | |
850 | ||
8bb54ab5 AS |
851 | new_driver->drvwrap.for_devices = 0; |
852 | new_driver->drvwrap.driver.name = (char *) new_driver->name; | |
853 | new_driver->drvwrap.driver.bus = &usb_bus_type; | |
854 | new_driver->drvwrap.driver.probe = usb_probe_interface; | |
855 | new_driver->drvwrap.driver.remove = usb_unbind_interface; | |
856 | new_driver->drvwrap.driver.owner = owner; | |
80f745fb | 857 | new_driver->drvwrap.driver.mod_name = mod_name; |
733260ff GKH |
858 | spin_lock_init(&new_driver->dynids.lock); |
859 | INIT_LIST_HEAD(&new_driver->dynids.list); | |
ddae41be | 860 | |
8bb54ab5 | 861 | retval = driver_register(&new_driver->drvwrap.driver); |
0c7a2b72 CR |
862 | if (retval) |
863 | goto out; | |
ddae41be | 864 | |
0c7a2b72 CR |
865 | usbfs_update_special(); |
866 | ||
867 | retval = usb_create_newid_file(new_driver); | |
868 | if (retval) | |
869 | goto out_newid; | |
870 | ||
871 | retval = usb_create_removeid_file(new_driver); | |
872 | if (retval) | |
873 | goto out_removeid; | |
874 | ||
875 | pr_info("%s: registered new interface driver %s\n", | |
ddae41be | 876 | usbcore_name, new_driver->name); |
ddae41be | 877 | |
0c7a2b72 | 878 | out: |
ddae41be | 879 | return retval; |
0c7a2b72 CR |
880 | |
881 | out_removeid: | |
882 | usb_remove_newid_file(new_driver); | |
883 | out_newid: | |
884 | driver_unregister(&new_driver->drvwrap.driver); | |
885 | ||
886 | printk(KERN_ERR "%s: error %d registering interface " | |
887 | " driver %s\n", | |
888 | usbcore_name, retval, new_driver->name); | |
889 | goto out; | |
ddae41be | 890 | } |
782e70c6 | 891 | EXPORT_SYMBOL_GPL(usb_register_driver); |
ddae41be GKH |
892 | |
893 | /** | |
8bb54ab5 AS |
894 | * usb_deregister - unregister a USB interface driver |
895 | * @driver: USB operations of the interface driver to unregister | |
ddae41be GKH |
896 | * Context: must be able to sleep |
897 | * | |
898 | * Unlinks the specified driver from the internal USB driver list. | |
899 | * | |
900 | * NOTE: If you called usb_register_dev(), you still need to call | |
901 | * usb_deregister_dev() to clean up your driver's allocated minor numbers, | |
902 | * this * call will no longer do it for you. | |
903 | */ | |
904 | void usb_deregister(struct usb_driver *driver) | |
905 | { | |
8bb54ab5 AS |
906 | pr_info("%s: deregistering interface driver %s\n", |
907 | usbcore_name, driver->name); | |
ddae41be | 908 | |
0c7a2b72 | 909 | usb_remove_removeid_file(driver); |
ba9dc657 | 910 | usb_remove_newid_file(driver); |
733260ff | 911 | usb_free_dynids(driver); |
8bb54ab5 | 912 | driver_unregister(&driver->drvwrap.driver); |
ddae41be GKH |
913 | |
914 | usbfs_update_special(); | |
915 | } | |
782e70c6 | 916 | EXPORT_SYMBOL_GPL(usb_deregister); |
36e56a34 | 917 | |
78d9a487 AS |
918 | /* Forced unbinding of a USB interface driver, either because |
919 | * it doesn't support pre_reset/post_reset/reset_resume or | |
920 | * because it doesn't support suspend/resume. | |
921 | * | |
922 | * The caller must hold @intf's device's lock, but not its pm_mutex | |
923 | * and not @intf->dev.sem. | |
924 | */ | |
925 | void usb_forced_unbind_intf(struct usb_interface *intf) | |
926 | { | |
927 | struct usb_driver *driver = to_usb_driver(intf->dev.driver); | |
928 | ||
929 | dev_dbg(&intf->dev, "forced unbind\n"); | |
930 | usb_driver_release_interface(driver, intf); | |
931 | ||
932 | /* Mark the interface for later rebinding */ | |
933 | intf->needs_binding = 1; | |
934 | } | |
935 | ||
936 | /* Delayed forced unbinding of a USB interface driver and scan | |
937 | * for rebinding. | |
938 | * | |
939 | * The caller must hold @intf's device's lock, but not its pm_mutex | |
940 | * and not @intf->dev.sem. | |
941 | * | |
5096aedc AS |
942 | * Note: Rebinds will be skipped if a system sleep transition is in |
943 | * progress and the PM "complete" callback hasn't occurred yet. | |
78d9a487 AS |
944 | */ |
945 | void usb_rebind_intf(struct usb_interface *intf) | |
946 | { | |
947 | int rc; | |
948 | ||
949 | /* Delayed unbind of an existing driver */ | |
950 | if (intf->dev.driver) { | |
951 | struct usb_driver *driver = | |
952 | to_usb_driver(intf->dev.driver); | |
953 | ||
954 | dev_dbg(&intf->dev, "forced unbind\n"); | |
955 | usb_driver_release_interface(driver, intf); | |
956 | } | |
957 | ||
958 | /* Try to rebind the interface */ | |
5096aedc AS |
959 | if (intf->dev.power.status == DPM_ON) { |
960 | intf->needs_binding = 0; | |
961 | rc = device_attach(&intf->dev); | |
962 | if (rc < 0) | |
963 | dev_warn(&intf->dev, "rebind failed: %d\n", rc); | |
964 | } | |
78d9a487 AS |
965 | } |
966 | ||
9ff78433 AS |
967 | #ifdef CONFIG_PM |
968 | ||
78d9a487 AS |
969 | #define DO_UNBIND 0 |
970 | #define DO_REBIND 1 | |
971 | ||
972 | /* Unbind drivers for @udev's interfaces that don't support suspend/resume, | |
973 | * or rebind interfaces that have been unbound, according to @action. | |
974 | * | |
975 | * The caller must hold @udev's device lock. | |
78d9a487 AS |
976 | */ |
977 | static void do_unbind_rebind(struct usb_device *udev, int action) | |
978 | { | |
979 | struct usb_host_config *config; | |
980 | int i; | |
981 | struct usb_interface *intf; | |
982 | struct usb_driver *drv; | |
983 | ||
984 | config = udev->actconfig; | |
985 | if (config) { | |
986 | for (i = 0; i < config->desc.bNumInterfaces; ++i) { | |
987 | intf = config->interface[i]; | |
988 | switch (action) { | |
989 | case DO_UNBIND: | |
990 | if (intf->dev.driver) { | |
991 | drv = to_usb_driver(intf->dev.driver); | |
992 | if (!drv->suspend || !drv->resume) | |
993 | usb_forced_unbind_intf(intf); | |
994 | } | |
995 | break; | |
996 | case DO_REBIND: | |
5096aedc | 997 | if (intf->needs_binding) |
78d9a487 | 998 | usb_rebind_intf(intf); |
78d9a487 AS |
999 | break; |
1000 | } | |
1001 | } | |
1002 | } | |
1003 | } | |
1004 | ||
d5ec1686 | 1005 | static int usb_suspend_device(struct usb_device *udev, pm_message_t msg) |
36e56a34 | 1006 | { |
782da727 | 1007 | struct usb_device_driver *udriver; |
2bf4086d | 1008 | int status = 0; |
36e56a34 | 1009 | |
114b368c AS |
1010 | if (udev->state == USB_STATE_NOTATTACHED || |
1011 | udev->state == USB_STATE_SUSPENDED) | |
1012 | goto done; | |
1013 | ||
b6f6436d AS |
1014 | /* For devices that don't have a driver, we do a generic suspend. */ |
1015 | if (udev->dev.driver) | |
1016 | udriver = to_usb_device_driver(udev->dev.driver); | |
1017 | else { | |
645daaab | 1018 | udev->do_remote_wakeup = 0; |
b6f6436d | 1019 | udriver = &usb_generic_driver; |
1c5df7e7 | 1020 | } |
2bf4086d AS |
1021 | status = udriver->suspend(udev, msg); |
1022 | ||
20dfdad7 | 1023 | done: |
441b62c1 | 1024 | dev_vdbg(&udev->dev, "%s: status %d\n", __func__, status); |
2bf4086d | 1025 | return status; |
1cc8a25d AS |
1026 | } |
1027 | ||
65bfd296 | 1028 | static int usb_resume_device(struct usb_device *udev, pm_message_t msg) |
1cc8a25d AS |
1029 | { |
1030 | struct usb_device_driver *udriver; | |
2bf4086d | 1031 | int status = 0; |
36e56a34 | 1032 | |
0458d5b4 AS |
1033 | if (udev->state == USB_STATE_NOTATTACHED) |
1034 | goto done; | |
1cc8a25d | 1035 | |
1c5df7e7 AS |
1036 | /* Can't resume it if it doesn't have a driver. */ |
1037 | if (udev->dev.driver == NULL) { | |
1038 | status = -ENOTCONN; | |
2bf4086d | 1039 | goto done; |
1c5df7e7 AS |
1040 | } |
1041 | ||
6d19c009 AS |
1042 | /* Non-root devices on a full/low-speed bus must wait for their |
1043 | * companion high-speed root hub, in case a handoff is needed. | |
1044 | */ | |
1045 | if (!(msg.event & PM_EVENT_AUTO) && udev->parent && | |
1046 | udev->bus->hs_companion) | |
1047 | device_pm_wait_for_dev(&udev->dev, | |
1048 | &udev->bus->hs_companion->root_hub->dev); | |
1049 | ||
6bc6cff5 AS |
1050 | if (udev->quirks & USB_QUIRK_RESET_RESUME) |
1051 | udev->reset_resume = 1; | |
1052 | ||
1cc8a25d | 1053 | udriver = to_usb_device_driver(udev->dev.driver); |
65bfd296 | 1054 | status = udriver->resume(udev, msg); |
2bf4086d | 1055 | |
20dfdad7 | 1056 | done: |
441b62c1 | 1057 | dev_vdbg(&udev->dev, "%s: status %d\n", __func__, status); |
2bf4086d | 1058 | return status; |
1cc8a25d AS |
1059 | } |
1060 | ||
65605ae8 AS |
1061 | static int usb_suspend_interface(struct usb_device *udev, |
1062 | struct usb_interface *intf, pm_message_t msg) | |
1cc8a25d AS |
1063 | { |
1064 | struct usb_driver *driver; | |
2bf4086d | 1065 | int status = 0; |
1cc8a25d | 1066 | |
9bbdf1e0 AS |
1067 | if (udev->state == USB_STATE_NOTATTACHED || |
1068 | intf->condition == USB_INTERFACE_UNBOUND) | |
2bf4086d | 1069 | goto done; |
114b368c | 1070 | driver = to_usb_driver(intf->dev.driver); |
36e56a34 | 1071 | |
78d9a487 | 1072 | if (driver->suspend) { |
1cc8a25d | 1073 | status = driver->suspend(intf, msg); |
9bbdf1e0 | 1074 | if (status && !(msg.event & PM_EVENT_AUTO)) |
1cc8a25d AS |
1075 | dev_err(&intf->dev, "%s error %d\n", |
1076 | "suspend", status); | |
36e56a34 | 1077 | } else { |
78d9a487 AS |
1078 | /* Later we will unbind the driver and reprobe */ |
1079 | intf->needs_binding = 1; | |
1080 | dev_warn(&intf->dev, "no %s for driver %s?\n", | |
1081 | "suspend", driver->name); | |
36e56a34 | 1082 | } |
2bf4086d | 1083 | |
20dfdad7 | 1084 | done: |
441b62c1 | 1085 | dev_vdbg(&intf->dev, "%s: status %d\n", __func__, status); |
36e56a34 AS |
1086 | return status; |
1087 | } | |
1088 | ||
65605ae8 | 1089 | static int usb_resume_interface(struct usb_device *udev, |
65bfd296 | 1090 | struct usb_interface *intf, pm_message_t msg, int reset_resume) |
36e56a34 | 1091 | { |
1cc8a25d | 1092 | struct usb_driver *driver; |
2bf4086d | 1093 | int status = 0; |
36e56a34 | 1094 | |
9bbdf1e0 | 1095 | if (udev->state == USB_STATE_NOTATTACHED) |
2bf4086d | 1096 | goto done; |
36e56a34 | 1097 | |
645daaab AS |
1098 | /* Don't let autoresume interfere with unbinding */ |
1099 | if (intf->condition == USB_INTERFACE_UNBINDING) | |
1100 | goto done; | |
1101 | ||
1c5df7e7 | 1102 | /* Can't resume it if it doesn't have a driver. */ |
55151d7d AS |
1103 | if (intf->condition == USB_INTERFACE_UNBOUND) { |
1104 | ||
1105 | /* Carry out a deferred switch to altsetting 0 */ | |
1106 | if (intf->needs_altsetting0 && | |
1107 | intf->dev.power.status == DPM_ON) { | |
1108 | usb_set_interface(udev, intf->altsetting[0]. | |
1109 | desc.bInterfaceNumber, 0); | |
1110 | intf->needs_altsetting0 = 0; | |
1111 | } | |
78d9a487 | 1112 | goto done; |
55151d7d | 1113 | } |
78d9a487 AS |
1114 | |
1115 | /* Don't resume if the interface is marked for rebinding */ | |
1116 | if (intf->needs_binding) | |
2bf4086d | 1117 | goto done; |
1cc8a25d | 1118 | driver = to_usb_driver(intf->dev.driver); |
36e56a34 | 1119 | |
f07600cf AS |
1120 | if (reset_resume) { |
1121 | if (driver->reset_resume) { | |
1122 | status = driver->reset_resume(intf); | |
1123 | if (status) | |
1124 | dev_err(&intf->dev, "%s error %d\n", | |
1125 | "reset_resume", status); | |
1126 | } else { | |
78d9a487 | 1127 | intf->needs_binding = 1; |
f07600cf AS |
1128 | dev_warn(&intf->dev, "no %s for driver %s?\n", |
1129 | "reset_resume", driver->name); | |
1130 | } | |
1131 | } else { | |
1132 | if (driver->resume) { | |
1133 | status = driver->resume(intf); | |
1134 | if (status) | |
1135 | dev_err(&intf->dev, "%s error %d\n", | |
1136 | "resume", status); | |
1137 | } else { | |
78d9a487 | 1138 | intf->needs_binding = 1; |
f07600cf AS |
1139 | dev_warn(&intf->dev, "no %s for driver %s?\n", |
1140 | "resume", driver->name); | |
1141 | } | |
1142 | } | |
2bf4086d AS |
1143 | |
1144 | done: | |
441b62c1 | 1145 | dev_vdbg(&intf->dev, "%s: status %d\n", __func__, status); |
f07600cf | 1146 | |
78d9a487 | 1147 | /* Later we will unbind the driver and/or reprobe, if necessary */ |
2bf4086d | 1148 | return status; |
36e56a34 AS |
1149 | } |
1150 | ||
645daaab AS |
1151 | /** |
1152 | * usb_suspend_both - suspend a USB device and its interfaces | |
1153 | * @udev: the usb_device to suspend | |
1154 | * @msg: Power Management message describing this state transition | |
1155 | * | |
1156 | * This is the central routine for suspending USB devices. It calls the | |
1157 | * suspend methods for all the interface drivers in @udev and then calls | |
1158 | * the suspend method for @udev itself. If an error occurs at any stage, | |
1159 | * all the interfaces which were suspended are resumed so that they remain | |
1160 | * in the same state as the device. | |
1161 | * | |
9bbdf1e0 AS |
1162 | * Autosuspend requests originating from a child device or an interface |
1163 | * driver may be made without the protection of @udev's device lock, but | |
1164 | * all other suspend calls will hold the lock. Usbcore will insure that | |
1165 | * method calls do not arrive during bind, unbind, or reset operations. | |
1166 | * However drivers must be prepared to handle suspend calls arriving at | |
1167 | * unpredictable times. | |
645daaab AS |
1168 | * |
1169 | * This routine can run only in process context. | |
1170 | */ | |
718efa64 | 1171 | static int usb_suspend_both(struct usb_device *udev, pm_message_t msg) |
a8e7c565 AS |
1172 | { |
1173 | int status = 0; | |
571dc79d | 1174 | int i = 0, n = 0; |
a8e7c565 | 1175 | struct usb_interface *intf; |
645daaab | 1176 | |
1941044a AS |
1177 | if (udev->state == USB_STATE_NOTATTACHED || |
1178 | udev->state == USB_STATE_SUSPENDED) | |
1179 | goto done; | |
a8e7c565 | 1180 | |
645daaab | 1181 | /* Suspend all the interfaces and then udev itself */ |
a8e7c565 | 1182 | if (udev->actconfig) { |
571dc79d AS |
1183 | n = udev->actconfig->desc.bNumInterfaces; |
1184 | for (i = n - 1; i >= 0; --i) { | |
a8e7c565 | 1185 | intf = udev->actconfig->interface[i]; |
65605ae8 | 1186 | status = usb_suspend_interface(udev, intf, msg); |
a8e7c565 AS |
1187 | if (status != 0) |
1188 | break; | |
1189 | } | |
1190 | } | |
5ad4f71e | 1191 | if (status == 0) |
d5ec1686 | 1192 | status = usb_suspend_device(udev, msg); |
a8e7c565 AS |
1193 | |
1194 | /* If the suspend failed, resume interfaces that did get suspended */ | |
1195 | if (status != 0) { | |
9bbdf1e0 | 1196 | msg.event ^= (PM_EVENT_SUSPEND | PM_EVENT_RESUME); |
571dc79d | 1197 | while (++i < n) { |
a8e7c565 | 1198 | intf = udev->actconfig->interface[i]; |
9bbdf1e0 | 1199 | usb_resume_interface(udev, intf, msg, 0); |
a8e7c565 | 1200 | } |
645daaab | 1201 | |
9bbdf1e0 AS |
1202 | /* If the suspend succeeded then prevent any more URB submissions |
1203 | * and flush any outstanding URBs. | |
6840d255 | 1204 | */ |
ef7f6c70 | 1205 | } else { |
6840d255 AS |
1206 | udev->can_submit = 0; |
1207 | for (i = 0; i < 16; ++i) { | |
1208 | usb_hcd_flush_endpoint(udev, udev->ep_out[i]); | |
1209 | usb_hcd_flush_endpoint(udev, udev->ep_in[i]); | |
1210 | } | |
ef7f6c70 | 1211 | } |
645daaab | 1212 | |
1941044a | 1213 | done: |
441b62c1 | 1214 | dev_vdbg(&udev->dev, "%s: status %d\n", __func__, status); |
a8e7c565 AS |
1215 | return status; |
1216 | } | |
1217 | ||
645daaab AS |
1218 | /** |
1219 | * usb_resume_both - resume a USB device and its interfaces | |
1220 | * @udev: the usb_device to resume | |
65bfd296 | 1221 | * @msg: Power Management message describing this state transition |
645daaab AS |
1222 | * |
1223 | * This is the central routine for resuming USB devices. It calls the | |
1224 | * the resume method for @udev and then calls the resume methods for all | |
1225 | * the interface drivers in @udev. | |
1226 | * | |
9bbdf1e0 AS |
1227 | * Autoresume requests originating from a child device or an interface |
1228 | * driver may be made without the protection of @udev's device lock, but | |
1229 | * all other resume calls will hold the lock. Usbcore will insure that | |
1230 | * method calls do not arrive during bind, unbind, or reset operations. | |
1231 | * However drivers must be prepared to handle resume calls arriving at | |
1232 | * unpredictable times. | |
645daaab AS |
1233 | * |
1234 | * This routine can run only in process context. | |
1235 | */ | |
65bfd296 | 1236 | static int usb_resume_both(struct usb_device *udev, pm_message_t msg) |
a8e7c565 | 1237 | { |
645daaab | 1238 | int status = 0; |
a8e7c565 AS |
1239 | int i; |
1240 | struct usb_interface *intf; | |
645daaab | 1241 | |
1941044a AS |
1242 | if (udev->state == USB_STATE_NOTATTACHED) { |
1243 | status = -ENODEV; | |
1244 | goto done; | |
1245 | } | |
6840d255 | 1246 | udev->can_submit = 1; |
a8e7c565 | 1247 | |
9bbdf1e0 AS |
1248 | /* Resume the device */ |
1249 | if (udev->state == USB_STATE_SUSPENDED || udev->reset_resume) | |
65bfd296 | 1250 | status = usb_resume_device(udev, msg); |
114b368c | 1251 | |
9bbdf1e0 | 1252 | /* Resume the interfaces */ |
a8e7c565 AS |
1253 | if (status == 0 && udev->actconfig) { |
1254 | for (i = 0; i < udev->actconfig->desc.bNumInterfaces; i++) { | |
1255 | intf = udev->actconfig->interface[i]; | |
65bfd296 AS |
1256 | usb_resume_interface(udev, intf, msg, |
1257 | udev->reset_resume); | |
a8e7c565 AS |
1258 | } |
1259 | } | |
645daaab | 1260 | |
1941044a | 1261 | done: |
441b62c1 | 1262 | dev_vdbg(&udev->dev, "%s: status %d\n", __func__, status); |
70a1c9e0 AS |
1263 | if (!status) |
1264 | udev->reset_resume = 0; | |
645daaab AS |
1265 | return status; |
1266 | } | |
1267 | ||
5f677f1d AS |
1268 | static void choose_wakeup(struct usb_device *udev, pm_message_t msg) |
1269 | { | |
1270 | int w, i; | |
1271 | struct usb_interface *intf; | |
1272 | ||
1273 | /* Remote wakeup is needed only when we actually go to sleep. | |
1274 | * For things like FREEZE and QUIESCE, if the device is already | |
1275 | * autosuspended then its current wakeup setting is okay. | |
1276 | */ | |
1277 | if (msg.event == PM_EVENT_FREEZE || msg.event == PM_EVENT_QUIESCE) { | |
1278 | if (udev->state != USB_STATE_SUSPENDED) | |
1279 | udev->do_remote_wakeup = 0; | |
1280 | return; | |
1281 | } | |
1282 | ||
1283 | /* If remote wakeup is permitted, see whether any interface drivers | |
1284 | * actually want it. | |
1285 | */ | |
1286 | w = 0; | |
1287 | if (device_may_wakeup(&udev->dev) && udev->actconfig) { | |
1288 | for (i = 0; i < udev->actconfig->desc.bNumInterfaces; i++) { | |
1289 | intf = udev->actconfig->interface[i]; | |
1290 | w |= intf->needs_remote_wakeup; | |
1291 | } | |
1292 | } | |
1293 | ||
1294 | /* If the device is autosuspended with the wrong wakeup setting, | |
1295 | * autoresume now so the setting can be changed. | |
1296 | */ | |
1297 | if (udev->state == USB_STATE_SUSPENDED && w != udev->do_remote_wakeup) | |
1298 | pm_runtime_resume(&udev->dev); | |
1299 | udev->do_remote_wakeup = w; | |
1300 | } | |
1301 | ||
9bbdf1e0 | 1302 | /* The device lock is held by the PM core */ |
0c590e23 AS |
1303 | int usb_suspend(struct device *dev, pm_message_t msg) |
1304 | { | |
9bbdf1e0 | 1305 | struct usb_device *udev = to_usb_device(dev); |
0c590e23 | 1306 | |
9bbdf1e0 | 1307 | do_unbind_rebind(udev, DO_UNBIND); |
5f677f1d | 1308 | choose_wakeup(udev, msg); |
9bbdf1e0 | 1309 | return usb_suspend_both(udev, msg); |
0c590e23 AS |
1310 | } |
1311 | ||
9bbdf1e0 | 1312 | /* The device lock is held by the PM core */ |
0c590e23 AS |
1313 | int usb_resume(struct device *dev, pm_message_t msg) |
1314 | { | |
9bbdf1e0 | 1315 | struct usb_device *udev = to_usb_device(dev); |
0c590e23 AS |
1316 | int status; |
1317 | ||
9bbdf1e0 AS |
1318 | /* For PM complete calls, all we do is rebind interfaces */ |
1319 | if (msg.event == PM_EVENT_ON) { | |
1320 | if (udev->state != USB_STATE_NOTATTACHED) | |
1321 | do_unbind_rebind(udev, DO_REBIND); | |
1322 | status = 0; | |
0c590e23 | 1323 | |
9bbdf1e0 AS |
1324 | /* For all other calls, take the device back to full power and |
1325 | * tell the PM core in case it was autosuspended previously. | |
0c590e23 | 1326 | */ |
9bbdf1e0 AS |
1327 | } else { |
1328 | status = usb_resume_both(udev, msg); | |
1329 | if (status == 0) { | |
1330 | pm_runtime_disable(dev); | |
1331 | pm_runtime_set_active(dev); | |
1332 | pm_runtime_enable(dev); | |
1333 | udev->last_busy = jiffies; | |
1334 | } | |
1335 | } | |
0c590e23 AS |
1336 | |
1337 | /* Avoid PM error messages for devices disconnected while suspended | |
1338 | * as we'll display regular disconnect messages just a bit later. | |
1339 | */ | |
1340 | if (status == -ENODEV) | |
9bbdf1e0 | 1341 | status = 0; |
0c590e23 AS |
1342 | return status; |
1343 | } | |
1344 | ||
1345 | #endif /* CONFIG_PM */ | |
1346 | ||
645daaab AS |
1347 | #ifdef CONFIG_USB_SUSPEND |
1348 | ||
088f7fec AS |
1349 | /** |
1350 | * usb_enable_autosuspend - allow a USB device to be autosuspended | |
1351 | * @udev: the USB device which may be autosuspended | |
1352 | * | |
1353 | * This routine allows @udev to be autosuspended. An autosuspend won't | |
1354 | * take place until the autosuspend_delay has elapsed and all the other | |
1355 | * necessary conditions are satisfied. | |
1356 | * | |
1357 | * The caller must hold @udev's device lock. | |
1358 | */ | |
1359 | int usb_enable_autosuspend(struct usb_device *udev) | |
1360 | { | |
1361 | if (udev->autosuspend_disabled) { | |
1362 | udev->autosuspend_disabled = 0; | |
1363 | usb_autosuspend_device(udev); | |
1364 | } | |
1365 | return 0; | |
1366 | } | |
1367 | EXPORT_SYMBOL_GPL(usb_enable_autosuspend); | |
1368 | ||
1369 | /** | |
1370 | * usb_disable_autosuspend - prevent a USB device from being autosuspended | |
1371 | * @udev: the USB device which may not be autosuspended | |
1372 | * | |
1373 | * This routine prevents @udev from being autosuspended and wakes it up | |
1374 | * if it is already autosuspended. | |
1375 | * | |
1376 | * The caller must hold @udev's device lock. | |
1377 | */ | |
1378 | int usb_disable_autosuspend(struct usb_device *udev) | |
1379 | { | |
1380 | int rc = 0; | |
1381 | ||
1382 | if (!udev->autosuspend_disabled) { | |
1383 | rc = usb_autoresume_device(udev); | |
1384 | if (rc == 0) | |
1385 | udev->autosuspend_disabled = 1; | |
1386 | } | |
1387 | return rc; | |
1388 | } | |
1389 | EXPORT_SYMBOL_GPL(usb_disable_autosuspend); | |
1390 | ||
645daaab AS |
1391 | /** |
1392 | * usb_autosuspend_device - delayed autosuspend of a USB device and its interfaces | |
701f35af | 1393 | * @udev: the usb_device to autosuspend |
645daaab AS |
1394 | * |
1395 | * This routine should be called when a core subsystem is finished using | |
1396 | * @udev and wants to allow it to autosuspend. Examples would be when | |
1397 | * @udev's device file in usbfs is closed or after a configuration change. | |
1398 | * | |
9bbdf1e0 AS |
1399 | * @udev's usage counter is decremented; if it drops to 0 and all the |
1400 | * interfaces are inactive then a delayed autosuspend will be attempted. | |
1401 | * The attempt may fail (see autosuspend_check()). | |
645daaab | 1402 | * |
62e299e6 | 1403 | * The caller must hold @udev's device lock. |
645daaab AS |
1404 | * |
1405 | * This routine can run only in process context. | |
1406 | */ | |
94fcda1f | 1407 | void usb_autosuspend_device(struct usb_device *udev) |
645daaab | 1408 | { |
94fcda1f AS |
1409 | int status; |
1410 | ||
9bbdf1e0 AS |
1411 | udev->last_busy = jiffies; |
1412 | status = pm_runtime_put_sync(&udev->dev); | |
1413 | dev_vdbg(&udev->dev, "%s: cnt %d -> %d\n", | |
1414 | __func__, atomic_read(&udev->dev.power.usage_count), | |
1415 | status); | |
19c26239 AS |
1416 | } |
1417 | ||
1418 | /** | |
1419 | * usb_try_autosuspend_device - attempt an autosuspend of a USB device and its interfaces | |
1420 | * @udev: the usb_device to autosuspend | |
1421 | * | |
1422 | * This routine should be called when a core subsystem thinks @udev may | |
1423 | * be ready to autosuspend. | |
1424 | * | |
9bbdf1e0 AS |
1425 | * @udev's usage counter left unchanged. If it is 0 and all the interfaces |
1426 | * are inactive then an autosuspend will be attempted. The attempt may | |
1427 | * fail or be delayed. | |
19c26239 | 1428 | * |
62e299e6 AS |
1429 | * The caller must hold @udev's device lock. |
1430 | * | |
19c26239 AS |
1431 | * This routine can run only in process context. |
1432 | */ | |
1433 | void usb_try_autosuspend_device(struct usb_device *udev) | |
1434 | { | |
9bbdf1e0 AS |
1435 | int status; |
1436 | ||
1437 | status = pm_runtime_idle(&udev->dev); | |
1438 | dev_vdbg(&udev->dev, "%s: cnt %d -> %d\n", | |
1439 | __func__, atomic_read(&udev->dev.power.usage_count), | |
1440 | status); | |
645daaab AS |
1441 | } |
1442 | ||
1443 | /** | |
1444 | * usb_autoresume_device - immediately autoresume a USB device and its interfaces | |
701f35af | 1445 | * @udev: the usb_device to autoresume |
645daaab AS |
1446 | * |
1447 | * This routine should be called when a core subsystem wants to use @udev | |
94fcda1f | 1448 | * and needs to guarantee that it is not suspended. No autosuspend will |
9bbdf1e0 AS |
1449 | * occur until usb_autosuspend_device() is called. (Note that this will |
1450 | * not prevent suspend events originating in the PM core.) Examples would | |
1451 | * be when @udev's device file in usbfs is opened or when a remote-wakeup | |
94fcda1f | 1452 | * request is received. |
645daaab | 1453 | * |
94fcda1f AS |
1454 | * @udev's usage counter is incremented to prevent subsequent autosuspends. |
1455 | * However if the autoresume fails then the usage counter is re-decremented. | |
645daaab | 1456 | * |
62e299e6 | 1457 | * The caller must hold @udev's device lock. |
645daaab AS |
1458 | * |
1459 | * This routine can run only in process context. | |
1460 | */ | |
94fcda1f | 1461 | int usb_autoresume_device(struct usb_device *udev) |
645daaab AS |
1462 | { |
1463 | int status; | |
1464 | ||
9bbdf1e0 AS |
1465 | status = pm_runtime_get_sync(&udev->dev); |
1466 | if (status < 0) | |
1467 | pm_runtime_put_sync(&udev->dev); | |
1468 | dev_vdbg(&udev->dev, "%s: cnt %d -> %d\n", | |
1469 | __func__, atomic_read(&udev->dev.power.usage_count), | |
1470 | status); | |
1471 | if (status > 0) | |
1472 | status = 0; | |
af4f7606 AS |
1473 | return status; |
1474 | } | |
1475 | ||
645daaab AS |
1476 | /** |
1477 | * usb_autopm_put_interface - decrement a USB interface's PM-usage counter | |
701f35af | 1478 | * @intf: the usb_interface whose counter should be decremented |
645daaab AS |
1479 | * |
1480 | * This routine should be called by an interface driver when it is | |
1481 | * finished using @intf and wants to allow it to autosuspend. A typical | |
1482 | * example would be a character-device driver when its device file is | |
1483 | * closed. | |
1484 | * | |
1485 | * The routine decrements @intf's usage counter. When the counter reaches | |
9bbdf1e0 AS |
1486 | * 0, a delayed autosuspend request for @intf's device is attempted. The |
1487 | * attempt may fail (see autosuspend_check()). | |
645daaab AS |
1488 | * |
1489 | * If the driver has set @intf->needs_remote_wakeup then autosuspend will | |
1490 | * take place only if the device's remote-wakeup facility is enabled. | |
1491 | * | |
645daaab AS |
1492 | * This routine can run only in process context. |
1493 | */ | |
1494 | void usb_autopm_put_interface(struct usb_interface *intf) | |
1495 | { | |
9bbdf1e0 AS |
1496 | struct usb_device *udev = interface_to_usbdev(intf); |
1497 | int status; | |
645daaab | 1498 | |
9bbdf1e0 AS |
1499 | udev->last_busy = jiffies; |
1500 | atomic_dec(&intf->pm_usage_cnt); | |
1501 | status = pm_runtime_put_sync(&intf->dev); | |
1502 | dev_vdbg(&intf->dev, "%s: cnt %d -> %d\n", | |
1503 | __func__, atomic_read(&intf->dev.power.usage_count), | |
1504 | status); | |
645daaab AS |
1505 | } |
1506 | EXPORT_SYMBOL_GPL(usb_autopm_put_interface); | |
1507 | ||
9ac39f28 AS |
1508 | /** |
1509 | * usb_autopm_put_interface_async - decrement a USB interface's PM-usage counter | |
1510 | * @intf: the usb_interface whose counter should be decremented | |
1511 | * | |
9bbdf1e0 AS |
1512 | * This routine does much the same thing as usb_autopm_put_interface(): |
1513 | * It decrements @intf's usage counter and schedules a delayed | |
1514 | * autosuspend request if the counter is <= 0. The difference is that it | |
1515 | * does not perform any synchronization; callers should hold a private | |
1516 | * lock and handle all synchronization issues themselves. | |
9ac39f28 AS |
1517 | * |
1518 | * Typically a driver would call this routine during an URB's completion | |
1519 | * handler, if no more URBs were pending. | |
1520 | * | |
1521 | * This routine can run in atomic context. | |
1522 | */ | |
1523 | void usb_autopm_put_interface_async(struct usb_interface *intf) | |
1524 | { | |
1525 | struct usb_device *udev = interface_to_usbdev(intf); | |
9bbdf1e0 | 1526 | unsigned long last_busy; |
9ac39f28 AS |
1527 | int status = 0; |
1528 | ||
9bbdf1e0 AS |
1529 | last_busy = udev->last_busy; |
1530 | udev->last_busy = jiffies; | |
1531 | atomic_dec(&intf->pm_usage_cnt); | |
1532 | pm_runtime_put_noidle(&intf->dev); | |
1533 | ||
1534 | if (!udev->autosuspend_disabled) { | |
1535 | /* Optimization: Don't schedule a delayed autosuspend if | |
1536 | * the timer is already running and the expiration time | |
1537 | * wouldn't change. | |
1538 | * | |
1539 | * We have to use the interface's timer. Attempts to | |
1540 | * schedule a suspend for the device would fail because | |
1541 | * the interface is still active. | |
1542 | */ | |
1543 | if (intf->dev.power.timer_expires == 0 || | |
1544 | round_jiffies_up(last_busy) != | |
1545 | round_jiffies_up(jiffies)) { | |
1546 | status = pm_schedule_suspend(&intf->dev, | |
1547 | jiffies_to_msecs( | |
4ec06d62 | 1548 | round_jiffies_up_relative( |
9bbdf1e0 | 1549 | udev->autosuspend_delay))); |
9ac39f28 AS |
1550 | } |
1551 | } | |
9bbdf1e0 AS |
1552 | dev_vdbg(&intf->dev, "%s: cnt %d -> %d\n", |
1553 | __func__, atomic_read(&intf->dev.power.usage_count), | |
1554 | status); | |
9ac39f28 AS |
1555 | } |
1556 | EXPORT_SYMBOL_GPL(usb_autopm_put_interface_async); | |
1557 | ||
9bbdf1e0 AS |
1558 | /** |
1559 | * usb_autopm_put_interface_no_suspend - decrement a USB interface's PM-usage counter | |
1560 | * @intf: the usb_interface whose counter should be decremented | |
1561 | * | |
1562 | * This routine decrements @intf's usage counter but does not carry out an | |
1563 | * autosuspend. | |
1564 | * | |
1565 | * This routine can run in atomic context. | |
1566 | */ | |
1567 | void usb_autopm_put_interface_no_suspend(struct usb_interface *intf) | |
1568 | { | |
1569 | struct usb_device *udev = interface_to_usbdev(intf); | |
1570 | ||
1571 | udev->last_busy = jiffies; | |
1572 | atomic_dec(&intf->pm_usage_cnt); | |
1573 | pm_runtime_put_noidle(&intf->dev); | |
1574 | } | |
1575 | EXPORT_SYMBOL_GPL(usb_autopm_put_interface_no_suspend); | |
1576 | ||
645daaab AS |
1577 | /** |
1578 | * usb_autopm_get_interface - increment a USB interface's PM-usage counter | |
701f35af | 1579 | * @intf: the usb_interface whose counter should be incremented |
645daaab AS |
1580 | * |
1581 | * This routine should be called by an interface driver when it wants to | |
1582 | * use @intf and needs to guarantee that it is not suspended. In addition, | |
1583 | * the routine prevents @intf from being autosuspended subsequently. (Note | |
1584 | * that this will not prevent suspend events originating in the PM core.) | |
1585 | * This prevention will persist until usb_autopm_put_interface() is called | |
1586 | * or @intf is unbound. A typical example would be a character-device | |
1587 | * driver when its device file is opened. | |
1588 | * | |
9bbdf1e0 AS |
1589 | * @intf's usage counter is incremented to prevent subsequent autosuspends. |
1590 | * However if the autoresume fails then the counter is re-decremented. | |
645daaab AS |
1591 | * |
1592 | * This routine can run only in process context. | |
1593 | */ | |
1594 | int usb_autopm_get_interface(struct usb_interface *intf) | |
1595 | { | |
af4f7606 | 1596 | int status; |
645daaab | 1597 | |
9bbdf1e0 AS |
1598 | status = pm_runtime_get_sync(&intf->dev); |
1599 | if (status < 0) | |
1600 | pm_runtime_put_sync(&intf->dev); | |
1601 | else | |
1602 | atomic_inc(&intf->pm_usage_cnt); | |
1603 | dev_vdbg(&intf->dev, "%s: cnt %d -> %d\n", | |
1604 | __func__, atomic_read(&intf->dev.power.usage_count), | |
1605 | status); | |
1606 | if (status > 0) | |
1607 | status = 0; | |
a8e7c565 AS |
1608 | return status; |
1609 | } | |
645daaab AS |
1610 | EXPORT_SYMBOL_GPL(usb_autopm_get_interface); |
1611 | ||
9ac39f28 AS |
1612 | /** |
1613 | * usb_autopm_get_interface_async - increment a USB interface's PM-usage counter | |
1614 | * @intf: the usb_interface whose counter should be incremented | |
1615 | * | |
1616 | * This routine does much the same thing as | |
9bbdf1e0 AS |
1617 | * usb_autopm_get_interface(): It increments @intf's usage counter and |
1618 | * queues an autoresume request if the device is suspended. The | |
1619 | * differences are that it does not perform any synchronization (callers | |
1620 | * should hold a private lock and handle all synchronization issues | |
1621 | * themselves), and it does not autoresume the device directly (it only | |
1622 | * queues a request). After a successful call, the device may not yet be | |
1623 | * resumed. | |
9ac39f28 AS |
1624 | * |
1625 | * This routine can run in atomic context. | |
1626 | */ | |
1627 | int usb_autopm_get_interface_async(struct usb_interface *intf) | |
1628 | { | |
9bbdf1e0 AS |
1629 | int status = 0; |
1630 | enum rpm_status s; | |
9ac39f28 | 1631 | |
9bbdf1e0 AS |
1632 | /* Don't request a resume unless the interface is already suspending |
1633 | * or suspended. Doing so would force a running suspend timer to be | |
1634 | * cancelled. | |
1635 | */ | |
1636 | pm_runtime_get_noresume(&intf->dev); | |
1637 | s = ACCESS_ONCE(intf->dev.power.runtime_status); | |
1638 | if (s == RPM_SUSPENDING || s == RPM_SUSPENDED) | |
1639 | status = pm_request_resume(&intf->dev); | |
1640 | ||
1641 | if (status < 0 && status != -EINPROGRESS) | |
1642 | pm_runtime_put_noidle(&intf->dev); | |
1643 | else | |
ccf5b801 | 1644 | atomic_inc(&intf->pm_usage_cnt); |
9bbdf1e0 AS |
1645 | dev_vdbg(&intf->dev, "%s: cnt %d -> %d\n", |
1646 | __func__, atomic_read(&intf->dev.power.usage_count), | |
1647 | status); | |
1648 | if (status > 0) | |
1649 | status = 0; | |
9ac39f28 AS |
1650 | return status; |
1651 | } | |
1652 | EXPORT_SYMBOL_GPL(usb_autopm_get_interface_async); | |
1653 | ||
9bbdf1e0 AS |
1654 | /** |
1655 | * usb_autopm_get_interface_no_resume - increment a USB interface's PM-usage counter | |
1656 | * @intf: the usb_interface whose counter should be incremented | |
1657 | * | |
1658 | * This routine increments @intf's usage counter but does not carry out an | |
1659 | * autoresume. | |
1660 | * | |
1661 | * This routine can run in atomic context. | |
1662 | */ | |
1663 | void usb_autopm_get_interface_no_resume(struct usb_interface *intf) | |
1664 | { | |
1665 | struct usb_device *udev = interface_to_usbdev(intf); | |
1666 | ||
1667 | udev->last_busy = jiffies; | |
1668 | atomic_inc(&intf->pm_usage_cnt); | |
1669 | pm_runtime_get_noresume(&intf->dev); | |
1670 | } | |
1671 | EXPORT_SYMBOL_GPL(usb_autopm_get_interface_no_resume); | |
1672 | ||
1673 | /* Internal routine to check whether we may autosuspend a device. */ | |
1674 | static int autosuspend_check(struct usb_device *udev) | |
1675 | { | |
1676 | int i; | |
1677 | struct usb_interface *intf; | |
1678 | unsigned long suspend_time, j; | |
1679 | ||
1680 | /* Fail if autosuspend is disabled, or any interfaces are in use, or | |
1681 | * any interface drivers require remote wakeup but it isn't available. | |
1682 | */ | |
1683 | udev->do_remote_wakeup = device_may_wakeup(&udev->dev); | |
1684 | if (udev->actconfig) { | |
1685 | for (i = 0; i < udev->actconfig->desc.bNumInterfaces; i++) { | |
1686 | intf = udev->actconfig->interface[i]; | |
1687 | ||
1688 | /* We don't need to check interfaces that are | |
1689 | * disabled for runtime PM. Either they are unbound | |
1690 | * or else their drivers don't support autosuspend | |
1691 | * and so they are permanently active. | |
1692 | */ | |
1693 | if (intf->dev.power.disable_depth) | |
1694 | continue; | |
1695 | if (atomic_read(&intf->dev.power.usage_count) > 0) | |
1696 | return -EBUSY; | |
1697 | if (intf->needs_remote_wakeup && | |
1698 | !udev->do_remote_wakeup) { | |
1699 | dev_dbg(&udev->dev, "remote wakeup needed " | |
1700 | "for autosuspend\n"); | |
1701 | return -EOPNOTSUPP; | |
1702 | } | |
1703 | ||
1704 | /* Don't allow autosuspend if the device will need | |
1705 | * a reset-resume and any of its interface drivers | |
1706 | * doesn't include support or needs remote wakeup. | |
1707 | */ | |
1708 | if (udev->quirks & USB_QUIRK_RESET_RESUME) { | |
1709 | struct usb_driver *driver; | |
1710 | ||
1711 | driver = to_usb_driver(intf->dev.driver); | |
1712 | if (!driver->reset_resume || | |
1713 | intf->needs_remote_wakeup) | |
1714 | return -EOPNOTSUPP; | |
1715 | } | |
1716 | } | |
1717 | } | |
1718 | ||
1719 | /* If everything is okay but the device hasn't been idle for long | |
1720 | * enough, queue a delayed autosuspend request. | |
1721 | */ | |
1722 | j = ACCESS_ONCE(jiffies); | |
1723 | suspend_time = udev->last_busy + udev->autosuspend_delay; | |
1724 | if (time_before(j, suspend_time)) { | |
1725 | pm_schedule_suspend(&udev->dev, jiffies_to_msecs( | |
1726 | round_jiffies_up_relative(suspend_time - j))); | |
1727 | return -EAGAIN; | |
1728 | } | |
1729 | return 0; | |
1730 | } | |
1731 | ||
1732 | static int usb_runtime_suspend(struct device *dev) | |
1733 | { | |
1734 | int status = 0; | |
718efa64 | 1735 | |
9bbdf1e0 AS |
1736 | /* A USB device can be suspended if it passes the various autosuspend |
1737 | * checks. Runtime suspend for a USB device means suspending all the | |
1738 | * interfaces and then the device itself. | |
1739 | */ | |
1740 | if (is_usb_device(dev)) { | |
1741 | struct usb_device *udev = to_usb_device(dev); | |
1742 | ||
1743 | if (autosuspend_check(udev) != 0) | |
1744 | return -EAGAIN; | |
1745 | ||
1746 | status = usb_suspend_both(udev, PMSG_AUTO_SUSPEND); | |
1747 | ||
1748 | /* If an interface fails the suspend, adjust the last_busy | |
1749 | * time so that we don't get another suspend attempt right | |
1750 | * away. | |
1751 | */ | |
1752 | if (status) { | |
1753 | udev->last_busy = jiffies + | |
1754 | (udev->autosuspend_delay == 0 ? | |
1755 | HZ/2 : 0); | |
1756 | } | |
1757 | ||
1758 | /* Prevent the parent from suspending immediately after */ | |
1759 | else if (udev->parent) { | |
1760 | udev->parent->last_busy = jiffies; | |
1761 | } | |
1762 | } | |
1763 | ||
1764 | /* Runtime suspend for a USB interface doesn't mean anything. */ | |
1765 | return status; | |
1766 | } | |
1767 | ||
1768 | static int usb_runtime_resume(struct device *dev) | |
1769 | { | |
1770 | /* Runtime resume for a USB device means resuming both the device | |
1771 | * and all its interfaces. | |
1772 | */ | |
1773 | if (is_usb_device(dev)) { | |
1774 | struct usb_device *udev = to_usb_device(dev); | |
1775 | int status; | |
1776 | ||
1777 | status = usb_resume_both(udev, PMSG_AUTO_RESUME); | |
1778 | udev->last_busy = jiffies; | |
1779 | return status; | |
1780 | } | |
1781 | ||
1782 | /* Runtime resume for a USB interface doesn't mean anything. */ | |
1783 | return 0; | |
1784 | } | |
1785 | ||
1786 | static int usb_runtime_idle(struct device *dev) | |
1787 | { | |
1788 | /* An idle USB device can be suspended if it passes the various | |
1789 | * autosuspend checks. An idle interface can be suspended at | |
1790 | * any time. | |
1791 | */ | |
1792 | if (is_usb_device(dev)) { | |
1793 | struct usb_device *udev = to_usb_device(dev); | |
1794 | ||
1795 | if (autosuspend_check(udev) != 0) | |
1796 | return 0; | |
1797 | } | |
1798 | ||
1799 | pm_runtime_suspend(dev); | |
1800 | return 0; | |
1801 | } | |
1802 | ||
1803 | static struct dev_pm_ops usb_bus_pm_ops = { | |
1804 | .runtime_suspend = usb_runtime_suspend, | |
1805 | .runtime_resume = usb_runtime_resume, | |
1806 | .runtime_idle = usb_runtime_idle, | |
1807 | }; | |
1808 | ||
1809 | #else | |
718efa64 | 1810 | |
9bbdf1e0 | 1811 | #define usb_bus_pm_ops (*(struct dev_pm_ops *) NULL) |
9ac39f28 | 1812 | |
645daaab | 1813 | #endif /* CONFIG_USB_SUSPEND */ |
a8e7c565 | 1814 | |
36e56a34 AS |
1815 | struct bus_type usb_bus_type = { |
1816 | .name = "usb", | |
1817 | .match = usb_device_match, | |
1818 | .uevent = usb_uevent, | |
9bbdf1e0 | 1819 | .pm = &usb_bus_pm_ops, |
36e56a34 | 1820 | }; |