hcd.c 50 KB

1234567891011121314151617181920212223242526272829303132333435363738394041424344454647484950515253545556575859606162636465666768697071727374757677787980818283848586878889909192939495969798991001011021031041051061071081091101111121131141151161171181191201211221231241251261271281291301311321331341351361371381391401411421431441451461471481491501511521531541551561571581591601611621631641651661671681691701711721731741751761771781791801811821831841851861871881891901911921931941951961971981992002012022032042052062072082092102112122132142152162172182192202212222232242252262272282292302312322332342352362372382392402412422432442452462472482492502512522532542552562572582592602612622632642652662672682692702712722732742752762772782792802812822832842852862872882892902912922932942952962972982993003013023033043053063073083093103113123133143153163173183193203213223233243253263273283293303313323333343353363373383393403413423433443453463473483493503513523533543553563573583593603613623633643653663673683693703713723733743753763773783793803813823833843853863873883893903913923933943953963973983994004014024034044054064074084094104114124134144154164174184194204214224234244254264274284294304314324334344354364374384394404414424434444454464474484494504514524534544554564574584594604614624634644654664674684694704714724734744754764774784794804814824834844854864874884894904914924934944954964974984995005015025035045055065075085095105115125135145155165175185195205215225235245255265275285295305315325335345355365375385395405415425435445455465475485495505515525535545555565575585595605615625635645655665675685695705715725735745755765775785795805815825835845855865875885895905915925935945955965975985996006016026036046056066076086096106116126136146156166176186196206216226236246256266276286296306316326336346356366376386396406416426436446456466476486496506516526536546556566576586596606616626636646656666676686696706716726736746756766776786796806816826836846856866876886896906916926936946956966976986997007017027037047057067077087097107117127137147157167177187197207217227237247257267277287297307317327337347357367377387397407417427437447457467477487497507517527537547557567577587597607617627637647657667677687697707717727737747757767777787797807817827837847857867877887897907917927937947957967977987998008018028038048058068078088098108118128138148158168178188198208218228238248258268278288298308318328338348358368378388398408418428438448458468478488498508518528538548558568578588598608618628638648658668678688698708718728738748758768778788798808818828838848858868878888898908918928938948958968978988999009019029039049059069079089099109119129139149159169179189199209219229239249259269279289299309319329339349359369379389399409419429439449459469479489499509519529539549559569579589599609619629639649659669679689699709719729739749759769779789799809819829839849859869879889899909919929939949959969979989991000100110021003100410051006100710081009101010111012101310141015101610171018101910201021102210231024102510261027102810291030103110321033103410351036103710381039104010411042104310441045104610471048104910501051105210531054105510561057105810591060106110621063106410651066106710681069107010711072107310741075107610771078107910801081108210831084108510861087108810891090109110921093109410951096109710981099110011011102110311041105110611071108110911101111111211131114111511161117111811191120112111221123112411251126112711281129113011311132113311341135113611371138113911401141114211431144114511461147114811491150115111521153115411551156115711581159116011611162116311641165116611671168116911701171117211731174117511761177117811791180118111821183118411851186118711881189119011911192119311941195119611971198119912001201120212031204120512061207120812091210121112121213121412151216121712181219122012211222122312241225122612271228122912301231123212331234123512361237123812391240124112421243124412451246124712481249125012511252125312541255125612571258125912601261126212631264126512661267126812691270127112721273127412751276127712781279128012811282128312841285128612871288128912901291129212931294129512961297129812991300130113021303130413051306130713081309131013111312131313141315131613171318131913201321132213231324132513261327132813291330133113321333133413351336133713381339134013411342134313441345134613471348134913501351135213531354135513561357135813591360136113621363136413651366136713681369137013711372137313741375137613771378137913801381138213831384138513861387138813891390139113921393139413951396139713981399140014011402140314041405140614071408140914101411141214131414141514161417141814191420142114221423142414251426142714281429143014311432143314341435143614371438143914401441144214431444144514461447144814491450145114521453145414551456145714581459146014611462146314641465146614671468146914701471147214731474147514761477147814791480148114821483148414851486148714881489149014911492149314941495149614971498149915001501150215031504150515061507150815091510151115121513151415151516151715181519152015211522152315241525152615271528152915301531153215331534153515361537153815391540154115421543154415451546154715481549155015511552155315541555155615571558155915601561156215631564156515661567156815691570157115721573157415751576157715781579158015811582158315841585158615871588158915901591159215931594159515961597159815991600160116021603160416051606160716081609161016111612161316141615161616171618161916201621162216231624162516261627162816291630163116321633163416351636163716381639164016411642164316441645164616471648164916501651165216531654165516561657165816591660166116621663166416651666166716681669167016711672167316741675167616771678167916801681168216831684168516861687168816891690169116921693169416951696169716981699170017011702170317041705170617071708170917101711171217131714171517161717171817191720172117221723172417251726172717281729173017311732173317341735173617371738173917401741174217431744174517461747174817491750175117521753175417551756175717581759
  1. /*
  2. * (C) Copyright Linus Torvalds 1999
  3. * (C) Copyright Johannes Erdfelt 1999-2001
  4. * (C) Copyright Andreas Gal 1999
  5. * (C) Copyright Gregory P. Smith 1999
  6. * (C) Copyright Deti Fliegl 1999
  7. * (C) Copyright Randy Dunlap 2000
  8. * (C) Copyright David Brownell 2000-2002
  9. *
  10. * This program is free software; you can redistribute it and/or modify it
  11. * under the terms of the GNU General Public License as published by the
  12. * Free Software Foundation; either version 2 of the License, or (at your
  13. * option) any later version.
  14. *
  15. * This program is distributed in the hope that it will be useful, but
  16. * WITHOUT ANY WARRANTY; without even the implied warranty of MERCHANTABILITY
  17. * or FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License
  18. * for more details.
  19. *
  20. * You should have received a copy of the GNU General Public License
  21. * along with this program; if not, write to the Free Software Foundation,
  22. * Inc., 675 Mass Ave, Cambridge, MA 02139, USA.
  23. */
  24. #include <linux/module.h>
  25. #include <linux/version.h>
  26. #include <linux/kernel.h>
  27. #include <linux/slab.h>
  28. #include <linux/completion.h>
  29. #include <linux/utsname.h>
  30. #include <linux/mm.h>
  31. #include <asm/io.h>
  32. #include <asm/scatterlist.h>
  33. #include <linux/device.h>
  34. #include <linux/dma-mapping.h>
  35. #include <linux/mutex.h>
  36. #include <asm/irq.h>
  37. #include <asm/byteorder.h>
  38. #include <linux/platform_device.h>
  39. #include <linux/workqueue.h>
  40. #include <linux/usb.h>
  41. #include "usb.h"
  42. #include "hcd.h"
  43. #include "hub.h"
  44. /*-------------------------------------------------------------------------*/
  45. /*
  46. * USB Host Controller Driver framework
  47. *
  48. * Plugs into usbcore (usb_bus) and lets HCDs share code, minimizing
  49. * HCD-specific behaviors/bugs.
  50. *
  51. * This does error checks, tracks devices and urbs, and delegates to a
  52. * "hc_driver" only for code (and data) that really needs to know about
  53. * hardware differences. That includes root hub registers, i/o queues,
  54. * and so on ... but as little else as possible.
  55. *
  56. * Shared code includes most of the "root hub" code (these are emulated,
  57. * though each HC's hardware works differently) and PCI glue, plus request
  58. * tracking overhead. The HCD code should only block on spinlocks or on
  59. * hardware handshaking; blocking on software events (such as other kernel
  60. * threads releasing resources, or completing actions) is all generic.
  61. *
  62. * Happens the USB 2.0 spec says this would be invisible inside the "USBD",
  63. * and includes mostly a "HCDI" (HCD Interface) along with some APIs used
  64. * only by the hub driver ... and that neither should be seen or used by
  65. * usb client device drivers.
  66. *
  67. * Contributors of ideas or unattributed patches include: David Brownell,
  68. * Roman Weissgaerber, Rory Bolt, Greg Kroah-Hartman, ...
  69. *
  70. * HISTORY:
  71. * 2002-02-21 Pull in most of the usb_bus support from usb.c; some
  72. * associated cleanup. "usb_hcd" still != "usb_bus".
  73. * 2001-12-12 Initial patch version for Linux 2.5.1 kernel.
  74. */
  75. /*-------------------------------------------------------------------------*/
  76. /* host controllers we manage */
  77. LIST_HEAD (usb_bus_list);
  78. EXPORT_SYMBOL_GPL (usb_bus_list);
  79. /* used when allocating bus numbers */
  80. #define USB_MAXBUS 64
  81. struct usb_busmap {
  82. unsigned long busmap [USB_MAXBUS / (8*sizeof (unsigned long))];
  83. };
  84. static struct usb_busmap busmap;
  85. /* used when updating list of hcds */
  86. DEFINE_MUTEX(usb_bus_list_lock); /* exported only for usbfs */
  87. EXPORT_SYMBOL_GPL (usb_bus_list_lock);
  88. /* used for controlling access to virtual root hubs */
  89. static DEFINE_SPINLOCK(hcd_root_hub_lock);
  90. /* used when updating an endpoint's URB list */
  91. static DEFINE_SPINLOCK(hcd_urb_list_lock);
  92. /* wait queue for synchronous unlinks */
  93. DECLARE_WAIT_QUEUE_HEAD(usb_kill_urb_queue);
  94. static inline int is_root_hub(struct usb_device *udev)
  95. {
  96. return (udev->parent == NULL);
  97. }
  98. /*-------------------------------------------------------------------------*/
  99. /*
  100. * Sharable chunks of root hub code.
  101. */
  102. /*-------------------------------------------------------------------------*/
  103. #define KERNEL_REL ((LINUX_VERSION_CODE >> 16) & 0x0ff)
  104. #define KERNEL_VER ((LINUX_VERSION_CODE >> 8) & 0x0ff)
  105. /* usb 2.0 root hub device descriptor */
  106. static const u8 usb2_rh_dev_descriptor [18] = {
  107. 0x12, /* __u8 bLength; */
  108. 0x01, /* __u8 bDescriptorType; Device */
  109. 0x00, 0x02, /* __le16 bcdUSB; v2.0 */
  110. 0x09, /* __u8 bDeviceClass; HUB_CLASSCODE */
  111. 0x00, /* __u8 bDeviceSubClass; */
  112. 0x01, /* __u8 bDeviceProtocol; [ usb 2.0 single TT ]*/
  113. 0x40, /* __u8 bMaxPacketSize0; 64 Bytes */
  114. 0x00, 0x00, /* __le16 idVendor; */
  115. 0x00, 0x00, /* __le16 idProduct; */
  116. KERNEL_VER, KERNEL_REL, /* __le16 bcdDevice */
  117. 0x03, /* __u8 iManufacturer; */
  118. 0x02, /* __u8 iProduct; */
  119. 0x01, /* __u8 iSerialNumber; */
  120. 0x01 /* __u8 bNumConfigurations; */
  121. };
  122. /* no usb 2.0 root hub "device qualifier" descriptor: one speed only */
  123. /* usb 1.1 root hub device descriptor */
  124. static const u8 usb11_rh_dev_descriptor [18] = {
  125. 0x12, /* __u8 bLength; */
  126. 0x01, /* __u8 bDescriptorType; Device */
  127. 0x10, 0x01, /* __le16 bcdUSB; v1.1 */
  128. 0x09, /* __u8 bDeviceClass; HUB_CLASSCODE */
  129. 0x00, /* __u8 bDeviceSubClass; */
  130. 0x00, /* __u8 bDeviceProtocol; [ low/full speeds only ] */
  131. 0x40, /* __u8 bMaxPacketSize0; 64 Bytes */
  132. 0x00, 0x00, /* __le16 idVendor; */
  133. 0x00, 0x00, /* __le16 idProduct; */
  134. KERNEL_VER, KERNEL_REL, /* __le16 bcdDevice */
  135. 0x03, /* __u8 iManufacturer; */
  136. 0x02, /* __u8 iProduct; */
  137. 0x01, /* __u8 iSerialNumber; */
  138. 0x01 /* __u8 bNumConfigurations; */
  139. };
  140. /*-------------------------------------------------------------------------*/
  141. /* Configuration descriptors for our root hubs */
  142. static const u8 fs_rh_config_descriptor [] = {
  143. /* one configuration */
  144. 0x09, /* __u8 bLength; */
  145. 0x02, /* __u8 bDescriptorType; Configuration */
  146. 0x19, 0x00, /* __le16 wTotalLength; */
  147. 0x01, /* __u8 bNumInterfaces; (1) */
  148. 0x01, /* __u8 bConfigurationValue; */
  149. 0x00, /* __u8 iConfiguration; */
  150. 0xc0, /* __u8 bmAttributes;
  151. Bit 7: must be set,
  152. 6: Self-powered,
  153. 5: Remote wakeup,
  154. 4..0: resvd */
  155. 0x00, /* __u8 MaxPower; */
  156. /* USB 1.1:
  157. * USB 2.0, single TT organization (mandatory):
  158. * one interface, protocol 0
  159. *
  160. * USB 2.0, multiple TT organization (optional):
  161. * two interfaces, protocols 1 (like single TT)
  162. * and 2 (multiple TT mode) ... config is
  163. * sometimes settable
  164. * NOT IMPLEMENTED
  165. */
  166. /* one interface */
  167. 0x09, /* __u8 if_bLength; */
  168. 0x04, /* __u8 if_bDescriptorType; Interface */
  169. 0x00, /* __u8 if_bInterfaceNumber; */
  170. 0x00, /* __u8 if_bAlternateSetting; */
  171. 0x01, /* __u8 if_bNumEndpoints; */
  172. 0x09, /* __u8 if_bInterfaceClass; HUB_CLASSCODE */
  173. 0x00, /* __u8 if_bInterfaceSubClass; */
  174. 0x00, /* __u8 if_bInterfaceProtocol; [usb1.1 or single tt] */
  175. 0x00, /* __u8 if_iInterface; */
  176. /* one endpoint (status change endpoint) */
  177. 0x07, /* __u8 ep_bLength; */
  178. 0x05, /* __u8 ep_bDescriptorType; Endpoint */
  179. 0x81, /* __u8 ep_bEndpointAddress; IN Endpoint 1 */
  180. 0x03, /* __u8 ep_bmAttributes; Interrupt */
  181. 0x02, 0x00, /* __le16 ep_wMaxPacketSize; 1 + (MAX_ROOT_PORTS / 8) */
  182. 0xff /* __u8 ep_bInterval; (255ms -- usb 2.0 spec) */
  183. };
  184. static const u8 hs_rh_config_descriptor [] = {
  185. /* one configuration */
  186. 0x09, /* __u8 bLength; */
  187. 0x02, /* __u8 bDescriptorType; Configuration */
  188. 0x19, 0x00, /* __le16 wTotalLength; */
  189. 0x01, /* __u8 bNumInterfaces; (1) */
  190. 0x01, /* __u8 bConfigurationValue; */
  191. 0x00, /* __u8 iConfiguration; */
  192. 0xc0, /* __u8 bmAttributes;
  193. Bit 7: must be set,
  194. 6: Self-powered,
  195. 5: Remote wakeup,
  196. 4..0: resvd */
  197. 0x00, /* __u8 MaxPower; */
  198. /* USB 1.1:
  199. * USB 2.0, single TT organization (mandatory):
  200. * one interface, protocol 0
  201. *
  202. * USB 2.0, multiple TT organization (optional):
  203. * two interfaces, protocols 1 (like single TT)
  204. * and 2 (multiple TT mode) ... config is
  205. * sometimes settable
  206. * NOT IMPLEMENTED
  207. */
  208. /* one interface */
  209. 0x09, /* __u8 if_bLength; */
  210. 0x04, /* __u8 if_bDescriptorType; Interface */
  211. 0x00, /* __u8 if_bInterfaceNumber; */
  212. 0x00, /* __u8 if_bAlternateSetting; */
  213. 0x01, /* __u8 if_bNumEndpoints; */
  214. 0x09, /* __u8 if_bInterfaceClass; HUB_CLASSCODE */
  215. 0x00, /* __u8 if_bInterfaceSubClass; */
  216. 0x00, /* __u8 if_bInterfaceProtocol; [usb1.1 or single tt] */
  217. 0x00, /* __u8 if_iInterface; */
  218. /* one endpoint (status change endpoint) */
  219. 0x07, /* __u8 ep_bLength; */
  220. 0x05, /* __u8 ep_bDescriptorType; Endpoint */
  221. 0x81, /* __u8 ep_bEndpointAddress; IN Endpoint 1 */
  222. 0x03, /* __u8 ep_bmAttributes; Interrupt */
  223. /* __le16 ep_wMaxPacketSize; 1 + (MAX_ROOT_PORTS / 8)
  224. * see hub.c:hub_configure() for details. */
  225. (USB_MAXCHILDREN + 1 + 7) / 8, 0x00,
  226. 0x0c /* __u8 ep_bInterval; (256ms -- usb 2.0 spec) */
  227. };
  228. /*-------------------------------------------------------------------------*/
  229. /*
  230. * helper routine for returning string descriptors in UTF-16LE
  231. * input can actually be ISO-8859-1; ASCII is its 7-bit subset
  232. */
  233. static int ascii2utf (char *s, u8 *utf, int utfmax)
  234. {
  235. int retval;
  236. for (retval = 0; *s && utfmax > 1; utfmax -= 2, retval += 2) {
  237. *utf++ = *s++;
  238. *utf++ = 0;
  239. }
  240. if (utfmax > 0) {
  241. *utf = *s;
  242. ++retval;
  243. }
  244. return retval;
  245. }
  246. /*
  247. * rh_string - provides manufacturer, product and serial strings for root hub
  248. * @id: the string ID number (1: serial number, 2: product, 3: vendor)
  249. * @hcd: the host controller for this root hub
  250. * @type: string describing our driver
  251. * @data: return packet in UTF-16 LE
  252. * @len: length of the return packet
  253. *
  254. * Produces either a manufacturer, product or serial number string for the
  255. * virtual root hub device.
  256. */
  257. static int rh_string (
  258. int id,
  259. struct usb_hcd *hcd,
  260. u8 *data,
  261. int len
  262. ) {
  263. char buf [100];
  264. // language ids
  265. if (id == 0) {
  266. buf[0] = 4; buf[1] = 3; /* 4 bytes string data */
  267. buf[2] = 0x09; buf[3] = 0x04; /* MSFT-speak for "en-us" */
  268. len = min (len, 4);
  269. memcpy (data, buf, len);
  270. return len;
  271. // serial number
  272. } else if (id == 1) {
  273. strlcpy (buf, hcd->self.bus_name, sizeof buf);
  274. // product description
  275. } else if (id == 2) {
  276. strlcpy (buf, hcd->product_desc, sizeof buf);
  277. // id 3 == vendor description
  278. } else if (id == 3) {
  279. snprintf (buf, sizeof buf, "%s %s %s", init_utsname()->sysname,
  280. init_utsname()->release, hcd->driver->description);
  281. // unsupported IDs --> "protocol stall"
  282. } else
  283. return -EPIPE;
  284. switch (len) { /* All cases fall through */
  285. default:
  286. len = 2 + ascii2utf (buf, data + 2, len - 2);
  287. case 2:
  288. data [1] = 3; /* type == string */
  289. case 1:
  290. data [0] = 2 * (strlen (buf) + 1);
  291. case 0:
  292. ; /* Compiler wants a statement here */
  293. }
  294. return len;
  295. }
  296. /* Root hub control transfers execute synchronously */
  297. static int rh_call_control (struct usb_hcd *hcd, struct urb *urb)
  298. {
  299. struct usb_ctrlrequest *cmd;
  300. u16 typeReq, wValue, wIndex, wLength;
  301. u8 *ubuf = urb->transfer_buffer;
  302. u8 tbuf [sizeof (struct usb_hub_descriptor)]
  303. __attribute__((aligned(4)));
  304. const u8 *bufp = tbuf;
  305. int len = 0;
  306. int patch_wakeup = 0;
  307. unsigned long flags;
  308. int status = 0;
  309. int n;
  310. cmd = (struct usb_ctrlrequest *) urb->setup_packet;
  311. typeReq = (cmd->bRequestType << 8) | cmd->bRequest;
  312. wValue = le16_to_cpu (cmd->wValue);
  313. wIndex = le16_to_cpu (cmd->wIndex);
  314. wLength = le16_to_cpu (cmd->wLength);
  315. if (wLength > urb->transfer_buffer_length)
  316. goto error;
  317. urb->actual_length = 0;
  318. switch (typeReq) {
  319. /* DEVICE REQUESTS */
  320. /* The root hub's remote wakeup enable bit is implemented using
  321. * driver model wakeup flags. If this system supports wakeup
  322. * through USB, userspace may change the default "allow wakeup"
  323. * policy through sysfs or these calls.
  324. *
  325. * Most root hubs support wakeup from downstream devices, for
  326. * runtime power management (disabling USB clocks and reducing
  327. * VBUS power usage). However, not all of them do so; silicon,
  328. * board, and BIOS bugs here are not uncommon, so these can't
  329. * be treated quite like external hubs.
  330. *
  331. * Likewise, not all root hubs will pass wakeup events upstream,
  332. * to wake up the whole system. So don't assume root hub and
  333. * controller capabilities are identical.
  334. */
  335. case DeviceRequest | USB_REQ_GET_STATUS:
  336. tbuf [0] = (device_may_wakeup(&hcd->self.root_hub->dev)
  337. << USB_DEVICE_REMOTE_WAKEUP)
  338. | (1 << USB_DEVICE_SELF_POWERED);
  339. tbuf [1] = 0;
  340. len = 2;
  341. break;
  342. case DeviceOutRequest | USB_REQ_CLEAR_FEATURE:
  343. if (wValue == USB_DEVICE_REMOTE_WAKEUP)
  344. device_set_wakeup_enable(&hcd->self.root_hub->dev, 0);
  345. else
  346. goto error;
  347. break;
  348. case DeviceOutRequest | USB_REQ_SET_FEATURE:
  349. if (device_can_wakeup(&hcd->self.root_hub->dev)
  350. && wValue == USB_DEVICE_REMOTE_WAKEUP)
  351. device_set_wakeup_enable(&hcd->self.root_hub->dev, 1);
  352. else
  353. goto error;
  354. break;
  355. case DeviceRequest | USB_REQ_GET_CONFIGURATION:
  356. tbuf [0] = 1;
  357. len = 1;
  358. /* FALLTHROUGH */
  359. case DeviceOutRequest | USB_REQ_SET_CONFIGURATION:
  360. break;
  361. case DeviceRequest | USB_REQ_GET_DESCRIPTOR:
  362. switch (wValue & 0xff00) {
  363. case USB_DT_DEVICE << 8:
  364. if (hcd->driver->flags & HCD_USB2)
  365. bufp = usb2_rh_dev_descriptor;
  366. else if (hcd->driver->flags & HCD_USB11)
  367. bufp = usb11_rh_dev_descriptor;
  368. else
  369. goto error;
  370. len = 18;
  371. break;
  372. case USB_DT_CONFIG << 8:
  373. if (hcd->driver->flags & HCD_USB2) {
  374. bufp = hs_rh_config_descriptor;
  375. len = sizeof hs_rh_config_descriptor;
  376. } else {
  377. bufp = fs_rh_config_descriptor;
  378. len = sizeof fs_rh_config_descriptor;
  379. }
  380. if (device_can_wakeup(&hcd->self.root_hub->dev))
  381. patch_wakeup = 1;
  382. break;
  383. case USB_DT_STRING << 8:
  384. n = rh_string (wValue & 0xff, hcd, ubuf, wLength);
  385. if (n < 0)
  386. goto error;
  387. urb->actual_length = n;
  388. break;
  389. default:
  390. goto error;
  391. }
  392. break;
  393. case DeviceRequest | USB_REQ_GET_INTERFACE:
  394. tbuf [0] = 0;
  395. len = 1;
  396. /* FALLTHROUGH */
  397. case DeviceOutRequest | USB_REQ_SET_INTERFACE:
  398. break;
  399. case DeviceOutRequest | USB_REQ_SET_ADDRESS:
  400. // wValue == urb->dev->devaddr
  401. dev_dbg (hcd->self.controller, "root hub device address %d\n",
  402. wValue);
  403. break;
  404. /* INTERFACE REQUESTS (no defined feature/status flags) */
  405. /* ENDPOINT REQUESTS */
  406. case EndpointRequest | USB_REQ_GET_STATUS:
  407. // ENDPOINT_HALT flag
  408. tbuf [0] = 0;
  409. tbuf [1] = 0;
  410. len = 2;
  411. /* FALLTHROUGH */
  412. case EndpointOutRequest | USB_REQ_CLEAR_FEATURE:
  413. case EndpointOutRequest | USB_REQ_SET_FEATURE:
  414. dev_dbg (hcd->self.controller, "no endpoint features yet\n");
  415. break;
  416. /* CLASS REQUESTS (and errors) */
  417. default:
  418. /* non-generic request */
  419. switch (typeReq) {
  420. case GetHubStatus:
  421. case GetPortStatus:
  422. len = 4;
  423. break;
  424. case GetHubDescriptor:
  425. len = sizeof (struct usb_hub_descriptor);
  426. break;
  427. }
  428. status = hcd->driver->hub_control (hcd,
  429. typeReq, wValue, wIndex,
  430. tbuf, wLength);
  431. break;
  432. error:
  433. /* "protocol stall" on error */
  434. status = -EPIPE;
  435. }
  436. if (status) {
  437. len = 0;
  438. if (status != -EPIPE) {
  439. dev_dbg (hcd->self.controller,
  440. "CTRL: TypeReq=0x%x val=0x%x "
  441. "idx=0x%x len=%d ==> %d\n",
  442. typeReq, wValue, wIndex,
  443. wLength, status);
  444. }
  445. }
  446. if (len) {
  447. if (urb->transfer_buffer_length < len)
  448. len = urb->transfer_buffer_length;
  449. urb->actual_length = len;
  450. // always USB_DIR_IN, toward host
  451. memcpy (ubuf, bufp, len);
  452. /* report whether RH hardware supports remote wakeup */
  453. if (patch_wakeup &&
  454. len > offsetof (struct usb_config_descriptor,
  455. bmAttributes))
  456. ((struct usb_config_descriptor *)ubuf)->bmAttributes
  457. |= USB_CONFIG_ATT_WAKEUP;
  458. }
  459. /* any errors get returned through the urb completion */
  460. local_irq_save (flags);
  461. spin_lock (&urb->lock);
  462. if (urb->status == -EINPROGRESS)
  463. urb->status = status;
  464. spin_unlock (&urb->lock);
  465. usb_hcd_giveback_urb (hcd, urb);
  466. local_irq_restore (flags);
  467. return 0;
  468. }
  469. /*-------------------------------------------------------------------------*/
  470. /*
  471. * Root Hub interrupt transfers are polled using a timer if the
  472. * driver requests it; otherwise the driver is responsible for
  473. * calling usb_hcd_poll_rh_status() when an event occurs.
  474. *
  475. * Completions are called in_interrupt(), but they may or may not
  476. * be in_irq().
  477. */
  478. void usb_hcd_poll_rh_status(struct usb_hcd *hcd)
  479. {
  480. struct urb *urb;
  481. int length;
  482. unsigned long flags;
  483. char buffer[4]; /* Any root hubs with > 31 ports? */
  484. if (unlikely(!hcd->rh_registered))
  485. return;
  486. if (!hcd->uses_new_polling && !hcd->status_urb)
  487. return;
  488. length = hcd->driver->hub_status_data(hcd, buffer);
  489. if (length > 0) {
  490. /* try to complete the status urb */
  491. local_irq_save (flags);
  492. spin_lock(&hcd_root_hub_lock);
  493. urb = hcd->status_urb;
  494. if (urb) {
  495. spin_lock(&urb->lock);
  496. if (urb->status == -EINPROGRESS) {
  497. hcd->poll_pending = 0;
  498. hcd->status_urb = NULL;
  499. urb->status = 0;
  500. urb->hcpriv = NULL;
  501. urb->actual_length = length;
  502. memcpy(urb->transfer_buffer, buffer, length);
  503. } else /* urb has been unlinked */
  504. length = 0;
  505. spin_unlock(&urb->lock);
  506. } else
  507. length = 0;
  508. spin_unlock(&hcd_root_hub_lock);
  509. /* local irqs are always blocked in completions */
  510. if (length > 0)
  511. usb_hcd_giveback_urb (hcd, urb);
  512. else
  513. hcd->poll_pending = 1;
  514. local_irq_restore (flags);
  515. }
  516. /* The USB 2.0 spec says 256 ms. This is close enough and won't
  517. * exceed that limit if HZ is 100. The math is more clunky than
  518. * maybe expected, this is to make sure that all timers for USB devices
  519. * fire at the same time to give the CPU a break inbetween */
  520. if (hcd->uses_new_polling ? hcd->poll_rh :
  521. (length == 0 && hcd->status_urb != NULL))
  522. mod_timer (&hcd->rh_timer, (jiffies/(HZ/4) + 1) * (HZ/4));
  523. }
  524. EXPORT_SYMBOL_GPL(usb_hcd_poll_rh_status);
  525. /* timer callback */
  526. static void rh_timer_func (unsigned long _hcd)
  527. {
  528. usb_hcd_poll_rh_status((struct usb_hcd *) _hcd);
  529. }
  530. /*-------------------------------------------------------------------------*/
  531. static int rh_queue_status (struct usb_hcd *hcd, struct urb *urb)
  532. {
  533. int retval;
  534. unsigned long flags;
  535. int len = 1 + (urb->dev->maxchild / 8);
  536. spin_lock_irqsave (&hcd_root_hub_lock, flags);
  537. if (urb->status != -EINPROGRESS) /* already unlinked */
  538. retval = urb->status;
  539. else if (hcd->status_urb || urb->transfer_buffer_length < len) {
  540. dev_dbg (hcd->self.controller, "not queuing rh status urb\n");
  541. retval = -EINVAL;
  542. } else {
  543. hcd->status_urb = urb;
  544. urb->hcpriv = hcd; /* indicate it's queued */
  545. if (!hcd->uses_new_polling)
  546. mod_timer (&hcd->rh_timer,
  547. (jiffies/(HZ/4) + 1) * (HZ/4));
  548. /* If a status change has already occurred, report it ASAP */
  549. else if (hcd->poll_pending)
  550. mod_timer (&hcd->rh_timer, jiffies);
  551. retval = 0;
  552. }
  553. spin_unlock_irqrestore (&hcd_root_hub_lock, flags);
  554. return retval;
  555. }
  556. static int rh_urb_enqueue (struct usb_hcd *hcd, struct urb *urb)
  557. {
  558. if (usb_pipeint (urb->pipe))
  559. return rh_queue_status (hcd, urb);
  560. if (usb_pipecontrol (urb->pipe))
  561. return rh_call_control (hcd, urb);
  562. return -EINVAL;
  563. }
  564. /*-------------------------------------------------------------------------*/
  565. /* Unlinks of root-hub control URBs are legal, but they don't do anything
  566. * since these URBs always execute synchronously.
  567. */
  568. static int usb_rh_urb_dequeue (struct usb_hcd *hcd, struct urb *urb)
  569. {
  570. unsigned long flags;
  571. if (usb_pipeendpoint(urb->pipe) == 0) { /* Control URB */
  572. ; /* Do nothing */
  573. } else { /* Status URB */
  574. if (!hcd->uses_new_polling)
  575. del_timer (&hcd->rh_timer);
  576. local_irq_save (flags);
  577. spin_lock (&hcd_root_hub_lock);
  578. if (urb == hcd->status_urb) {
  579. hcd->status_urb = NULL;
  580. urb->hcpriv = NULL;
  581. } else
  582. urb = NULL; /* wasn't fully queued */
  583. spin_unlock (&hcd_root_hub_lock);
  584. if (urb)
  585. usb_hcd_giveback_urb (hcd, urb);
  586. local_irq_restore (flags);
  587. }
  588. return 0;
  589. }
  590. /*-------------------------------------------------------------------------*/
  591. static struct class *usb_host_class;
  592. int usb_host_init(void)
  593. {
  594. int retval = 0;
  595. usb_host_class = class_create(THIS_MODULE, "usb_host");
  596. if (IS_ERR(usb_host_class))
  597. retval = PTR_ERR(usb_host_class);
  598. return retval;
  599. }
  600. void usb_host_cleanup(void)
  601. {
  602. class_destroy(usb_host_class);
  603. }
  604. /**
  605. * usb_bus_init - shared initialization code
  606. * @bus: the bus structure being initialized
  607. *
  608. * This code is used to initialize a usb_bus structure, memory for which is
  609. * separately managed.
  610. */
  611. static void usb_bus_init (struct usb_bus *bus)
  612. {
  613. memset (&bus->devmap, 0, sizeof(struct usb_devmap));
  614. bus->devnum_next = 1;
  615. bus->root_hub = NULL;
  616. bus->busnum = -1;
  617. bus->bandwidth_allocated = 0;
  618. bus->bandwidth_int_reqs = 0;
  619. bus->bandwidth_isoc_reqs = 0;
  620. INIT_LIST_HEAD (&bus->bus_list);
  621. }
  622. /*-------------------------------------------------------------------------*/
  623. /**
  624. * usb_register_bus - registers the USB host controller with the usb core
  625. * @bus: pointer to the bus to register
  626. * Context: !in_interrupt()
  627. *
  628. * Assigns a bus number, and links the controller into usbcore data
  629. * structures so that it can be seen by scanning the bus list.
  630. */
  631. static int usb_register_bus(struct usb_bus *bus)
  632. {
  633. int busnum;
  634. mutex_lock(&usb_bus_list_lock);
  635. busnum = find_next_zero_bit (busmap.busmap, USB_MAXBUS, 1);
  636. if (busnum < USB_MAXBUS) {
  637. set_bit (busnum, busmap.busmap);
  638. bus->busnum = busnum;
  639. } else {
  640. printk (KERN_ERR "%s: too many buses\n", usbcore_name);
  641. mutex_unlock(&usb_bus_list_lock);
  642. return -E2BIG;
  643. }
  644. bus->class_dev = class_device_create(usb_host_class, NULL, MKDEV(0,0),
  645. bus->controller, "usb_host%d", busnum);
  646. if (IS_ERR(bus->class_dev)) {
  647. clear_bit(busnum, busmap.busmap);
  648. mutex_unlock(&usb_bus_list_lock);
  649. return PTR_ERR(bus->class_dev);
  650. }
  651. class_set_devdata(bus->class_dev, bus);
  652. /* Add it to the local list of buses */
  653. list_add (&bus->bus_list, &usb_bus_list);
  654. mutex_unlock(&usb_bus_list_lock);
  655. usb_notify_add_bus(bus);
  656. dev_info (bus->controller, "new USB bus registered, assigned bus number %d\n", bus->busnum);
  657. return 0;
  658. }
  659. /**
  660. * usb_deregister_bus - deregisters the USB host controller
  661. * @bus: pointer to the bus to deregister
  662. * Context: !in_interrupt()
  663. *
  664. * Recycles the bus number, and unlinks the controller from usbcore data
  665. * structures so that it won't be seen by scanning the bus list.
  666. */
  667. static void usb_deregister_bus (struct usb_bus *bus)
  668. {
  669. dev_info (bus->controller, "USB bus %d deregistered\n", bus->busnum);
  670. /*
  671. * NOTE: make sure that all the devices are removed by the
  672. * controller code, as well as having it call this when cleaning
  673. * itself up
  674. */
  675. mutex_lock(&usb_bus_list_lock);
  676. list_del (&bus->bus_list);
  677. mutex_unlock(&usb_bus_list_lock);
  678. usb_notify_remove_bus(bus);
  679. clear_bit (bus->busnum, busmap.busmap);
  680. class_device_unregister(bus->class_dev);
  681. }
  682. /**
  683. * register_root_hub - called by usb_add_hcd() to register a root hub
  684. * @hcd: host controller for this root hub
  685. *
  686. * This function registers the root hub with the USB subsystem. It sets up
  687. * the device properly in the device tree and then calls usb_new_device()
  688. * to register the usb device. It also assigns the root hub's USB address
  689. * (always 1).
  690. */
  691. static int register_root_hub(struct usb_hcd *hcd)
  692. {
  693. struct device *parent_dev = hcd->self.controller;
  694. struct usb_device *usb_dev = hcd->self.root_hub;
  695. const int devnum = 1;
  696. int retval;
  697. usb_dev->devnum = devnum;
  698. usb_dev->bus->devnum_next = devnum + 1;
  699. memset (&usb_dev->bus->devmap.devicemap, 0,
  700. sizeof usb_dev->bus->devmap.devicemap);
  701. set_bit (devnum, usb_dev->bus->devmap.devicemap);
  702. usb_set_device_state(usb_dev, USB_STATE_ADDRESS);
  703. mutex_lock(&usb_bus_list_lock);
  704. usb_dev->ep0.desc.wMaxPacketSize = __constant_cpu_to_le16(64);
  705. retval = usb_get_device_descriptor(usb_dev, USB_DT_DEVICE_SIZE);
  706. if (retval != sizeof usb_dev->descriptor) {
  707. mutex_unlock(&usb_bus_list_lock);
  708. dev_dbg (parent_dev, "can't read %s device descriptor %d\n",
  709. usb_dev->dev.bus_id, retval);
  710. return (retval < 0) ? retval : -EMSGSIZE;
  711. }
  712. retval = usb_new_device (usb_dev);
  713. if (retval) {
  714. dev_err (parent_dev, "can't register root hub for %s, %d\n",
  715. usb_dev->dev.bus_id, retval);
  716. }
  717. mutex_unlock(&usb_bus_list_lock);
  718. if (retval == 0) {
  719. spin_lock_irq (&hcd_root_hub_lock);
  720. hcd->rh_registered = 1;
  721. spin_unlock_irq (&hcd_root_hub_lock);
  722. /* Did the HC die before the root hub was registered? */
  723. if (hcd->state == HC_STATE_HALT)
  724. usb_hc_died (hcd); /* This time clean up */
  725. }
  726. return retval;
  727. }
  728. void usb_enable_root_hub_irq (struct usb_bus *bus)
  729. {
  730. struct usb_hcd *hcd;
  731. hcd = container_of (bus, struct usb_hcd, self);
  732. if (hcd->driver->hub_irq_enable && hcd->state != HC_STATE_HALT)
  733. hcd->driver->hub_irq_enable (hcd);
  734. }
  735. /*-------------------------------------------------------------------------*/
  736. /**
  737. * usb_calc_bus_time - approximate periodic transaction time in nanoseconds
  738. * @speed: from dev->speed; USB_SPEED_{LOW,FULL,HIGH}
  739. * @is_input: true iff the transaction sends data to the host
  740. * @isoc: true for isochronous transactions, false for interrupt ones
  741. * @bytecount: how many bytes in the transaction.
  742. *
  743. * Returns approximate bus time in nanoseconds for a periodic transaction.
  744. * See USB 2.0 spec section 5.11.3; only periodic transfers need to be
  745. * scheduled in software, this function is only used for such scheduling.
  746. */
  747. long usb_calc_bus_time (int speed, int is_input, int isoc, int bytecount)
  748. {
  749. unsigned long tmp;
  750. switch (speed) {
  751. case USB_SPEED_LOW: /* INTR only */
  752. if (is_input) {
  753. tmp = (67667L * (31L + 10L * BitTime (bytecount))) / 1000L;
  754. return (64060L + (2 * BW_HUB_LS_SETUP) + BW_HOST_DELAY + tmp);
  755. } else {
  756. tmp = (66700L * (31L + 10L * BitTime (bytecount))) / 1000L;
  757. return (64107L + (2 * BW_HUB_LS_SETUP) + BW_HOST_DELAY + tmp);
  758. }
  759. case USB_SPEED_FULL: /* ISOC or INTR */
  760. if (isoc) {
  761. tmp = (8354L * (31L + 10L * BitTime (bytecount))) / 1000L;
  762. return (((is_input) ? 7268L : 6265L) + BW_HOST_DELAY + tmp);
  763. } else {
  764. tmp = (8354L * (31L + 10L * BitTime (bytecount))) / 1000L;
  765. return (9107L + BW_HOST_DELAY + tmp);
  766. }
  767. case USB_SPEED_HIGH: /* ISOC or INTR */
  768. // FIXME adjust for input vs output
  769. if (isoc)
  770. tmp = HS_NSECS_ISO (bytecount);
  771. else
  772. tmp = HS_NSECS (bytecount);
  773. return tmp;
  774. default:
  775. pr_debug ("%s: bogus device speed!\n", usbcore_name);
  776. return -1;
  777. }
  778. }
  779. EXPORT_SYMBOL (usb_calc_bus_time);
  780. /*-------------------------------------------------------------------------*/
  781. /*
  782. * Generic HC operations.
  783. */
  784. /*-------------------------------------------------------------------------*/
  785. static void urb_unlink(struct usb_hcd *hcd, struct urb *urb)
  786. {
  787. unsigned long flags;
  788. /* clear all state linking urb to this dev (and hcd) */
  789. spin_lock_irqsave(&hcd_urb_list_lock, flags);
  790. list_del_init (&urb->urb_list);
  791. spin_unlock_irqrestore(&hcd_urb_list_lock, flags);
  792. if (hcd->self.uses_dma && !is_root_hub(urb->dev)) {
  793. if (usb_pipecontrol (urb->pipe)
  794. && !(urb->transfer_flags & URB_NO_SETUP_DMA_MAP))
  795. dma_unmap_single (hcd->self.controller, urb->setup_dma,
  796. sizeof (struct usb_ctrlrequest),
  797. DMA_TO_DEVICE);
  798. if (urb->transfer_buffer_length != 0
  799. && !(urb->transfer_flags & URB_NO_TRANSFER_DMA_MAP))
  800. dma_unmap_single (hcd->self.controller,
  801. urb->transfer_dma,
  802. urb->transfer_buffer_length,
  803. usb_pipein (urb->pipe)
  804. ? DMA_FROM_DEVICE
  805. : DMA_TO_DEVICE);
  806. }
  807. }
  808. /* may be called in any context with a valid urb->dev usecount
  809. * caller surrenders "ownership" of urb
  810. * expects usb_submit_urb() to have sanity checked and conditioned all
  811. * inputs in the urb
  812. */
  813. int usb_hcd_submit_urb (struct urb *urb, gfp_t mem_flags)
  814. {
  815. int status;
  816. struct usb_hcd *hcd = bus_to_hcd(urb->dev->bus);
  817. struct usb_host_endpoint *ep;
  818. unsigned long flags;
  819. if (!hcd)
  820. return -ENODEV;
  821. usbmon_urb_submit(&hcd->self, urb);
  822. /*
  823. * Atomically queue the urb, first to our records, then to the HCD.
  824. * Access to urb->status is controlled by urb->lock ... changes on
  825. * i/o completion (normal or fault) or unlinking.
  826. */
  827. // FIXME: verify that quiescing hc works right (RH cleans up)
  828. spin_lock_irqsave(&hcd_urb_list_lock, flags);
  829. ep = (usb_pipein(urb->pipe) ? urb->dev->ep_in : urb->dev->ep_out)
  830. [usb_pipeendpoint(urb->pipe)];
  831. if (unlikely (!ep))
  832. status = -ENOENT;
  833. else if (unlikely (urb->reject))
  834. status = -EPERM;
  835. else switch (hcd->state) {
  836. case HC_STATE_RUNNING:
  837. case HC_STATE_RESUMING:
  838. list_add_tail (&urb->urb_list, &ep->urb_list);
  839. status = 0;
  840. break;
  841. default:
  842. status = -ESHUTDOWN;
  843. break;
  844. }
  845. spin_unlock_irqrestore(&hcd_urb_list_lock, flags);
  846. if (status) {
  847. INIT_LIST_HEAD (&urb->urb_list);
  848. usbmon_urb_submit_error(&hcd->self, urb, status);
  849. return status;
  850. }
  851. /* increment urb's reference count as part of giving it to the HCD
  852. * (which now controls it). HCD guarantees that it either returns
  853. * an error or calls giveback(), but not both.
  854. */
  855. urb = usb_get_urb (urb);
  856. atomic_inc (&urb->use_count);
  857. if (is_root_hub(urb->dev)) {
  858. /* NOTE: requirement on hub callers (usbfs and the hub
  859. * driver, for now) that URBs' urb->transfer_buffer be
  860. * valid and usb_buffer_{sync,unmap}() not be needed, since
  861. * they could clobber root hub response data.
  862. */
  863. status = rh_urb_enqueue (hcd, urb);
  864. goto done;
  865. }
  866. /* lower level hcd code should use *_dma exclusively,
  867. * unless it uses pio or talks to another transport.
  868. */
  869. if (hcd->self.uses_dma) {
  870. if (usb_pipecontrol (urb->pipe)
  871. && !(urb->transfer_flags & URB_NO_SETUP_DMA_MAP))
  872. urb->setup_dma = dma_map_single (
  873. hcd->self.controller,
  874. urb->setup_packet,
  875. sizeof (struct usb_ctrlrequest),
  876. DMA_TO_DEVICE);
  877. if (urb->transfer_buffer_length != 0
  878. && !(urb->transfer_flags & URB_NO_TRANSFER_DMA_MAP))
  879. urb->transfer_dma = dma_map_single (
  880. hcd->self.controller,
  881. urb->transfer_buffer,
  882. urb->transfer_buffer_length,
  883. usb_pipein (urb->pipe)
  884. ? DMA_FROM_DEVICE
  885. : DMA_TO_DEVICE);
  886. }
  887. status = hcd->driver->urb_enqueue (hcd, ep, urb, mem_flags);
  888. done:
  889. if (unlikely (status)) {
  890. urb_unlink(hcd, urb);
  891. atomic_dec (&urb->use_count);
  892. if (urb->reject)
  893. wake_up (&usb_kill_urb_queue);
  894. usbmon_urb_submit_error(&hcd->self, urb, status);
  895. usb_put_urb (urb);
  896. }
  897. return status;
  898. }
  899. /*-------------------------------------------------------------------------*/
  900. /* this makes the hcd giveback() the urb more quickly, by kicking it
  901. * off hardware queues (which may take a while) and returning it as
  902. * soon as practical. we've already set up the urb's return status,
  903. * but we can't know if the callback completed already.
  904. */
  905. static int
  906. unlink1 (struct usb_hcd *hcd, struct urb *urb)
  907. {
  908. int value;
  909. if (is_root_hub(urb->dev))
  910. value = usb_rh_urb_dequeue (hcd, urb);
  911. else {
  912. /* The only reason an HCD might fail this call is if
  913. * it has not yet fully queued the urb to begin with.
  914. * Such failures should be harmless. */
  915. value = hcd->driver->urb_dequeue (hcd, urb);
  916. }
  917. if (value != 0)
  918. dev_dbg (hcd->self.controller, "dequeue %p --> %d\n",
  919. urb, value);
  920. return value;
  921. }
  922. /*
  923. * called in any context
  924. *
  925. * caller guarantees urb won't be recycled till both unlink()
  926. * and the urb's completion function return
  927. */
  928. int usb_hcd_unlink_urb (struct urb *urb, int status)
  929. {
  930. struct usb_host_endpoint *ep;
  931. struct usb_hcd *hcd = NULL;
  932. struct device *sys = NULL;
  933. unsigned long flags;
  934. struct list_head *tmp;
  935. int retval;
  936. if (!urb)
  937. return -EINVAL;
  938. if (!urb->dev || !urb->dev->bus)
  939. return -ENODEV;
  940. ep = (usb_pipein(urb->pipe) ? urb->dev->ep_in : urb->dev->ep_out)
  941. [usb_pipeendpoint(urb->pipe)];
  942. if (!ep)
  943. return -ENODEV;
  944. /*
  945. * we contend for urb->status with the hcd core,
  946. * which changes it while returning the urb.
  947. *
  948. * Caller guaranteed that the urb pointer hasn't been freed, and
  949. * that it was submitted. But as a rule it can't know whether or
  950. * not it's already been unlinked ... so we respect the reversed
  951. * lock sequence needed for the usb_hcd_giveback_urb() code paths
  952. * (urb lock, then hcd_urb_list_lock) in case some other CPU is now
  953. * unlinking it.
  954. */
  955. spin_lock_irqsave (&urb->lock, flags);
  956. spin_lock(&hcd_urb_list_lock);
  957. sys = &urb->dev->dev;
  958. hcd = bus_to_hcd(urb->dev->bus);
  959. if (hcd == NULL) {
  960. retval = -ENODEV;
  961. goto done;
  962. }
  963. /* insist the urb is still queued */
  964. list_for_each(tmp, &ep->urb_list) {
  965. if (tmp == &urb->urb_list)
  966. break;
  967. }
  968. if (tmp != &urb->urb_list) {
  969. retval = -EIDRM;
  970. goto done;
  971. }
  972. /* Any status except -EINPROGRESS means something already started to
  973. * unlink this URB from the hardware. So there's no more work to do.
  974. */
  975. if (urb->status != -EINPROGRESS) {
  976. retval = -EBUSY;
  977. goto done;
  978. }
  979. /* IRQ setup can easily be broken so that USB controllers
  980. * never get completion IRQs ... maybe even the ones we need to
  981. * finish unlinking the initial failed usb_set_address()
  982. * or device descriptor fetch.
  983. */
  984. if (!test_bit(HCD_FLAG_SAW_IRQ, &hcd->flags) &&
  985. !is_root_hub(urb->dev)) {
  986. dev_warn (hcd->self.controller, "Unlink after no-IRQ? "
  987. "Controller is probably using the wrong IRQ.\n");
  988. set_bit(HCD_FLAG_SAW_IRQ, &hcd->flags);
  989. }
  990. urb->status = status;
  991. spin_unlock(&hcd_urb_list_lock);
  992. spin_unlock_irqrestore (&urb->lock, flags);
  993. retval = unlink1 (hcd, urb);
  994. if (retval == 0)
  995. retval = -EINPROGRESS;
  996. return retval;
  997. done:
  998. spin_unlock(&hcd_urb_list_lock);
  999. spin_unlock_irqrestore (&urb->lock, flags);
  1000. if (retval != -EIDRM && sys && sys->driver)
  1001. dev_dbg (sys, "hcd_unlink_urb %p fail %d\n", urb, retval);
  1002. return retval;
  1003. }
  1004. /*-------------------------------------------------------------------------*/
  1005. /**
  1006. * usb_hcd_giveback_urb - return URB from HCD to device driver
  1007. * @hcd: host controller returning the URB
  1008. * @urb: urb being returned to the USB device driver.
  1009. * Context: in_interrupt()
  1010. *
  1011. * This hands the URB from HCD to its USB device driver, using its
  1012. * completion function. The HCD has freed all per-urb resources
  1013. * (and is done using urb->hcpriv). It also released all HCD locks;
  1014. * the device driver won't cause problems if it frees, modifies,
  1015. * or resubmits this URB.
  1016. */
  1017. void usb_hcd_giveback_urb (struct usb_hcd *hcd, struct urb *urb)
  1018. {
  1019. urb_unlink(hcd, urb);
  1020. usbmon_urb_complete (&hcd->self, urb);
  1021. usb_unanchor_urb(urb);
  1022. /* pass ownership to the completion handler */
  1023. urb->complete (urb);
  1024. atomic_dec (&urb->use_count);
  1025. if (unlikely (urb->reject))
  1026. wake_up (&usb_kill_urb_queue);
  1027. usb_put_urb (urb);
  1028. }
  1029. EXPORT_SYMBOL (usb_hcd_giveback_urb);
  1030. /*-------------------------------------------------------------------------*/
  1031. /* disables the endpoint: cancels any pending urbs, then synchronizes with
  1032. * the hcd to make sure all endpoint state is gone from hardware, and then
  1033. * waits until the endpoint's queue is completely drained. use for
  1034. * set_configuration, set_interface, driver removal, physical disconnect.
  1035. *
  1036. * example: a qh stored in ep->hcpriv, holding state related to endpoint
  1037. * type, maxpacket size, toggle, halt status, and scheduling.
  1038. */
  1039. void usb_hcd_endpoint_disable (struct usb_device *udev,
  1040. struct usb_host_endpoint *ep)
  1041. {
  1042. struct usb_hcd *hcd;
  1043. struct urb *urb;
  1044. hcd = bus_to_hcd(udev->bus);
  1045. local_irq_disable ();
  1046. /* ep is already gone from udev->ep_{in,out}[]; no more submits */
  1047. rescan:
  1048. spin_lock(&hcd_urb_list_lock);
  1049. list_for_each_entry (urb, &ep->urb_list, urb_list) {
  1050. int tmp;
  1051. /* the urb may already have been unlinked */
  1052. if (urb->status != -EINPROGRESS)
  1053. continue;
  1054. usb_get_urb (urb);
  1055. spin_unlock(&hcd_urb_list_lock);
  1056. spin_lock (&urb->lock);
  1057. tmp = urb->status;
  1058. if (tmp == -EINPROGRESS)
  1059. urb->status = -ESHUTDOWN;
  1060. spin_unlock (&urb->lock);
  1061. /* kick hcd unless it's already returning this */
  1062. if (tmp == -EINPROGRESS) {
  1063. tmp = urb->pipe;
  1064. unlink1 (hcd, urb);
  1065. dev_dbg (hcd->self.controller,
  1066. "shutdown urb %p pipe %08x ep%d%s%s\n",
  1067. urb, tmp, usb_pipeendpoint (tmp),
  1068. (tmp & USB_DIR_IN) ? "in" : "out",
  1069. ({ char *s; \
  1070. switch (usb_pipetype (tmp)) { \
  1071. case PIPE_CONTROL: s = ""; break; \
  1072. case PIPE_BULK: s = "-bulk"; break; \
  1073. case PIPE_INTERRUPT: s = "-intr"; break; \
  1074. default: s = "-iso"; break; \
  1075. }; s;}));
  1076. }
  1077. usb_put_urb (urb);
  1078. /* list contents may have changed */
  1079. goto rescan;
  1080. }
  1081. spin_unlock(&hcd_urb_list_lock);
  1082. local_irq_enable ();
  1083. /* synchronize with the hardware, so old configuration state
  1084. * clears out immediately (and will be freed).
  1085. */
  1086. might_sleep ();
  1087. if (hcd->driver->endpoint_disable)
  1088. hcd->driver->endpoint_disable (hcd, ep);
  1089. /* Wait until the endpoint queue is completely empty. Most HCDs
  1090. * will have done this already in their endpoint_disable method,
  1091. * but some might not. And there could be root-hub control URBs
  1092. * still pending since they aren't affected by the HCDs'
  1093. * endpoint_disable methods.
  1094. */
  1095. while (!list_empty (&ep->urb_list)) {
  1096. spin_lock_irq(&hcd_urb_list_lock);
  1097. /* The list may have changed while we acquired the spinlock */
  1098. urb = NULL;
  1099. if (!list_empty (&ep->urb_list)) {
  1100. urb = list_entry (ep->urb_list.prev, struct urb,
  1101. urb_list);
  1102. usb_get_urb (urb);
  1103. }
  1104. spin_unlock_irq(&hcd_urb_list_lock);
  1105. if (urb) {
  1106. usb_kill_urb (urb);
  1107. usb_put_urb (urb);
  1108. }
  1109. }
  1110. }
  1111. /*-------------------------------------------------------------------------*/
  1112. /* called in any context */
  1113. int usb_hcd_get_frame_number (struct usb_device *udev)
  1114. {
  1115. struct usb_hcd *hcd = bus_to_hcd(udev->bus);
  1116. if (!HC_IS_RUNNING (hcd->state))
  1117. return -ESHUTDOWN;
  1118. return hcd->driver->get_frame_number (hcd);
  1119. }
  1120. /*-------------------------------------------------------------------------*/
  1121. #ifdef CONFIG_PM
  1122. int hcd_bus_suspend(struct usb_device *rhdev)
  1123. {
  1124. struct usb_hcd *hcd = container_of(rhdev->bus, struct usb_hcd, self);
  1125. int status;
  1126. int old_state = hcd->state;
  1127. dev_dbg(&rhdev->dev, "bus %s%s\n",
  1128. rhdev->auto_pm ? "auto-" : "", "suspend");
  1129. if (!hcd->driver->bus_suspend) {
  1130. status = -ENOENT;
  1131. } else {
  1132. hcd->state = HC_STATE_QUIESCING;
  1133. status = hcd->driver->bus_suspend(hcd);
  1134. }
  1135. if (status == 0) {
  1136. usb_set_device_state(rhdev, USB_STATE_SUSPENDED);
  1137. hcd->state = HC_STATE_SUSPENDED;
  1138. } else {
  1139. hcd->state = old_state;
  1140. dev_dbg(&rhdev->dev, "bus %s fail, err %d\n",
  1141. "suspend", status);
  1142. }
  1143. return status;
  1144. }
  1145. int hcd_bus_resume(struct usb_device *rhdev)
  1146. {
  1147. struct usb_hcd *hcd = container_of(rhdev->bus, struct usb_hcd, self);
  1148. int status;
  1149. int old_state = hcd->state;
  1150. dev_dbg(&rhdev->dev, "usb %s%s\n",
  1151. rhdev->auto_pm ? "auto-" : "", "resume");
  1152. if (!hcd->driver->bus_resume)
  1153. return -ENOENT;
  1154. if (hcd->state == HC_STATE_RUNNING)
  1155. return 0;
  1156. hcd->state = HC_STATE_RESUMING;
  1157. status = hcd->driver->bus_resume(hcd);
  1158. if (status == 0) {
  1159. /* TRSMRCY = 10 msec */
  1160. msleep(10);
  1161. usb_set_device_state(rhdev, rhdev->actconfig
  1162. ? USB_STATE_CONFIGURED
  1163. : USB_STATE_ADDRESS);
  1164. hcd->state = HC_STATE_RUNNING;
  1165. } else {
  1166. hcd->state = old_state;
  1167. dev_dbg(&rhdev->dev, "bus %s fail, err %d\n",
  1168. "resume", status);
  1169. if (status != -ESHUTDOWN)
  1170. usb_hc_died(hcd);
  1171. }
  1172. return status;
  1173. }
  1174. /* Workqueue routine for root-hub remote wakeup */
  1175. static void hcd_resume_work(struct work_struct *work)
  1176. {
  1177. struct usb_hcd *hcd = container_of(work, struct usb_hcd, wakeup_work);
  1178. struct usb_device *udev = hcd->self.root_hub;
  1179. usb_lock_device(udev);
  1180. usb_mark_last_busy(udev);
  1181. usb_external_resume_device(udev);
  1182. usb_unlock_device(udev);
  1183. }
  1184. /**
  1185. * usb_hcd_resume_root_hub - called by HCD to resume its root hub
  1186. * @hcd: host controller for this root hub
  1187. *
  1188. * The USB host controller calls this function when its root hub is
  1189. * suspended (with the remote wakeup feature enabled) and a remote
  1190. * wakeup request is received. The routine submits a workqueue request
  1191. * to resume the root hub (that is, manage its downstream ports again).
  1192. */
  1193. void usb_hcd_resume_root_hub (struct usb_hcd *hcd)
  1194. {
  1195. unsigned long flags;
  1196. spin_lock_irqsave (&hcd_root_hub_lock, flags);
  1197. if (hcd->rh_registered)
  1198. queue_work(ksuspend_usb_wq, &hcd->wakeup_work);
  1199. spin_unlock_irqrestore (&hcd_root_hub_lock, flags);
  1200. }
  1201. EXPORT_SYMBOL_GPL(usb_hcd_resume_root_hub);
  1202. #endif
  1203. /*-------------------------------------------------------------------------*/
  1204. #ifdef CONFIG_USB_OTG
  1205. /**
  1206. * usb_bus_start_enum - start immediate enumeration (for OTG)
  1207. * @bus: the bus (must use hcd framework)
  1208. * @port_num: 1-based number of port; usually bus->otg_port
  1209. * Context: in_interrupt()
  1210. *
  1211. * Starts enumeration, with an immediate reset followed later by
  1212. * khubd identifying and possibly configuring the device.
  1213. * This is needed by OTG controller drivers, where it helps meet
  1214. * HNP protocol timing requirements for starting a port reset.
  1215. */
  1216. int usb_bus_start_enum(struct usb_bus *bus, unsigned port_num)
  1217. {
  1218. struct usb_hcd *hcd;
  1219. int status = -EOPNOTSUPP;
  1220. /* NOTE: since HNP can't start by grabbing the bus's address0_sem,
  1221. * boards with root hubs hooked up to internal devices (instead of
  1222. * just the OTG port) may need more attention to resetting...
  1223. */
  1224. hcd = container_of (bus, struct usb_hcd, self);
  1225. if (port_num && hcd->driver->start_port_reset)
  1226. status = hcd->driver->start_port_reset(hcd, port_num);
  1227. /* run khubd shortly after (first) root port reset finishes;
  1228. * it may issue others, until at least 50 msecs have passed.
  1229. */
  1230. if (status == 0)
  1231. mod_timer(&hcd->rh_timer, jiffies + msecs_to_jiffies(10));
  1232. return status;
  1233. }
  1234. EXPORT_SYMBOL (usb_bus_start_enum);
  1235. #endif
  1236. /*-------------------------------------------------------------------------*/
  1237. /**
  1238. * usb_hcd_irq - hook IRQs to HCD framework (bus glue)
  1239. * @irq: the IRQ being raised
  1240. * @__hcd: pointer to the HCD whose IRQ is being signaled
  1241. * @r: saved hardware registers
  1242. *
  1243. * If the controller isn't HALTed, calls the driver's irq handler.
  1244. * Checks whether the controller is now dead.
  1245. */
  1246. irqreturn_t usb_hcd_irq (int irq, void *__hcd)
  1247. {
  1248. struct usb_hcd *hcd = __hcd;
  1249. int start = hcd->state;
  1250. if (unlikely(start == HC_STATE_HALT ||
  1251. !test_bit(HCD_FLAG_HW_ACCESSIBLE, &hcd->flags)))
  1252. return IRQ_NONE;
  1253. if (hcd->driver->irq (hcd) == IRQ_NONE)
  1254. return IRQ_NONE;
  1255. set_bit(HCD_FLAG_SAW_IRQ, &hcd->flags);
  1256. if (unlikely(hcd->state == HC_STATE_HALT))
  1257. usb_hc_died (hcd);
  1258. return IRQ_HANDLED;
  1259. }
  1260. /*-------------------------------------------------------------------------*/
  1261. /**
  1262. * usb_hc_died - report abnormal shutdown of a host controller (bus glue)
  1263. * @hcd: pointer to the HCD representing the controller
  1264. *
  1265. * This is called by bus glue to report a USB host controller that died
  1266. * while operations may still have been pending. It's called automatically
  1267. * by the PCI glue, so only glue for non-PCI busses should need to call it.
  1268. */
  1269. void usb_hc_died (struct usb_hcd *hcd)
  1270. {
  1271. unsigned long flags;
  1272. dev_err (hcd->self.controller, "HC died; cleaning up\n");
  1273. spin_lock_irqsave (&hcd_root_hub_lock, flags);
  1274. if (hcd->rh_registered) {
  1275. hcd->poll_rh = 0;
  1276. /* make khubd clean up old urbs and devices */
  1277. usb_set_device_state (hcd->self.root_hub,
  1278. USB_STATE_NOTATTACHED);
  1279. usb_kick_khubd (hcd->self.root_hub);
  1280. }
  1281. spin_unlock_irqrestore (&hcd_root_hub_lock, flags);
  1282. }
  1283. EXPORT_SYMBOL_GPL (usb_hc_died);
  1284. /*-------------------------------------------------------------------------*/
  1285. /**
  1286. * usb_create_hcd - create and initialize an HCD structure
  1287. * @driver: HC driver that will use this hcd
  1288. * @dev: device for this HC, stored in hcd->self.controller
  1289. * @bus_name: value to store in hcd->self.bus_name
  1290. * Context: !in_interrupt()
  1291. *
  1292. * Allocate a struct usb_hcd, with extra space at the end for the
  1293. * HC driver's private data. Initialize the generic members of the
  1294. * hcd structure.
  1295. *
  1296. * If memory is unavailable, returns NULL.
  1297. */
  1298. struct usb_hcd *usb_create_hcd (const struct hc_driver *driver,
  1299. struct device *dev, char *bus_name)
  1300. {
  1301. struct usb_hcd *hcd;
  1302. hcd = kzalloc(sizeof(*hcd) + driver->hcd_priv_size, GFP_KERNEL);
  1303. if (!hcd) {
  1304. dev_dbg (dev, "hcd alloc failed\n");
  1305. return NULL;
  1306. }
  1307. dev_set_drvdata(dev, hcd);
  1308. kref_init(&hcd->kref);
  1309. usb_bus_init(&hcd->self);
  1310. hcd->self.controller = dev;
  1311. hcd->self.bus_name = bus_name;
  1312. hcd->self.uses_dma = (dev->dma_mask != NULL);
  1313. init_timer(&hcd->rh_timer);
  1314. hcd->rh_timer.function = rh_timer_func;
  1315. hcd->rh_timer.data = (unsigned long) hcd;
  1316. #ifdef CONFIG_PM
  1317. INIT_WORK(&hcd->wakeup_work, hcd_resume_work);
  1318. #endif
  1319. hcd->driver = driver;
  1320. hcd->product_desc = (driver->product_desc) ? driver->product_desc :
  1321. "USB Host Controller";
  1322. return hcd;
  1323. }
  1324. EXPORT_SYMBOL (usb_create_hcd);
  1325. static void hcd_release (struct kref *kref)
  1326. {
  1327. struct usb_hcd *hcd = container_of (kref, struct usb_hcd, kref);
  1328. kfree(hcd);
  1329. }
  1330. struct usb_hcd *usb_get_hcd (struct usb_hcd *hcd)
  1331. {
  1332. if (hcd)
  1333. kref_get (&hcd->kref);
  1334. return hcd;
  1335. }
  1336. EXPORT_SYMBOL (usb_get_hcd);
  1337. void usb_put_hcd (struct usb_hcd *hcd)
  1338. {
  1339. if (hcd)
  1340. kref_put (&hcd->kref, hcd_release);
  1341. }
  1342. EXPORT_SYMBOL (usb_put_hcd);
  1343. /**
  1344. * usb_add_hcd - finish generic HCD structure initialization and register
  1345. * @hcd: the usb_hcd structure to initialize
  1346. * @irqnum: Interrupt line to allocate
  1347. * @irqflags: Interrupt type flags
  1348. *
  1349. * Finish the remaining parts of generic HCD initialization: allocate the
  1350. * buffers of consistent memory, register the bus, request the IRQ line,
  1351. * and call the driver's reset() and start() routines.
  1352. */
  1353. int usb_add_hcd(struct usb_hcd *hcd,
  1354. unsigned int irqnum, unsigned long irqflags)
  1355. {
  1356. int retval;
  1357. struct usb_device *rhdev;
  1358. dev_info(hcd->self.controller, "%s\n", hcd->product_desc);
  1359. set_bit(HCD_FLAG_HW_ACCESSIBLE, &hcd->flags);
  1360. /* HC is in reset state, but accessible. Now do the one-time init,
  1361. * bottom up so that hcds can customize the root hubs before khubd
  1362. * starts talking to them. (Note, bus id is assigned early too.)
  1363. */
  1364. if ((retval = hcd_buffer_create(hcd)) != 0) {
  1365. dev_dbg(hcd->self.controller, "pool alloc failed\n");
  1366. return retval;
  1367. }
  1368. if ((retval = usb_register_bus(&hcd->self)) < 0)
  1369. goto err_register_bus;
  1370. if ((rhdev = usb_alloc_dev(NULL, &hcd->self, 0)) == NULL) {
  1371. dev_err(hcd->self.controller, "unable to allocate root hub\n");
  1372. retval = -ENOMEM;
  1373. goto err_allocate_root_hub;
  1374. }
  1375. rhdev->speed = (hcd->driver->flags & HCD_USB2) ? USB_SPEED_HIGH :
  1376. USB_SPEED_FULL;
  1377. hcd->self.root_hub = rhdev;
  1378. /* wakeup flag init defaults to "everything works" for root hubs,
  1379. * but drivers can override it in reset() if needed, along with
  1380. * recording the overall controller's system wakeup capability.
  1381. */
  1382. device_init_wakeup(&rhdev->dev, 1);
  1383. /* "reset" is misnamed; its role is now one-time init. the controller
  1384. * should already have been reset (and boot firmware kicked off etc).
  1385. */
  1386. if (hcd->driver->reset && (retval = hcd->driver->reset(hcd)) < 0) {
  1387. dev_err(hcd->self.controller, "can't setup\n");
  1388. goto err_hcd_driver_setup;
  1389. }
  1390. /* NOTE: root hub and controller capabilities may not be the same */
  1391. if (device_can_wakeup(hcd->self.controller)
  1392. && device_can_wakeup(&hcd->self.root_hub->dev))
  1393. dev_dbg(hcd->self.controller, "supports USB remote wakeup\n");
  1394. /* enable irqs just before we start the controller */
  1395. if (hcd->driver->irq) {
  1396. snprintf(hcd->irq_descr, sizeof(hcd->irq_descr), "%s:usb%d",
  1397. hcd->driver->description, hcd->self.busnum);
  1398. if ((retval = request_irq(irqnum, &usb_hcd_irq, irqflags,
  1399. hcd->irq_descr, hcd)) != 0) {
  1400. dev_err(hcd->self.controller,
  1401. "request interrupt %d failed\n", irqnum);
  1402. goto err_request_irq;
  1403. }
  1404. hcd->irq = irqnum;
  1405. dev_info(hcd->self.controller, "irq %d, %s 0x%08llx\n", irqnum,
  1406. (hcd->driver->flags & HCD_MEMORY) ?
  1407. "io mem" : "io base",
  1408. (unsigned long long)hcd->rsrc_start);
  1409. } else {
  1410. hcd->irq = -1;
  1411. if (hcd->rsrc_start)
  1412. dev_info(hcd->self.controller, "%s 0x%08llx\n",
  1413. (hcd->driver->flags & HCD_MEMORY) ?
  1414. "io mem" : "io base",
  1415. (unsigned long long)hcd->rsrc_start);
  1416. }
  1417. if ((retval = hcd->driver->start(hcd)) < 0) {
  1418. dev_err(hcd->self.controller, "startup error %d\n", retval);
  1419. goto err_hcd_driver_start;
  1420. }
  1421. /* starting here, usbcore will pay attention to this root hub */
  1422. rhdev->bus_mA = min(500u, hcd->power_budget);
  1423. if ((retval = register_root_hub(hcd)) != 0)
  1424. goto err_register_root_hub;
  1425. if (hcd->uses_new_polling && hcd->poll_rh)
  1426. usb_hcd_poll_rh_status(hcd);
  1427. return retval;
  1428. err_register_root_hub:
  1429. hcd->driver->stop(hcd);
  1430. err_hcd_driver_start:
  1431. if (hcd->irq >= 0)
  1432. free_irq(irqnum, hcd);
  1433. err_request_irq:
  1434. err_hcd_driver_setup:
  1435. hcd->self.root_hub = NULL;
  1436. usb_put_dev(rhdev);
  1437. err_allocate_root_hub:
  1438. usb_deregister_bus(&hcd->self);
  1439. err_register_bus:
  1440. hcd_buffer_destroy(hcd);
  1441. return retval;
  1442. }
  1443. EXPORT_SYMBOL (usb_add_hcd);
  1444. /**
  1445. * usb_remove_hcd - shutdown processing for generic HCDs
  1446. * @hcd: the usb_hcd structure to remove
  1447. * Context: !in_interrupt()
  1448. *
  1449. * Disconnects the root hub, then reverses the effects of usb_add_hcd(),
  1450. * invoking the HCD's stop() method.
  1451. */
  1452. void usb_remove_hcd(struct usb_hcd *hcd)
  1453. {
  1454. dev_info(hcd->self.controller, "remove, state %x\n", hcd->state);
  1455. if (HC_IS_RUNNING (hcd->state))
  1456. hcd->state = HC_STATE_QUIESCING;
  1457. dev_dbg(hcd->self.controller, "roothub graceful disconnect\n");
  1458. spin_lock_irq (&hcd_root_hub_lock);
  1459. hcd->rh_registered = 0;
  1460. spin_unlock_irq (&hcd_root_hub_lock);
  1461. #ifdef CONFIG_PM
  1462. cancel_work_sync(&hcd->wakeup_work);
  1463. #endif
  1464. mutex_lock(&usb_bus_list_lock);
  1465. usb_disconnect(&hcd->self.root_hub);
  1466. mutex_unlock(&usb_bus_list_lock);
  1467. hcd->driver->stop(hcd);
  1468. hcd->state = HC_STATE_HALT;
  1469. hcd->poll_rh = 0;
  1470. del_timer_sync(&hcd->rh_timer);
  1471. if (hcd->irq >= 0)
  1472. free_irq(hcd->irq, hcd);
  1473. usb_deregister_bus(&hcd->self);
  1474. hcd_buffer_destroy(hcd);
  1475. }
  1476. EXPORT_SYMBOL (usb_remove_hcd);
  1477. void
  1478. usb_hcd_platform_shutdown(struct platform_device* dev)
  1479. {
  1480. struct usb_hcd *hcd = platform_get_drvdata(dev);
  1481. if (hcd->driver->shutdown)
  1482. hcd->driver->shutdown(hcd);
  1483. }
  1484. EXPORT_SYMBOL (usb_hcd_platform_shutdown);
  1485. /*-------------------------------------------------------------------------*/
  1486. #if defined(CONFIG_USB_MON)
  1487. struct usb_mon_operations *mon_ops;
  1488. /*
  1489. * The registration is unlocked.
  1490. * We do it this way because we do not want to lock in hot paths.
  1491. *
  1492. * Notice that the code is minimally error-proof. Because usbmon needs
  1493. * symbols from usbcore, usbcore gets referenced and cannot be unloaded first.
  1494. */
  1495. int usb_mon_register (struct usb_mon_operations *ops)
  1496. {
  1497. if (mon_ops)
  1498. return -EBUSY;
  1499. mon_ops = ops;
  1500. mb();
  1501. return 0;
  1502. }
  1503. EXPORT_SYMBOL_GPL (usb_mon_register);
  1504. void usb_mon_deregister (void)
  1505. {
  1506. if (mon_ops == NULL) {
  1507. printk(KERN_ERR "USB: monitor was not registered\n");
  1508. return;
  1509. }
  1510. mon_ops = NULL;
  1511. mb();
  1512. }
  1513. EXPORT_SYMBOL_GPL (usb_mon_deregister);
  1514. #endif /* CONFIG_USB_MON */