core.c 43 KB

1234567891011121314151617181920212223242526272829303132333435363738394041424344454647484950515253545556575859606162636465666768697071727374757677787980818283848586878889909192939495969798991001011021031041051061071081091101111121131141151161171181191201211221231241251261271281291301311321331341351361371381391401411421431441451461471481491501511521531541551561571581591601611621631641651661671681691701711721731741751761771781791801811821831841851861871881891901911921931941951961971981992002012022032042052062072082092102112122132142152162172182192202212222232242252262272282292302312322332342352362372382392402412422432442452462472482492502512522532542552562572582592602612622632642652662672682692702712722732742752762772782792802812822832842852862872882892902912922932942952962972982993003013023033043053063073083093103113123133143153163173183193203213223233243253263273283293303313323333343353363373383393403413423433443453463473483493503513523533543553563573583593603613623633643653663673683693703713723733743753763773783793803813823833843853863873883893903913923933943953963973983994004014024034044054064074084094104114124134144154164174184194204214224234244254264274284294304314324334344354364374384394404414424434444454464474484494504514524534544554564574584594604614624634644654664674684694704714724734744754764774784794804814824834844854864874884894904914924934944954964974984995005015025035045055065075085095105115125135145155165175185195205215225235245255265275285295305315325335345355365375385395405415425435445455465475485495505515525535545555565575585595605615625635645655665675685695705715725735745755765775785795805815825835845855865875885895905915925935945955965975985996006016026036046056066076086096106116126136146156166176186196206216226236246256266276286296306316326336346356366376386396406416426436446456466476486496506516526536546556566576586596606616626636646656666676686696706716726736746756766776786796806816826836846856866876886896906916926936946956966976986997007017027037047057067077087097107117127137147157167177187197207217227237247257267277287297307317327337347357367377387397407417427437447457467477487497507517527537547557567577587597607617627637647657667677687697707717727737747757767777787797807817827837847857867877887897907917927937947957967977987998008018028038048058068078088098108118128138148158168178188198208218228238248258268278288298308318328338348358368378388398408418428438448458468478488498508518528538548558568578588598608618628638648658668678688698708718728738748758768778788798808818828838848858868878888898908918928938948958968978988999009019029039049059069079089099109119129139149159169179189199209219229239249259269279289299309319329339349359369379389399409419429439449459469479489499509519529539549559569579589599609619629639649659669679689699709719729739749759769779789799809819829839849859869879889899909919929939949959969979989991000100110021003100410051006100710081009101010111012101310141015101610171018101910201021102210231024102510261027102810291030103110321033103410351036103710381039104010411042104310441045104610471048104910501051105210531054105510561057105810591060106110621063106410651066106710681069107010711072107310741075107610771078107910801081108210831084108510861087108810891090109110921093109410951096109710981099110011011102110311041105110611071108110911101111111211131114111511161117111811191120112111221123112411251126112711281129113011311132113311341135113611371138113911401141114211431144114511461147114811491150115111521153115411551156115711581159116011611162116311641165116611671168116911701171117211731174117511761177117811791180118111821183118411851186118711881189119011911192119311941195119611971198119912001201120212031204120512061207120812091210121112121213121412151216121712181219122012211222122312241225122612271228122912301231123212331234123512361237123812391240124112421243124412451246124712481249125012511252125312541255125612571258125912601261126212631264126512661267126812691270127112721273127412751276127712781279128012811282128312841285128612871288128912901291129212931294129512961297129812991300130113021303130413051306130713081309131013111312131313141315131613171318131913201321132213231324132513261327132813291330133113321333133413351336133713381339134013411342134313441345134613471348134913501351135213531354135513561357135813591360136113621363136413651366136713681369137013711372137313741375137613771378137913801381138213831384138513861387138813891390139113921393139413951396139713981399140014011402140314041405140614071408140914101411141214131414141514161417141814191420142114221423142414251426142714281429143014311432143314341435143614371438143914401441144214431444144514461447144814491450145114521453145414551456145714581459146014611462146314641465146614671468146914701471147214731474147514761477147814791480148114821483148414851486148714881489149014911492149314941495149614971498149915001501150215031504150515061507150815091510151115121513151415151516151715181519152015211522152315241525152615271528152915301531153215331534153515361537153815391540154115421543154415451546154715481549155015511552155315541555155615571558155915601561156215631564156515661567156815691570157115721573157415751576157715781579158015811582158315841585158615871588158915901591
  1. // SPDX-License-Identifier: GPL-2.0
  2. /**
  3. * udc.c - Core UDC Framework
  4. *
  5. * Copyright (C) 2010 Texas Instruments
  6. * Author: Felipe Balbi <balbi@ti.com>
  7. */
  8. #include <linux/kernel.h>
  9. #include <linux/module.h>
  10. #include <linux/device.h>
  11. #include <linux/list.h>
  12. #include <linux/err.h>
  13. #include <linux/dma-mapping.h>
  14. #include <linux/sched/task_stack.h>
  15. #include <linux/workqueue.h>
  16. #include <linux/usb/ch9.h>
  17. #include <linux/usb/gadget.h>
  18. #include <linux/usb.h>
  19. #include "trace.h"
  20. /**
  21. * struct usb_udc - describes one usb device controller
  22. * @driver - the gadget driver pointer. For use by the class code
  23. * @dev - the child device to the actual controller
  24. * @gadget - the gadget. For use by the class code
  25. * @list - for use by the udc class driver
  26. * @vbus - for udcs who care about vbus status, this value is real vbus status;
  27. * for udcs who do not care about vbus status, this value is always true
  28. *
  29. * This represents the internal data structure which is used by the UDC-class
  30. * to hold information about udc driver and gadget together.
  31. */
  32. struct usb_udc {
  33. struct usb_gadget_driver *driver;
  34. struct usb_gadget *gadget;
  35. struct device dev;
  36. struct list_head list;
  37. bool vbus;
  38. };
  39. static struct class *udc_class;
  40. static LIST_HEAD(udc_list);
  41. static LIST_HEAD(gadget_driver_pending_list);
  42. static DEFINE_MUTEX(udc_lock);
  43. static int udc_bind_to_driver(struct usb_udc *udc,
  44. struct usb_gadget_driver *driver);
  45. /* ------------------------------------------------------------------------- */
  46. /**
  47. * usb_ep_set_maxpacket_limit - set maximum packet size limit for endpoint
  48. * @ep:the endpoint being configured
  49. * @maxpacket_limit:value of maximum packet size limit
  50. *
  51. * This function should be used only in UDC drivers to initialize endpoint
  52. * (usually in probe function).
  53. */
  54. void usb_ep_set_maxpacket_limit(struct usb_ep *ep,
  55. unsigned maxpacket_limit)
  56. {
  57. ep->maxpacket_limit = maxpacket_limit;
  58. ep->maxpacket = maxpacket_limit;
  59. trace_usb_ep_set_maxpacket_limit(ep, 0);
  60. }
  61. EXPORT_SYMBOL_GPL(usb_ep_set_maxpacket_limit);
  62. /**
  63. * usb_ep_enable - configure endpoint, making it usable
  64. * @ep:the endpoint being configured. may not be the endpoint named "ep0".
  65. * drivers discover endpoints through the ep_list of a usb_gadget.
  66. *
  67. * When configurations are set, or when interface settings change, the driver
  68. * will enable or disable the relevant endpoints. while it is enabled, an
  69. * endpoint may be used for i/o until the driver receives a disconnect() from
  70. * the host or until the endpoint is disabled.
  71. *
  72. * the ep0 implementation (which calls this routine) must ensure that the
  73. * hardware capabilities of each endpoint match the descriptor provided
  74. * for it. for example, an endpoint named "ep2in-bulk" would be usable
  75. * for interrupt transfers as well as bulk, but it likely couldn't be used
  76. * for iso transfers or for endpoint 14. some endpoints are fully
  77. * configurable, with more generic names like "ep-a". (remember that for
  78. * USB, "in" means "towards the USB master".)
  79. *
  80. * returns zero, or a negative error code.
  81. */
  82. int usb_ep_enable(struct usb_ep *ep)
  83. {
  84. int ret = 0;
  85. if (ep->enabled)
  86. goto out;
  87. ret = ep->ops->enable(ep, ep->desc);
  88. if (ret)
  89. goto out;
  90. ep->enabled = true;
  91. out:
  92. trace_usb_ep_enable(ep, ret);
  93. return ret;
  94. }
  95. EXPORT_SYMBOL_GPL(usb_ep_enable);
  96. /**
  97. * usb_ep_disable - endpoint is no longer usable
  98. * @ep:the endpoint being unconfigured. may not be the endpoint named "ep0".
  99. *
  100. * no other task may be using this endpoint when this is called.
  101. * any pending and uncompleted requests will complete with status
  102. * indicating disconnect (-ESHUTDOWN) before this call returns.
  103. * gadget drivers must call usb_ep_enable() again before queueing
  104. * requests to the endpoint.
  105. *
  106. * returns zero, or a negative error code.
  107. */
  108. int usb_ep_disable(struct usb_ep *ep)
  109. {
  110. int ret = 0;
  111. if (!ep->enabled)
  112. goto out;
  113. ret = ep->ops->disable(ep);
  114. if (ret)
  115. goto out;
  116. ep->enabled = false;
  117. out:
  118. trace_usb_ep_disable(ep, ret);
  119. return ret;
  120. }
  121. EXPORT_SYMBOL_GPL(usb_ep_disable);
  122. /**
  123. * usb_ep_alloc_request - allocate a request object to use with this endpoint
  124. * @ep:the endpoint to be used with with the request
  125. * @gfp_flags:GFP_* flags to use
  126. *
  127. * Request objects must be allocated with this call, since they normally
  128. * need controller-specific setup and may even need endpoint-specific
  129. * resources such as allocation of DMA descriptors.
  130. * Requests may be submitted with usb_ep_queue(), and receive a single
  131. * completion callback. Free requests with usb_ep_free_request(), when
  132. * they are no longer needed.
  133. *
  134. * Returns the request, or null if one could not be allocated.
  135. */
  136. struct usb_request *usb_ep_alloc_request(struct usb_ep *ep,
  137. gfp_t gfp_flags)
  138. {
  139. struct usb_request *req = NULL;
  140. req = ep->ops->alloc_request(ep, gfp_flags);
  141. trace_usb_ep_alloc_request(ep, req, req ? 0 : -ENOMEM);
  142. return req;
  143. }
  144. EXPORT_SYMBOL_GPL(usb_ep_alloc_request);
  145. /**
  146. * usb_ep_free_request - frees a request object
  147. * @ep:the endpoint associated with the request
  148. * @req:the request being freed
  149. *
  150. * Reverses the effect of usb_ep_alloc_request().
  151. * Caller guarantees the request is not queued, and that it will
  152. * no longer be requeued (or otherwise used).
  153. */
  154. void usb_ep_free_request(struct usb_ep *ep,
  155. struct usb_request *req)
  156. {
  157. trace_usb_ep_free_request(ep, req, 0);
  158. ep->ops->free_request(ep, req);
  159. }
  160. EXPORT_SYMBOL_GPL(usb_ep_free_request);
  161. /**
  162. * usb_ep_queue - queues (submits) an I/O request to an endpoint.
  163. * @ep:the endpoint associated with the request
  164. * @req:the request being submitted
  165. * @gfp_flags: GFP_* flags to use in case the lower level driver couldn't
  166. * pre-allocate all necessary memory with the request.
  167. *
  168. * This tells the device controller to perform the specified request through
  169. * that endpoint (reading or writing a buffer). When the request completes,
  170. * including being canceled by usb_ep_dequeue(), the request's completion
  171. * routine is called to return the request to the driver. Any endpoint
  172. * (except control endpoints like ep0) may have more than one transfer
  173. * request queued; they complete in FIFO order. Once a gadget driver
  174. * submits a request, that request may not be examined or modified until it
  175. * is given back to that driver through the completion callback.
  176. *
  177. * Each request is turned into one or more packets. The controller driver
  178. * never merges adjacent requests into the same packet. OUT transfers
  179. * will sometimes use data that's already buffered in the hardware.
  180. * Drivers can rely on the fact that the first byte of the request's buffer
  181. * always corresponds to the first byte of some USB packet, for both
  182. * IN and OUT transfers.
  183. *
  184. * Bulk endpoints can queue any amount of data; the transfer is packetized
  185. * automatically. The last packet will be short if the request doesn't fill it
  186. * out completely. Zero length packets (ZLPs) should be avoided in portable
  187. * protocols since not all usb hardware can successfully handle zero length
  188. * packets. (ZLPs may be explicitly written, and may be implicitly written if
  189. * the request 'zero' flag is set.) Bulk endpoints may also be used
  190. * for interrupt transfers; but the reverse is not true, and some endpoints
  191. * won't support every interrupt transfer. (Such as 768 byte packets.)
  192. *
  193. * Interrupt-only endpoints are less functional than bulk endpoints, for
  194. * example by not supporting queueing or not handling buffers that are
  195. * larger than the endpoint's maxpacket size. They may also treat data
  196. * toggle differently.
  197. *
  198. * Control endpoints ... after getting a setup() callback, the driver queues
  199. * one response (even if it would be zero length). That enables the
  200. * status ack, after transferring data as specified in the response. Setup
  201. * functions may return negative error codes to generate protocol stalls.
  202. * (Note that some USB device controllers disallow protocol stall responses
  203. * in some cases.) When control responses are deferred (the response is
  204. * written after the setup callback returns), then usb_ep_set_halt() may be
  205. * used on ep0 to trigger protocol stalls. Depending on the controller,
  206. * it may not be possible to trigger a status-stage protocol stall when the
  207. * data stage is over, that is, from within the response's completion
  208. * routine.
  209. *
  210. * For periodic endpoints, like interrupt or isochronous ones, the usb host
  211. * arranges to poll once per interval, and the gadget driver usually will
  212. * have queued some data to transfer at that time.
  213. *
  214. * Note that @req's ->complete() callback must never be called from
  215. * within usb_ep_queue() as that can create deadlock situations.
  216. *
  217. * Returns zero, or a negative error code. Endpoints that are not enabled
  218. * report errors; errors will also be
  219. * reported when the usb peripheral is disconnected.
  220. *
  221. * If and only if @req is successfully queued (the return value is zero),
  222. * @req->complete() will be called exactly once, when the Gadget core and
  223. * UDC are finished with the request. When the completion function is called,
  224. * control of the request is returned to the device driver which submitted it.
  225. * The completion handler may then immediately free or reuse @req.
  226. */
  227. int usb_ep_queue(struct usb_ep *ep,
  228. struct usb_request *req, gfp_t gfp_flags)
  229. {
  230. int ret = 0;
  231. if (WARN_ON_ONCE(!ep->enabled && ep->address)) {
  232. ret = -ESHUTDOWN;
  233. goto out;
  234. }
  235. ret = ep->ops->queue(ep, req, gfp_flags);
  236. out:
  237. trace_usb_ep_queue(ep, req, ret);
  238. return ret;
  239. }
  240. EXPORT_SYMBOL_GPL(usb_ep_queue);
  241. /**
  242. * usb_ep_dequeue - dequeues (cancels, unlinks) an I/O request from an endpoint
  243. * @ep:the endpoint associated with the request
  244. * @req:the request being canceled
  245. *
  246. * If the request is still active on the endpoint, it is dequeued and its
  247. * completion routine is called (with status -ECONNRESET); else a negative
  248. * error code is returned. This is guaranteed to happen before the call to
  249. * usb_ep_dequeue() returns.
  250. *
  251. * Note that some hardware can't clear out write fifos (to unlink the request
  252. * at the head of the queue) except as part of disconnecting from usb. Such
  253. * restrictions prevent drivers from supporting configuration changes,
  254. * even to configuration zero (a "chapter 9" requirement).
  255. */
  256. int usb_ep_dequeue(struct usb_ep *ep, struct usb_request *req)
  257. {
  258. int ret;
  259. ret = ep->ops->dequeue(ep, req);
  260. trace_usb_ep_dequeue(ep, req, ret);
  261. return ret;
  262. }
  263. EXPORT_SYMBOL_GPL(usb_ep_dequeue);
  264. /**
  265. * usb_ep_set_halt - sets the endpoint halt feature.
  266. * @ep: the non-isochronous endpoint being stalled
  267. *
  268. * Use this to stall an endpoint, perhaps as an error report.
  269. * Except for control endpoints,
  270. * the endpoint stays halted (will not stream any data) until the host
  271. * clears this feature; drivers may need to empty the endpoint's request
  272. * queue first, to make sure no inappropriate transfers happen.
  273. *
  274. * Note that while an endpoint CLEAR_FEATURE will be invisible to the
  275. * gadget driver, a SET_INTERFACE will not be. To reset endpoints for the
  276. * current altsetting, see usb_ep_clear_halt(). When switching altsettings,
  277. * it's simplest to use usb_ep_enable() or usb_ep_disable() for the endpoints.
  278. *
  279. * Returns zero, or a negative error code. On success, this call sets
  280. * underlying hardware state that blocks data transfers.
  281. * Attempts to halt IN endpoints will fail (returning -EAGAIN) if any
  282. * transfer requests are still queued, or if the controller hardware
  283. * (usually a FIFO) still holds bytes that the host hasn't collected.
  284. */
  285. int usb_ep_set_halt(struct usb_ep *ep)
  286. {
  287. int ret;
  288. ret = ep->ops->set_halt(ep, 1);
  289. trace_usb_ep_set_halt(ep, ret);
  290. return ret;
  291. }
  292. EXPORT_SYMBOL_GPL(usb_ep_set_halt);
  293. /**
  294. * usb_ep_clear_halt - clears endpoint halt, and resets toggle
  295. * @ep:the bulk or interrupt endpoint being reset
  296. *
  297. * Use this when responding to the standard usb "set interface" request,
  298. * for endpoints that aren't reconfigured, after clearing any other state
  299. * in the endpoint's i/o queue.
  300. *
  301. * Returns zero, or a negative error code. On success, this call clears
  302. * the underlying hardware state reflecting endpoint halt and data toggle.
  303. * Note that some hardware can't support this request (like pxa2xx_udc),
  304. * and accordingly can't correctly implement interface altsettings.
  305. */
  306. int usb_ep_clear_halt(struct usb_ep *ep)
  307. {
  308. int ret;
  309. ret = ep->ops->set_halt(ep, 0);
  310. trace_usb_ep_clear_halt(ep, ret);
  311. return ret;
  312. }
  313. EXPORT_SYMBOL_GPL(usb_ep_clear_halt);
  314. /**
  315. * usb_ep_set_wedge - sets the halt feature and ignores clear requests
  316. * @ep: the endpoint being wedged
  317. *
  318. * Use this to stall an endpoint and ignore CLEAR_FEATURE(HALT_ENDPOINT)
  319. * requests. If the gadget driver clears the halt status, it will
  320. * automatically unwedge the endpoint.
  321. *
  322. * Returns zero on success, else negative errno.
  323. */
  324. int usb_ep_set_wedge(struct usb_ep *ep)
  325. {
  326. int ret;
  327. if (ep->ops->set_wedge)
  328. ret = ep->ops->set_wedge(ep);
  329. else
  330. ret = ep->ops->set_halt(ep, 1);
  331. trace_usb_ep_set_wedge(ep, ret);
  332. return ret;
  333. }
  334. EXPORT_SYMBOL_GPL(usb_ep_set_wedge);
  335. /**
  336. * usb_ep_fifo_status - returns number of bytes in fifo, or error
  337. * @ep: the endpoint whose fifo status is being checked.
  338. *
  339. * FIFO endpoints may have "unclaimed data" in them in certain cases,
  340. * such as after aborted transfers. Hosts may not have collected all
  341. * the IN data written by the gadget driver (and reported by a request
  342. * completion). The gadget driver may not have collected all the data
  343. * written OUT to it by the host. Drivers that need precise handling for
  344. * fault reporting or recovery may need to use this call.
  345. *
  346. * This returns the number of such bytes in the fifo, or a negative
  347. * errno if the endpoint doesn't use a FIFO or doesn't support such
  348. * precise handling.
  349. */
  350. int usb_ep_fifo_status(struct usb_ep *ep)
  351. {
  352. int ret;
  353. if (ep->ops->fifo_status)
  354. ret = ep->ops->fifo_status(ep);
  355. else
  356. ret = -EOPNOTSUPP;
  357. trace_usb_ep_fifo_status(ep, ret);
  358. return ret;
  359. }
  360. EXPORT_SYMBOL_GPL(usb_ep_fifo_status);
  361. /**
  362. * usb_ep_fifo_flush - flushes contents of a fifo
  363. * @ep: the endpoint whose fifo is being flushed.
  364. *
  365. * This call may be used to flush the "unclaimed data" that may exist in
  366. * an endpoint fifo after abnormal transaction terminations. The call
  367. * must never be used except when endpoint is not being used for any
  368. * protocol translation.
  369. */
  370. void usb_ep_fifo_flush(struct usb_ep *ep)
  371. {
  372. if (ep->ops->fifo_flush)
  373. ep->ops->fifo_flush(ep);
  374. trace_usb_ep_fifo_flush(ep, 0);
  375. }
  376. EXPORT_SYMBOL_GPL(usb_ep_fifo_flush);
  377. /* ------------------------------------------------------------------------- */
  378. /**
  379. * usb_gadget_frame_number - returns the current frame number
  380. * @gadget: controller that reports the frame number
  381. *
  382. * Returns the usb frame number, normally eleven bits from a SOF packet,
  383. * or negative errno if this device doesn't support this capability.
  384. */
  385. int usb_gadget_frame_number(struct usb_gadget *gadget)
  386. {
  387. int ret;
  388. ret = gadget->ops->get_frame(gadget);
  389. trace_usb_gadget_frame_number(gadget, ret);
  390. return ret;
  391. }
  392. EXPORT_SYMBOL_GPL(usb_gadget_frame_number);
  393. /**
  394. * usb_gadget_wakeup - tries to wake up the host connected to this gadget
  395. * @gadget: controller used to wake up the host
  396. *
  397. * Returns zero on success, else negative error code if the hardware
  398. * doesn't support such attempts, or its support has not been enabled
  399. * by the usb host. Drivers must return device descriptors that report
  400. * their ability to support this, or hosts won't enable it.
  401. *
  402. * This may also try to use SRP to wake the host and start enumeration,
  403. * even if OTG isn't otherwise in use. OTG devices may also start
  404. * remote wakeup even when hosts don't explicitly enable it.
  405. */
  406. int usb_gadget_wakeup(struct usb_gadget *gadget)
  407. {
  408. int ret = 0;
  409. if (!gadget->ops->wakeup) {
  410. ret = -EOPNOTSUPP;
  411. goto out;
  412. }
  413. ret = gadget->ops->wakeup(gadget);
  414. out:
  415. trace_usb_gadget_wakeup(gadget, ret);
  416. return ret;
  417. }
  418. EXPORT_SYMBOL_GPL(usb_gadget_wakeup);
  419. /**
  420. * usb_gadget_set_selfpowered - sets the device selfpowered feature.
  421. * @gadget:the device being declared as self-powered
  422. *
  423. * this affects the device status reported by the hardware driver
  424. * to reflect that it now has a local power supply.
  425. *
  426. * returns zero on success, else negative errno.
  427. */
  428. int usb_gadget_set_selfpowered(struct usb_gadget *gadget)
  429. {
  430. int ret = 0;
  431. if (!gadget->ops->set_selfpowered) {
  432. ret = -EOPNOTSUPP;
  433. goto out;
  434. }
  435. ret = gadget->ops->set_selfpowered(gadget, 1);
  436. out:
  437. trace_usb_gadget_set_selfpowered(gadget, ret);
  438. return ret;
  439. }
  440. EXPORT_SYMBOL_GPL(usb_gadget_set_selfpowered);
  441. /**
  442. * usb_gadget_clear_selfpowered - clear the device selfpowered feature.
  443. * @gadget:the device being declared as bus-powered
  444. *
  445. * this affects the device status reported by the hardware driver.
  446. * some hardware may not support bus-powered operation, in which
  447. * case this feature's value can never change.
  448. *
  449. * returns zero on success, else negative errno.
  450. */
  451. int usb_gadget_clear_selfpowered(struct usb_gadget *gadget)
  452. {
  453. int ret = 0;
  454. if (!gadget->ops->set_selfpowered) {
  455. ret = -EOPNOTSUPP;
  456. goto out;
  457. }
  458. ret = gadget->ops->set_selfpowered(gadget, 0);
  459. out:
  460. trace_usb_gadget_clear_selfpowered(gadget, ret);
  461. return ret;
  462. }
  463. EXPORT_SYMBOL_GPL(usb_gadget_clear_selfpowered);
  464. /**
  465. * usb_gadget_vbus_connect - Notify controller that VBUS is powered
  466. * @gadget:The device which now has VBUS power.
  467. * Context: can sleep
  468. *
  469. * This call is used by a driver for an external transceiver (or GPIO)
  470. * that detects a VBUS power session starting. Common responses include
  471. * resuming the controller, activating the D+ (or D-) pullup to let the
  472. * host detect that a USB device is attached, and starting to draw power
  473. * (8mA or possibly more, especially after SET_CONFIGURATION).
  474. *
  475. * Returns zero on success, else negative errno.
  476. */
  477. int usb_gadget_vbus_connect(struct usb_gadget *gadget)
  478. {
  479. int ret = 0;
  480. if (!gadget->ops->vbus_session) {
  481. ret = -EOPNOTSUPP;
  482. goto out;
  483. }
  484. ret = gadget->ops->vbus_session(gadget, 1);
  485. out:
  486. trace_usb_gadget_vbus_connect(gadget, ret);
  487. return ret;
  488. }
  489. EXPORT_SYMBOL_GPL(usb_gadget_vbus_connect);
  490. /**
  491. * usb_gadget_vbus_draw - constrain controller's VBUS power usage
  492. * @gadget:The device whose VBUS usage is being described
  493. * @mA:How much current to draw, in milliAmperes. This should be twice
  494. * the value listed in the configuration descriptor bMaxPower field.
  495. *
  496. * This call is used by gadget drivers during SET_CONFIGURATION calls,
  497. * reporting how much power the device may consume. For example, this
  498. * could affect how quickly batteries are recharged.
  499. *
  500. * Returns zero on success, else negative errno.
  501. */
  502. int usb_gadget_vbus_draw(struct usb_gadget *gadget, unsigned mA)
  503. {
  504. int ret = 0;
  505. if (!gadget->ops->vbus_draw) {
  506. ret = -EOPNOTSUPP;
  507. goto out;
  508. }
  509. ret = gadget->ops->vbus_draw(gadget, mA);
  510. if (!ret)
  511. gadget->mA = mA;
  512. out:
  513. trace_usb_gadget_vbus_draw(gadget, ret);
  514. return ret;
  515. }
  516. EXPORT_SYMBOL_GPL(usb_gadget_vbus_draw);
  517. /**
  518. * usb_gadget_vbus_disconnect - notify controller about VBUS session end
  519. * @gadget:the device whose VBUS supply is being described
  520. * Context: can sleep
  521. *
  522. * This call is used by a driver for an external transceiver (or GPIO)
  523. * that detects a VBUS power session ending. Common responses include
  524. * reversing everything done in usb_gadget_vbus_connect().
  525. *
  526. * Returns zero on success, else negative errno.
  527. */
  528. int usb_gadget_vbus_disconnect(struct usb_gadget *gadget)
  529. {
  530. int ret = 0;
  531. if (!gadget->ops->vbus_session) {
  532. ret = -EOPNOTSUPP;
  533. goto out;
  534. }
  535. ret = gadget->ops->vbus_session(gadget, 0);
  536. out:
  537. trace_usb_gadget_vbus_disconnect(gadget, ret);
  538. return ret;
  539. }
  540. EXPORT_SYMBOL_GPL(usb_gadget_vbus_disconnect);
  541. /**
  542. * usb_gadget_connect - software-controlled connect to USB host
  543. * @gadget:the peripheral being connected
  544. *
  545. * Enables the D+ (or potentially D-) pullup. The host will start
  546. * enumerating this gadget when the pullup is active and a VBUS session
  547. * is active (the link is powered). This pullup is always enabled unless
  548. * usb_gadget_disconnect() has been used to disable it.
  549. *
  550. * Returns zero on success, else negative errno.
  551. */
  552. int usb_gadget_connect(struct usb_gadget *gadget)
  553. {
  554. int ret = 0;
  555. if (!gadget->ops->pullup) {
  556. ret = -EOPNOTSUPP;
  557. goto out;
  558. }
  559. if (gadget->deactivated) {
  560. /*
  561. * If gadget is deactivated we only save new state.
  562. * Gadget will be connected automatically after activation.
  563. */
  564. gadget->connected = true;
  565. goto out;
  566. }
  567. ret = gadget->ops->pullup(gadget, 1);
  568. if (!ret)
  569. gadget->connected = 1;
  570. out:
  571. trace_usb_gadget_connect(gadget, ret);
  572. return ret;
  573. }
  574. EXPORT_SYMBOL_GPL(usb_gadget_connect);
  575. /**
  576. * usb_gadget_disconnect - software-controlled disconnect from USB host
  577. * @gadget:the peripheral being disconnected
  578. *
  579. * Disables the D+ (or potentially D-) pullup, which the host may see
  580. * as a disconnect (when a VBUS session is active). Not all systems
  581. * support software pullup controls.
  582. *
  583. * Returns zero on success, else negative errno.
  584. */
  585. int usb_gadget_disconnect(struct usb_gadget *gadget)
  586. {
  587. int ret = 0;
  588. if (!gadget->ops->pullup) {
  589. ret = -EOPNOTSUPP;
  590. goto out;
  591. }
  592. if (gadget->deactivated) {
  593. /*
  594. * If gadget is deactivated we only save new state.
  595. * Gadget will stay disconnected after activation.
  596. */
  597. gadget->connected = false;
  598. goto out;
  599. }
  600. ret = gadget->ops->pullup(gadget, 0);
  601. if (!ret)
  602. gadget->connected = 0;
  603. out:
  604. trace_usb_gadget_disconnect(gadget, ret);
  605. return ret;
  606. }
  607. EXPORT_SYMBOL_GPL(usb_gadget_disconnect);
  608. /**
  609. * usb_gadget_deactivate - deactivate function which is not ready to work
  610. * @gadget: the peripheral being deactivated
  611. *
  612. * This routine may be used during the gadget driver bind() call to prevent
  613. * the peripheral from ever being visible to the USB host, unless later
  614. * usb_gadget_activate() is called. For example, user mode components may
  615. * need to be activated before the system can talk to hosts.
  616. *
  617. * Returns zero on success, else negative errno.
  618. */
  619. int usb_gadget_deactivate(struct usb_gadget *gadget)
  620. {
  621. int ret = 0;
  622. if (gadget->deactivated)
  623. goto out;
  624. if (gadget->connected) {
  625. ret = usb_gadget_disconnect(gadget);
  626. if (ret)
  627. goto out;
  628. /*
  629. * If gadget was being connected before deactivation, we want
  630. * to reconnect it in usb_gadget_activate().
  631. */
  632. gadget->connected = true;
  633. }
  634. gadget->deactivated = true;
  635. out:
  636. trace_usb_gadget_deactivate(gadget, ret);
  637. return ret;
  638. }
  639. EXPORT_SYMBOL_GPL(usb_gadget_deactivate);
  640. /**
  641. * usb_gadget_activate - activate function which is not ready to work
  642. * @gadget: the peripheral being activated
  643. *
  644. * This routine activates gadget which was previously deactivated with
  645. * usb_gadget_deactivate() call. It calls usb_gadget_connect() if needed.
  646. *
  647. * Returns zero on success, else negative errno.
  648. */
  649. int usb_gadget_activate(struct usb_gadget *gadget)
  650. {
  651. int ret = 0;
  652. if (!gadget->deactivated)
  653. goto out;
  654. gadget->deactivated = false;
  655. /*
  656. * If gadget has been connected before deactivation, or became connected
  657. * while it was being deactivated, we call usb_gadget_connect().
  658. */
  659. if (gadget->connected)
  660. ret = usb_gadget_connect(gadget);
  661. out:
  662. trace_usb_gadget_activate(gadget, ret);
  663. return ret;
  664. }
  665. EXPORT_SYMBOL_GPL(usb_gadget_activate);
  666. /* ------------------------------------------------------------------------- */
  667. #ifdef CONFIG_HAS_DMA
  668. int usb_gadget_map_request_by_dev(struct device *dev,
  669. struct usb_request *req, int is_in)
  670. {
  671. if (req->length == 0)
  672. return 0;
  673. if (req->num_sgs) {
  674. int mapped;
  675. mapped = dma_map_sg(dev, req->sg, req->num_sgs,
  676. is_in ? DMA_TO_DEVICE : DMA_FROM_DEVICE);
  677. if (mapped == 0) {
  678. dev_err(dev, "failed to map SGs\n");
  679. return -EFAULT;
  680. }
  681. req->num_mapped_sgs = mapped;
  682. } else {
  683. if (is_vmalloc_addr(req->buf)) {
  684. dev_err(dev, "buffer is not dma capable\n");
  685. return -EFAULT;
  686. } else if (object_is_on_stack(req->buf)) {
  687. dev_err(dev, "buffer is on stack\n");
  688. return -EFAULT;
  689. }
  690. req->dma = dma_map_single(dev, req->buf, req->length,
  691. is_in ? DMA_TO_DEVICE : DMA_FROM_DEVICE);
  692. if (dma_mapping_error(dev, req->dma)) {
  693. dev_err(dev, "failed to map buffer\n");
  694. return -EFAULT;
  695. }
  696. req->dma_mapped = 1;
  697. }
  698. return 0;
  699. }
  700. EXPORT_SYMBOL_GPL(usb_gadget_map_request_by_dev);
  701. int usb_gadget_map_request(struct usb_gadget *gadget,
  702. struct usb_request *req, int is_in)
  703. {
  704. return usb_gadget_map_request_by_dev(gadget->dev.parent, req, is_in);
  705. }
  706. EXPORT_SYMBOL_GPL(usb_gadget_map_request);
  707. void usb_gadget_unmap_request_by_dev(struct device *dev,
  708. struct usb_request *req, int is_in)
  709. {
  710. if (req->length == 0)
  711. return;
  712. if (req->num_mapped_sgs) {
  713. dma_unmap_sg(dev, req->sg, req->num_sgs,
  714. is_in ? DMA_TO_DEVICE : DMA_FROM_DEVICE);
  715. req->num_mapped_sgs = 0;
  716. } else if (req->dma_mapped) {
  717. dma_unmap_single(dev, req->dma, req->length,
  718. is_in ? DMA_TO_DEVICE : DMA_FROM_DEVICE);
  719. req->dma_mapped = 0;
  720. }
  721. }
  722. EXPORT_SYMBOL_GPL(usb_gadget_unmap_request_by_dev);
  723. void usb_gadget_unmap_request(struct usb_gadget *gadget,
  724. struct usb_request *req, int is_in)
  725. {
  726. usb_gadget_unmap_request_by_dev(gadget->dev.parent, req, is_in);
  727. }
  728. EXPORT_SYMBOL_GPL(usb_gadget_unmap_request);
  729. #endif /* CONFIG_HAS_DMA */
  730. /* ------------------------------------------------------------------------- */
  731. /**
  732. * usb_gadget_giveback_request - give the request back to the gadget layer
  733. * Context: in_interrupt()
  734. *
  735. * This is called by device controller drivers in order to return the
  736. * completed request back to the gadget layer.
  737. */
  738. void usb_gadget_giveback_request(struct usb_ep *ep,
  739. struct usb_request *req)
  740. {
  741. if (likely(req->status == 0))
  742. usb_led_activity(USB_LED_EVENT_GADGET);
  743. trace_usb_gadget_giveback_request(ep, req, 0);
  744. req->complete(ep, req);
  745. }
  746. EXPORT_SYMBOL_GPL(usb_gadget_giveback_request);
  747. /* ------------------------------------------------------------------------- */
  748. /**
  749. * gadget_find_ep_by_name - returns ep whose name is the same as sting passed
  750. * in second parameter or NULL if searched endpoint not found
  751. * @g: controller to check for quirk
  752. * @name: name of searched endpoint
  753. */
  754. struct usb_ep *gadget_find_ep_by_name(struct usb_gadget *g, const char *name)
  755. {
  756. struct usb_ep *ep;
  757. gadget_for_each_ep(ep, g) {
  758. if (!strcmp(ep->name, name))
  759. return ep;
  760. }
  761. return NULL;
  762. }
  763. EXPORT_SYMBOL_GPL(gadget_find_ep_by_name);
  764. /* ------------------------------------------------------------------------- */
  765. int usb_gadget_ep_match_desc(struct usb_gadget *gadget,
  766. struct usb_ep *ep, struct usb_endpoint_descriptor *desc,
  767. struct usb_ss_ep_comp_descriptor *ep_comp)
  768. {
  769. u8 type;
  770. u16 max;
  771. int num_req_streams = 0;
  772. /* endpoint already claimed? */
  773. if (ep->claimed)
  774. return 0;
  775. type = usb_endpoint_type(desc);
  776. max = usb_endpoint_maxp(desc);
  777. if (usb_endpoint_dir_in(desc) && !ep->caps.dir_in)
  778. return 0;
  779. if (usb_endpoint_dir_out(desc) && !ep->caps.dir_out)
  780. return 0;
  781. if (max > ep->maxpacket_limit)
  782. return 0;
  783. /* "high bandwidth" works only at high speed */
  784. if (!gadget_is_dualspeed(gadget) && usb_endpoint_maxp_mult(desc) > 1)
  785. return 0;
  786. switch (type) {
  787. case USB_ENDPOINT_XFER_CONTROL:
  788. /* only support ep0 for portable CONTROL traffic */
  789. return 0;
  790. case USB_ENDPOINT_XFER_ISOC:
  791. if (!ep->caps.type_iso)
  792. return 0;
  793. /* ISO: limit 1023 bytes full speed, 1024 high/super speed */
  794. if (!gadget_is_dualspeed(gadget) && max > 1023)
  795. return 0;
  796. break;
  797. case USB_ENDPOINT_XFER_BULK:
  798. if (!ep->caps.type_bulk)
  799. return 0;
  800. if (ep_comp && gadget_is_superspeed(gadget)) {
  801. /* Get the number of required streams from the
  802. * EP companion descriptor and see if the EP
  803. * matches it
  804. */
  805. num_req_streams = ep_comp->bmAttributes & 0x1f;
  806. if (num_req_streams > ep->max_streams)
  807. return 0;
  808. }
  809. break;
  810. case USB_ENDPOINT_XFER_INT:
  811. /* Bulk endpoints handle interrupt transfers,
  812. * except the toggle-quirky iso-synch kind
  813. */
  814. if (!ep->caps.type_int && !ep->caps.type_bulk)
  815. return 0;
  816. /* INT: limit 64 bytes full speed, 1024 high/super speed */
  817. if (!gadget_is_dualspeed(gadget) && max > 64)
  818. return 0;
  819. break;
  820. }
  821. return 1;
  822. }
  823. EXPORT_SYMBOL_GPL(usb_gadget_ep_match_desc);
  824. /* ------------------------------------------------------------------------- */
  825. static void usb_gadget_state_work(struct work_struct *work)
  826. {
  827. struct usb_gadget *gadget = work_to_gadget(work);
  828. struct usb_udc *udc = gadget->udc;
  829. if (udc)
  830. sysfs_notify(&udc->dev.kobj, NULL, "state");
  831. }
  832. void usb_gadget_set_state(struct usb_gadget *gadget,
  833. enum usb_device_state state)
  834. {
  835. gadget->state = state;
  836. schedule_work(&gadget->work);
  837. }
  838. EXPORT_SYMBOL_GPL(usb_gadget_set_state);
  839. /* ------------------------------------------------------------------------- */
  840. static void usb_udc_connect_control(struct usb_udc *udc)
  841. {
  842. if (udc->vbus)
  843. usb_gadget_connect(udc->gadget);
  844. else
  845. usb_gadget_disconnect(udc->gadget);
  846. }
  847. /**
  848. * usb_udc_vbus_handler - updates the udc core vbus status, and try to
  849. * connect or disconnect gadget
  850. * @gadget: The gadget which vbus change occurs
  851. * @status: The vbus status
  852. *
  853. * The udc driver calls it when it wants to connect or disconnect gadget
  854. * according to vbus status.
  855. */
  856. void usb_udc_vbus_handler(struct usb_gadget *gadget, bool status)
  857. {
  858. struct usb_udc *udc = gadget->udc;
  859. if (udc) {
  860. udc->vbus = status;
  861. usb_udc_connect_control(udc);
  862. }
  863. }
  864. EXPORT_SYMBOL_GPL(usb_udc_vbus_handler);
  865. /**
  866. * usb_gadget_udc_reset - notifies the udc core that bus reset occurs
  867. * @gadget: The gadget which bus reset occurs
  868. * @driver: The gadget driver we want to notify
  869. *
  870. * If the udc driver has bus reset handler, it needs to call this when the bus
  871. * reset occurs, it notifies the gadget driver that the bus reset occurs as
  872. * well as updates gadget state.
  873. */
  874. void usb_gadget_udc_reset(struct usb_gadget *gadget,
  875. struct usb_gadget_driver *driver)
  876. {
  877. driver->reset(gadget);
  878. usb_gadget_set_state(gadget, USB_STATE_DEFAULT);
  879. }
  880. EXPORT_SYMBOL_GPL(usb_gadget_udc_reset);
  881. /**
  882. * usb_gadget_udc_start - tells usb device controller to start up
  883. * @udc: The UDC to be started
  884. *
  885. * This call is issued by the UDC Class driver when it's about
  886. * to register a gadget driver to the device controller, before
  887. * calling gadget driver's bind() method.
  888. *
  889. * It allows the controller to be powered off until strictly
  890. * necessary to have it powered on.
  891. *
  892. * Returns zero on success, else negative errno.
  893. */
  894. static inline int usb_gadget_udc_start(struct usb_udc *udc)
  895. {
  896. return udc->gadget->ops->udc_start(udc->gadget, udc->driver);
  897. }
  898. /**
  899. * usb_gadget_udc_stop - tells usb device controller we don't need it anymore
  900. * @gadget: The device we want to stop activity
  901. * @driver: The driver to unbind from @gadget
  902. *
  903. * This call is issued by the UDC Class driver after calling
  904. * gadget driver's unbind() method.
  905. *
  906. * The details are implementation specific, but it can go as
  907. * far as powering off UDC completely and disable its data
  908. * line pullups.
  909. */
  910. static inline void usb_gadget_udc_stop(struct usb_udc *udc)
  911. {
  912. udc->gadget->ops->udc_stop(udc->gadget);
  913. }
  914. /**
  915. * usb_gadget_udc_set_speed - tells usb device controller speed supported by
  916. * current driver
  917. * @udc: The device we want to set maximum speed
  918. * @speed: The maximum speed to allowed to run
  919. *
  920. * This call is issued by the UDC Class driver before calling
  921. * usb_gadget_udc_start() in order to make sure that we don't try to
  922. * connect on speeds the gadget driver doesn't support.
  923. */
  924. static inline void usb_gadget_udc_set_speed(struct usb_udc *udc,
  925. enum usb_device_speed speed)
  926. {
  927. if (udc->gadget->ops->udc_set_speed) {
  928. enum usb_device_speed s;
  929. s = min(speed, udc->gadget->max_speed);
  930. udc->gadget->ops->udc_set_speed(udc->gadget, s);
  931. }
  932. }
  933. /**
  934. * usb_udc_release - release the usb_udc struct
  935. * @dev: the dev member within usb_udc
  936. *
  937. * This is called by driver's core in order to free memory once the last
  938. * reference is released.
  939. */
  940. static void usb_udc_release(struct device *dev)
  941. {
  942. struct usb_udc *udc;
  943. udc = container_of(dev, struct usb_udc, dev);
  944. dev_dbg(dev, "releasing '%s'\n", dev_name(dev));
  945. kfree(udc);
  946. }
  947. static const struct attribute_group *usb_udc_attr_groups[];
  948. static void usb_udc_nop_release(struct device *dev)
  949. {
  950. dev_vdbg(dev, "%s\n", __func__);
  951. }
  952. /* should be called with udc_lock held */
  953. static int check_pending_gadget_drivers(struct usb_udc *udc)
  954. {
  955. struct usb_gadget_driver *driver;
  956. int ret = 0;
  957. list_for_each_entry(driver, &gadget_driver_pending_list, pending)
  958. if (!driver->udc_name || strcmp(driver->udc_name,
  959. dev_name(&udc->dev)) == 0) {
  960. ret = udc_bind_to_driver(udc, driver);
  961. if (ret != -EPROBE_DEFER)
  962. list_del(&driver->pending);
  963. break;
  964. }
  965. return ret;
  966. }
  967. /**
  968. * usb_add_gadget_udc_release - adds a new gadget to the udc class driver list
  969. * @parent: the parent device to this udc. Usually the controller driver's
  970. * device.
  971. * @gadget: the gadget to be added to the list.
  972. * @release: a gadget release function.
  973. *
  974. * Returns zero on success, negative errno otherwise.
  975. * Calls the gadget release function in the latter case.
  976. */
  977. int usb_add_gadget_udc_release(struct device *parent, struct usb_gadget *gadget,
  978. void (*release)(struct device *dev))
  979. {
  980. struct usb_udc *udc;
  981. int ret = -ENOMEM;
  982. dev_set_name(&gadget->dev, "gadget");
  983. INIT_WORK(&gadget->work, usb_gadget_state_work);
  984. gadget->dev.parent = parent;
  985. if (release)
  986. gadget->dev.release = release;
  987. else
  988. gadget->dev.release = usb_udc_nop_release;
  989. device_initialize(&gadget->dev);
  990. udc = kzalloc(sizeof(*udc), GFP_KERNEL);
  991. if (!udc)
  992. goto err_put_gadget;
  993. device_initialize(&udc->dev);
  994. udc->dev.release = usb_udc_release;
  995. udc->dev.class = udc_class;
  996. udc->dev.groups = usb_udc_attr_groups;
  997. udc->dev.parent = parent;
  998. ret = dev_set_name(&udc->dev, "%s", kobject_name(&parent->kobj));
  999. if (ret)
  1000. goto err_put_udc;
  1001. ret = device_add(&gadget->dev);
  1002. if (ret)
  1003. goto err_put_udc;
  1004. udc->gadget = gadget;
  1005. gadget->udc = udc;
  1006. mutex_lock(&udc_lock);
  1007. list_add_tail(&udc->list, &udc_list);
  1008. ret = device_add(&udc->dev);
  1009. if (ret)
  1010. goto err_unlist_udc;
  1011. usb_gadget_set_state(gadget, USB_STATE_NOTATTACHED);
  1012. udc->vbus = true;
  1013. /* pick up one of pending gadget drivers */
  1014. ret = check_pending_gadget_drivers(udc);
  1015. if (ret)
  1016. goto err_del_udc;
  1017. mutex_unlock(&udc_lock);
  1018. return 0;
  1019. err_del_udc:
  1020. device_del(&udc->dev);
  1021. err_unlist_udc:
  1022. list_del(&udc->list);
  1023. mutex_unlock(&udc_lock);
  1024. device_del(&gadget->dev);
  1025. err_put_udc:
  1026. put_device(&udc->dev);
  1027. err_put_gadget:
  1028. put_device(&gadget->dev);
  1029. return ret;
  1030. }
  1031. EXPORT_SYMBOL_GPL(usb_add_gadget_udc_release);
  1032. /**
  1033. * usb_get_gadget_udc_name - get the name of the first UDC controller
  1034. * This functions returns the name of the first UDC controller in the system.
  1035. * Please note that this interface is usefull only for legacy drivers which
  1036. * assume that there is only one UDC controller in the system and they need to
  1037. * get its name before initialization. There is no guarantee that the UDC
  1038. * of the returned name will be still available, when gadget driver registers
  1039. * itself.
  1040. *
  1041. * Returns pointer to string with UDC controller name on success, NULL
  1042. * otherwise. Caller should kfree() returned string.
  1043. */
  1044. char *usb_get_gadget_udc_name(void)
  1045. {
  1046. struct usb_udc *udc;
  1047. char *name = NULL;
  1048. /* For now we take the first available UDC */
  1049. mutex_lock(&udc_lock);
  1050. list_for_each_entry(udc, &udc_list, list) {
  1051. if (!udc->driver) {
  1052. name = kstrdup(udc->gadget->name, GFP_KERNEL);
  1053. break;
  1054. }
  1055. }
  1056. mutex_unlock(&udc_lock);
  1057. return name;
  1058. }
  1059. EXPORT_SYMBOL_GPL(usb_get_gadget_udc_name);
  1060. /**
  1061. * usb_add_gadget_udc - adds a new gadget to the udc class driver list
  1062. * @parent: the parent device to this udc. Usually the controller
  1063. * driver's device.
  1064. * @gadget: the gadget to be added to the list
  1065. *
  1066. * Returns zero on success, negative errno otherwise.
  1067. */
  1068. int usb_add_gadget_udc(struct device *parent, struct usb_gadget *gadget)
  1069. {
  1070. return usb_add_gadget_udc_release(parent, gadget, NULL);
  1071. }
  1072. EXPORT_SYMBOL_GPL(usb_add_gadget_udc);
  1073. static void usb_gadget_remove_driver(struct usb_udc *udc)
  1074. {
  1075. dev_dbg(&udc->dev, "unregistering UDC driver [%s]\n",
  1076. udc->driver->function);
  1077. kobject_uevent(&udc->dev.kobj, KOBJ_CHANGE);
  1078. usb_gadget_disconnect(udc->gadget);
  1079. udc->driver->disconnect(udc->gadget);
  1080. udc->driver->unbind(udc->gadget);
  1081. usb_gadget_udc_stop(udc);
  1082. udc->driver = NULL;
  1083. udc->dev.driver = NULL;
  1084. udc->gadget->dev.driver = NULL;
  1085. }
  1086. /**
  1087. * usb_del_gadget_udc - deletes @udc from udc_list
  1088. * @gadget: the gadget to be removed.
  1089. *
  1090. * This, will call usb_gadget_unregister_driver() if
  1091. * the @udc is still busy.
  1092. */
  1093. void usb_del_gadget_udc(struct usb_gadget *gadget)
  1094. {
  1095. struct usb_udc *udc = gadget->udc;
  1096. if (!udc)
  1097. return;
  1098. dev_vdbg(gadget->dev.parent, "unregistering gadget\n");
  1099. mutex_lock(&udc_lock);
  1100. list_del(&udc->list);
  1101. if (udc->driver) {
  1102. struct usb_gadget_driver *driver = udc->driver;
  1103. usb_gadget_remove_driver(udc);
  1104. list_add(&driver->pending, &gadget_driver_pending_list);
  1105. }
  1106. mutex_unlock(&udc_lock);
  1107. kobject_uevent(&udc->dev.kobj, KOBJ_REMOVE);
  1108. flush_work(&gadget->work);
  1109. device_unregister(&udc->dev);
  1110. device_unregister(&gadget->dev);
  1111. memset(&gadget->dev, 0x00, sizeof(gadget->dev));
  1112. }
  1113. EXPORT_SYMBOL_GPL(usb_del_gadget_udc);
  1114. /* ------------------------------------------------------------------------- */
  1115. static int udc_bind_to_driver(struct usb_udc *udc, struct usb_gadget_driver *driver)
  1116. {
  1117. int ret;
  1118. dev_dbg(&udc->dev, "registering UDC driver [%s]\n",
  1119. driver->function);
  1120. udc->driver = driver;
  1121. udc->dev.driver = &driver->driver;
  1122. udc->gadget->dev.driver = &driver->driver;
  1123. usb_gadget_udc_set_speed(udc, driver->max_speed);
  1124. ret = driver->bind(udc->gadget, driver);
  1125. if (ret)
  1126. goto err1;
  1127. ret = usb_gadget_udc_start(udc);
  1128. if (ret) {
  1129. driver->unbind(udc->gadget);
  1130. goto err1;
  1131. }
  1132. usb_udc_connect_control(udc);
  1133. kobject_uevent(&udc->dev.kobj, KOBJ_CHANGE);
  1134. return 0;
  1135. err1:
  1136. if (ret != -EISNAM)
  1137. dev_err(&udc->dev, "failed to start %s: %d\n",
  1138. udc->driver->function, ret);
  1139. udc->driver = NULL;
  1140. udc->dev.driver = NULL;
  1141. udc->gadget->dev.driver = NULL;
  1142. return ret;
  1143. }
  1144. int usb_gadget_probe_driver(struct usb_gadget_driver *driver)
  1145. {
  1146. struct usb_udc *udc = NULL;
  1147. int ret = -ENODEV;
  1148. if (!driver || !driver->bind || !driver->setup)
  1149. return -EINVAL;
  1150. mutex_lock(&udc_lock);
  1151. if (driver->udc_name) {
  1152. list_for_each_entry(udc, &udc_list, list) {
  1153. ret = strcmp(driver->udc_name, dev_name(&udc->dev));
  1154. if (!ret)
  1155. break;
  1156. }
  1157. if (ret)
  1158. ret = -ENODEV;
  1159. else if (udc->driver)
  1160. ret = -EBUSY;
  1161. else
  1162. goto found;
  1163. } else {
  1164. list_for_each_entry(udc, &udc_list, list) {
  1165. /* For now we take the first one */
  1166. if (!udc->driver)
  1167. goto found;
  1168. }
  1169. }
  1170. if (!driver->match_existing_only) {
  1171. list_add_tail(&driver->pending, &gadget_driver_pending_list);
  1172. pr_info("udc-core: couldn't find an available UDC - added [%s] to list of pending drivers\n",
  1173. driver->function);
  1174. ret = 0;
  1175. }
  1176. mutex_unlock(&udc_lock);
  1177. return ret;
  1178. found:
  1179. ret = udc_bind_to_driver(udc, driver);
  1180. mutex_unlock(&udc_lock);
  1181. return ret;
  1182. }
  1183. EXPORT_SYMBOL_GPL(usb_gadget_probe_driver);
  1184. int usb_gadget_unregister_driver(struct usb_gadget_driver *driver)
  1185. {
  1186. struct usb_udc *udc = NULL;
  1187. int ret = -ENODEV;
  1188. if (!driver || !driver->unbind)
  1189. return -EINVAL;
  1190. mutex_lock(&udc_lock);
  1191. list_for_each_entry(udc, &udc_list, list) {
  1192. if (udc->driver == driver) {
  1193. usb_gadget_remove_driver(udc);
  1194. usb_gadget_set_state(udc->gadget,
  1195. USB_STATE_NOTATTACHED);
  1196. /* Maybe there is someone waiting for this UDC? */
  1197. check_pending_gadget_drivers(udc);
  1198. /*
  1199. * For now we ignore bind errors as probably it's
  1200. * not a valid reason to fail other's gadget unbind
  1201. */
  1202. ret = 0;
  1203. break;
  1204. }
  1205. }
  1206. if (ret) {
  1207. list_del(&driver->pending);
  1208. ret = 0;
  1209. }
  1210. mutex_unlock(&udc_lock);
  1211. return ret;
  1212. }
  1213. EXPORT_SYMBOL_GPL(usb_gadget_unregister_driver);
  1214. /* ------------------------------------------------------------------------- */
  1215. static ssize_t srp_store(struct device *dev,
  1216. struct device_attribute *attr, const char *buf, size_t n)
  1217. {
  1218. struct usb_udc *udc = container_of(dev, struct usb_udc, dev);
  1219. if (sysfs_streq(buf, "1"))
  1220. usb_gadget_wakeup(udc->gadget);
  1221. return n;
  1222. }
  1223. static DEVICE_ATTR_WO(srp);
  1224. static ssize_t soft_connect_store(struct device *dev,
  1225. struct device_attribute *attr, const char *buf, size_t n)
  1226. {
  1227. struct usb_udc *udc = container_of(dev, struct usb_udc, dev);
  1228. if (!udc->driver) {
  1229. dev_err(dev, "soft-connect without a gadget driver\n");
  1230. return -EOPNOTSUPP;
  1231. }
  1232. if (sysfs_streq(buf, "connect")) {
  1233. usb_gadget_udc_start(udc);
  1234. usb_gadget_connect(udc->gadget);
  1235. } else if (sysfs_streq(buf, "disconnect")) {
  1236. usb_gadget_disconnect(udc->gadget);
  1237. udc->driver->disconnect(udc->gadget);
  1238. usb_gadget_udc_stop(udc);
  1239. } else {
  1240. dev_err(dev, "unsupported command '%s'\n", buf);
  1241. return -EINVAL;
  1242. }
  1243. return n;
  1244. }
  1245. static DEVICE_ATTR_WO(soft_connect);
  1246. static ssize_t state_show(struct device *dev, struct device_attribute *attr,
  1247. char *buf)
  1248. {
  1249. struct usb_udc *udc = container_of(dev, struct usb_udc, dev);
  1250. struct usb_gadget *gadget = udc->gadget;
  1251. return sprintf(buf, "%s\n", usb_state_string(gadget->state));
  1252. }
  1253. static DEVICE_ATTR_RO(state);
  1254. static ssize_t function_show(struct device *dev, struct device_attribute *attr,
  1255. char *buf)
  1256. {
  1257. struct usb_udc *udc = container_of(dev, struct usb_udc, dev);
  1258. struct usb_gadget_driver *drv = udc->driver;
  1259. if (!drv || !drv->function)
  1260. return 0;
  1261. return scnprintf(buf, PAGE_SIZE, "%s\n", drv->function);
  1262. }
  1263. static DEVICE_ATTR_RO(function);
  1264. #define USB_UDC_SPEED_ATTR(name, param) \
  1265. ssize_t name##_show(struct device *dev, \
  1266. struct device_attribute *attr, char *buf) \
  1267. { \
  1268. struct usb_udc *udc = container_of(dev, struct usb_udc, dev); \
  1269. return scnprintf(buf, PAGE_SIZE, "%s\n", \
  1270. usb_speed_string(udc->gadget->param)); \
  1271. } \
  1272. static DEVICE_ATTR_RO(name)
  1273. static USB_UDC_SPEED_ATTR(current_speed, speed);
  1274. static USB_UDC_SPEED_ATTR(maximum_speed, max_speed);
  1275. #define USB_UDC_ATTR(name) \
  1276. ssize_t name##_show(struct device *dev, \
  1277. struct device_attribute *attr, char *buf) \
  1278. { \
  1279. struct usb_udc *udc = container_of(dev, struct usb_udc, dev); \
  1280. struct usb_gadget *gadget = udc->gadget; \
  1281. \
  1282. return scnprintf(buf, PAGE_SIZE, "%d\n", gadget->name); \
  1283. } \
  1284. static DEVICE_ATTR_RO(name)
  1285. static USB_UDC_ATTR(is_otg);
  1286. static USB_UDC_ATTR(is_a_peripheral);
  1287. static USB_UDC_ATTR(b_hnp_enable);
  1288. static USB_UDC_ATTR(a_hnp_support);
  1289. static USB_UDC_ATTR(a_alt_hnp_support);
  1290. static USB_UDC_ATTR(is_selfpowered);
  1291. static struct attribute *usb_udc_attrs[] = {
  1292. &dev_attr_srp.attr,
  1293. &dev_attr_soft_connect.attr,
  1294. &dev_attr_state.attr,
  1295. &dev_attr_function.attr,
  1296. &dev_attr_current_speed.attr,
  1297. &dev_attr_maximum_speed.attr,
  1298. &dev_attr_is_otg.attr,
  1299. &dev_attr_is_a_peripheral.attr,
  1300. &dev_attr_b_hnp_enable.attr,
  1301. &dev_attr_a_hnp_support.attr,
  1302. &dev_attr_a_alt_hnp_support.attr,
  1303. &dev_attr_is_selfpowered.attr,
  1304. NULL,
  1305. };
  1306. static const struct attribute_group usb_udc_attr_group = {
  1307. .attrs = usb_udc_attrs,
  1308. };
  1309. static const struct attribute_group *usb_udc_attr_groups[] = {
  1310. &usb_udc_attr_group,
  1311. NULL,
  1312. };
  1313. static int usb_udc_uevent(struct device *dev, struct kobj_uevent_env *env)
  1314. {
  1315. struct usb_udc *udc = container_of(dev, struct usb_udc, dev);
  1316. int ret;
  1317. ret = add_uevent_var(env, "USB_UDC_NAME=%s", udc->gadget->name);
  1318. if (ret) {
  1319. dev_err(dev, "failed to add uevent USB_UDC_NAME\n");
  1320. return ret;
  1321. }
  1322. if (udc->driver) {
  1323. ret = add_uevent_var(env, "USB_UDC_DRIVER=%s",
  1324. udc->driver->function);
  1325. if (ret) {
  1326. dev_err(dev, "failed to add uevent USB_UDC_DRIVER\n");
  1327. return ret;
  1328. }
  1329. }
  1330. return 0;
  1331. }
  1332. static int __init usb_udc_init(void)
  1333. {
  1334. udc_class = class_create(THIS_MODULE, "udc");
  1335. if (IS_ERR(udc_class)) {
  1336. pr_err("failed to create udc class --> %ld\n",
  1337. PTR_ERR(udc_class));
  1338. return PTR_ERR(udc_class);
  1339. }
  1340. udc_class->dev_uevent = usb_udc_uevent;
  1341. return 0;
  1342. }
  1343. subsys_initcall(usb_udc_init);
  1344. static void __exit usb_udc_exit(void)
  1345. {
  1346. class_destroy(udc_class);
  1347. }
  1348. module_exit(usb_udc_exit);
  1349. MODULE_DESCRIPTION("UDC Framework");
  1350. MODULE_AUTHOR("Felipe Balbi <balbi@ti.com>");
  1351. MODULE_LICENSE("GPL v2");