f_uac2.c 34 KB

1234567891011121314151617181920212223242526272829303132333435363738394041424344454647484950515253545556575859606162636465666768697071727374757677787980818283848586878889909192939495969798991001011021031041051061071081091101111121131141151161171181191201211221231241251261271281291301311321331341351361371381391401411421431441451461471481491501511521531541551561571581591601611621631641651661671681691701711721731741751761771781791801811821831841851861871881891901911921931941951961971981992002012022032042052062072082092102112122132142152162172182192202212222232242252262272282292302312322332342352362372382392402412422432442452462472482492502512522532542552562572582592602612622632642652662672682692702712722732742752762772782792802812822832842852862872882892902912922932942952962972982993003013023033043053063073083093103113123133143153163173183193203213223233243253263273283293303313323333343353363373383393403413423433443453463473483493503513523533543553563573583593603613623633643653663673683693703713723733743753763773783793803813823833843853863873883893903913923933943953963973983994004014024034044054064074084094104114124134144154164174184194204214224234244254264274284294304314324334344354364374384394404414424434444454464474484494504514524534544554564574584594604614624634644654664674684694704714724734744754764774784794804814824834844854864874884894904914924934944954964974984995005015025035045055065075085095105115125135145155165175185195205215225235245255265275285295305315325335345355365375385395405415425435445455465475485495505515525535545555565575585595605615625635645655665675685695705715725735745755765775785795805815825835845855865875885895905915925935945955965975985996006016026036046056066076086096106116126136146156166176186196206216226236246256266276286296306316326336346356366376386396406416426436446456466476486496506516526536546556566576586596606616626636646656666676686696706716726736746756766776786796806816826836846856866876886896906916926936946956966976986997007017027037047057067077087097107117127137147157167177187197207217227237247257267277287297307317327337347357367377387397407417427437447457467477487497507517527537547557567577587597607617627637647657667677687697707717727737747757767777787797807817827837847857867877887897907917927937947957967977987998008018028038048058068078088098108118128138148158168178188198208218228238248258268278288298308318328338348358368378388398408418428438448458468478488498508518528538548558568578588598608618628638648658668678688698708718728738748758768778788798808818828838848858868878888898908918928938948958968978988999009019029039049059069079089099109119129139149159169179189199209219229239249259269279289299309319329339349359369379389399409419429439449459469479489499509519529539549559569579589599609619629639649659669679689699709719729739749759769779789799809819829839849859869879889899909919929939949959969979989991000100110021003100410051006100710081009101010111012101310141015101610171018101910201021102210231024102510261027102810291030103110321033103410351036103710381039104010411042104310441045104610471048104910501051105210531054105510561057105810591060106110621063106410651066106710681069107010711072107310741075107610771078107910801081108210831084108510861087108810891090109110921093109410951096109710981099110011011102110311041105110611071108110911101111111211131114111511161117111811191120112111221123112411251126112711281129113011311132113311341135113611371138113911401141114211431144114511461147114811491150115111521153115411551156115711581159116011611162116311641165116611671168116911701171117211731174117511761177117811791180118111821183118411851186118711881189119011911192119311941195119611971198119912001201120212031204120512061207120812091210121112121213121412151216121712181219122012211222122312241225122612271228122912301231123212331234123512361237123812391240124112421243124412451246124712481249125012511252125312541255125612571258125912601261126212631264126512661267126812691270127112721273127412751276127712781279128012811282128312841285128612871288128912901291129212931294129512961297129812991300130113021303130413051306130713081309131013111312131313141315131613171318131913201321132213231324132513261327132813291330133113321333133413351336133713381339134013411342134313441345134613471348134913501351135213531354
  1. /*
  2. * f_uac2.c -- USB Audio Class 2.0 Function
  3. *
  4. * Copyright (C) 2011
  5. * Yadwinder Singh (yadi.brar01@gmail.com)
  6. * Jaswinder Singh (jaswinder.singh@linaro.org)
  7. *
  8. * This program is free software; you can redistribute it and/or modify
  9. * it under the terms of the GNU General Public License as published by
  10. * the Free Software Foundation; either version 2 of the License, or
  11. * (at your option) any later version.
  12. */
  13. #include <linux/usb/audio.h>
  14. #include <linux/usb/audio-v2.h>
  15. #include <linux/platform_device.h>
  16. #include <linux/module.h>
  17. #include <sound/core.h>
  18. #include <sound/pcm.h>
  19. #include <sound/pcm_params.h>
  20. /* Playback(USB-IN) Default Stereo - Fl/Fr */
  21. static int p_chmask = 0x3;
  22. module_param(p_chmask, uint, S_IRUGO);
  23. MODULE_PARM_DESC(p_chmask, "Playback Channel Mask");
  24. /* Playback Default 48 KHz */
  25. static int p_srate = 48000;
  26. module_param(p_srate, uint, S_IRUGO);
  27. MODULE_PARM_DESC(p_srate, "Playback Sampling Rate");
  28. /* Playback Default 16bits/sample */
  29. static int p_ssize = 2;
  30. module_param(p_ssize, uint, S_IRUGO);
  31. MODULE_PARM_DESC(p_ssize, "Playback Sample Size(bytes)");
  32. /* Capture(USB-OUT) Default Stereo - Fl/Fr */
  33. static int c_chmask = 0x3;
  34. module_param(c_chmask, uint, S_IRUGO);
  35. MODULE_PARM_DESC(c_chmask, "Capture Channel Mask");
  36. /* Capture Default 64 KHz */
  37. static int c_srate = 64000;
  38. module_param(c_srate, uint, S_IRUGO);
  39. MODULE_PARM_DESC(c_srate, "Capture Sampling Rate");
  40. /* Capture Default 16bits/sample */
  41. static int c_ssize = 2;
  42. module_param(c_ssize, uint, S_IRUGO);
  43. MODULE_PARM_DESC(c_ssize, "Capture Sample Size(bytes)");
  44. /* Keep everyone on toes */
  45. #define USB_XFERS 2
  46. /*
  47. * The driver implements a simple UAC_2 topology.
  48. * USB-OUT -> IT_1 -> OT_3 -> ALSA_Capture
  49. * ALSA_Playback -> IT_2 -> OT_4 -> USB-IN
  50. * Capture and Playback sampling rates are independently
  51. * controlled by two clock sources :
  52. * CLK_5 := c_srate, and CLK_6 := p_srate
  53. */
  54. #define USB_OUT_IT_ID 1
  55. #define IO_IN_IT_ID 2
  56. #define IO_OUT_OT_ID 3
  57. #define USB_IN_OT_ID 4
  58. #define USB_OUT_CLK_ID 5
  59. #define USB_IN_CLK_ID 6
  60. #define CONTROL_ABSENT 0
  61. #define CONTROL_RDONLY 1
  62. #define CONTROL_RDWR 3
  63. #define CLK_FREQ_CTRL 0
  64. #define CLK_VLD_CTRL 2
  65. #define COPY_CTRL 0
  66. #define CONN_CTRL 2
  67. #define OVRLD_CTRL 4
  68. #define CLSTR_CTRL 6
  69. #define UNFLW_CTRL 8
  70. #define OVFLW_CTRL 10
  71. const char *uac2_name = "snd_uac2";
  72. struct uac2_req {
  73. struct uac2_rtd_params *pp; /* parent param */
  74. struct usb_request *req;
  75. };
  76. struct uac2_rtd_params {
  77. struct snd_uac2_chip *uac2; /* parent chip */
  78. bool ep_enabled; /* if the ep is enabled */
  79. /* Size of the ring buffer */
  80. size_t dma_bytes;
  81. unsigned char *dma_area;
  82. struct snd_pcm_substream *ss;
  83. /* Ring buffer */
  84. ssize_t hw_ptr;
  85. void *rbuf;
  86. size_t period_size;
  87. unsigned max_psize;
  88. struct uac2_req ureq[USB_XFERS];
  89. spinlock_t lock;
  90. };
  91. struct snd_uac2_chip {
  92. struct platform_device pdev;
  93. struct platform_driver pdrv;
  94. struct uac2_rtd_params p_prm;
  95. struct uac2_rtd_params c_prm;
  96. struct snd_card *card;
  97. struct snd_pcm *pcm;
  98. };
  99. #define BUFF_SIZE_MAX (PAGE_SIZE * 16)
  100. #define PRD_SIZE_MAX PAGE_SIZE
  101. #define MIN_PERIODS 4
  102. static struct snd_pcm_hardware uac2_pcm_hardware = {
  103. .info = SNDRV_PCM_INFO_INTERLEAVED | SNDRV_PCM_INFO_BLOCK_TRANSFER
  104. | SNDRV_PCM_INFO_MMAP | SNDRV_PCM_INFO_MMAP_VALID
  105. | SNDRV_PCM_INFO_PAUSE | SNDRV_PCM_INFO_RESUME,
  106. .rates = SNDRV_PCM_RATE_CONTINUOUS,
  107. .periods_max = BUFF_SIZE_MAX / PRD_SIZE_MAX,
  108. .buffer_bytes_max = BUFF_SIZE_MAX,
  109. .period_bytes_max = PRD_SIZE_MAX,
  110. .periods_min = MIN_PERIODS,
  111. };
  112. struct audio_dev {
  113. u8 ac_intf, ac_alt;
  114. u8 as_out_intf, as_out_alt;
  115. u8 as_in_intf, as_in_alt;
  116. struct usb_ep *in_ep, *out_ep;
  117. struct usb_function func;
  118. /* The ALSA Sound Card it represents on the USB-Client side */
  119. struct snd_uac2_chip uac2;
  120. };
  121. static struct audio_dev *agdev_g;
  122. static inline
  123. struct audio_dev *func_to_agdev(struct usb_function *f)
  124. {
  125. return container_of(f, struct audio_dev, func);
  126. }
  127. static inline
  128. struct audio_dev *uac2_to_agdev(struct snd_uac2_chip *u)
  129. {
  130. return container_of(u, struct audio_dev, uac2);
  131. }
  132. static inline
  133. struct snd_uac2_chip *pdev_to_uac2(struct platform_device *p)
  134. {
  135. return container_of(p, struct snd_uac2_chip, pdev);
  136. }
  137. static inline
  138. uint num_channels(uint chanmask)
  139. {
  140. uint num = 0;
  141. while (chanmask) {
  142. num += (chanmask & 1);
  143. chanmask >>= 1;
  144. }
  145. return num;
  146. }
  147. static void
  148. agdev_iso_complete(struct usb_ep *ep, struct usb_request *req)
  149. {
  150. unsigned pending;
  151. unsigned long flags;
  152. bool update_alsa = false;
  153. unsigned char *src, *dst;
  154. int status = req->status;
  155. struct uac2_req *ur = req->context;
  156. struct snd_pcm_substream *substream;
  157. struct uac2_rtd_params *prm = ur->pp;
  158. struct snd_uac2_chip *uac2 = prm->uac2;
  159. /* i/f shutting down */
  160. if (!prm->ep_enabled || req->status == -ESHUTDOWN)
  161. return;
  162. /*
  163. * We can't really do much about bad xfers.
  164. * Afterall, the ISOCH xfers could fail legitimately.
  165. */
  166. if (status)
  167. pr_debug("%s: iso_complete status(%d) %d/%d\n",
  168. __func__, status, req->actual, req->length);
  169. substream = prm->ss;
  170. /* Do nothing if ALSA isn't active */
  171. if (!substream)
  172. goto exit;
  173. spin_lock_irqsave(&prm->lock, flags);
  174. if (substream->stream == SNDRV_PCM_STREAM_PLAYBACK) {
  175. src = prm->dma_area + prm->hw_ptr;
  176. req->actual = req->length;
  177. dst = req->buf;
  178. } else {
  179. dst = prm->dma_area + prm->hw_ptr;
  180. src = req->buf;
  181. }
  182. pending = prm->hw_ptr % prm->period_size;
  183. pending += req->actual;
  184. if (pending >= prm->period_size)
  185. update_alsa = true;
  186. prm->hw_ptr = (prm->hw_ptr + req->actual) % prm->dma_bytes;
  187. spin_unlock_irqrestore(&prm->lock, flags);
  188. /* Pack USB load in ALSA ring buffer */
  189. memcpy(dst, src, req->actual);
  190. exit:
  191. if (usb_ep_queue(ep, req, GFP_ATOMIC))
  192. dev_err(&uac2->pdev.dev, "%d Error!\n", __LINE__);
  193. if (update_alsa)
  194. snd_pcm_period_elapsed(substream);
  195. return;
  196. }
  197. static int
  198. uac2_pcm_trigger(struct snd_pcm_substream *substream, int cmd)
  199. {
  200. struct snd_uac2_chip *uac2 = snd_pcm_substream_chip(substream);
  201. struct uac2_rtd_params *prm;
  202. unsigned long flags;
  203. int err = 0;
  204. if (substream->stream == SNDRV_PCM_STREAM_PLAYBACK)
  205. prm = &uac2->p_prm;
  206. else
  207. prm = &uac2->c_prm;
  208. spin_lock_irqsave(&prm->lock, flags);
  209. /* Reset */
  210. prm->hw_ptr = 0;
  211. switch (cmd) {
  212. case SNDRV_PCM_TRIGGER_START:
  213. case SNDRV_PCM_TRIGGER_RESUME:
  214. prm->ss = substream;
  215. break;
  216. case SNDRV_PCM_TRIGGER_STOP:
  217. case SNDRV_PCM_TRIGGER_SUSPEND:
  218. prm->ss = NULL;
  219. break;
  220. default:
  221. err = -EINVAL;
  222. }
  223. spin_unlock_irqrestore(&prm->lock, flags);
  224. /* Clear buffer after Play stops */
  225. if (substream->stream == SNDRV_PCM_STREAM_PLAYBACK && !prm->ss)
  226. memset(prm->rbuf, 0, prm->max_psize * USB_XFERS);
  227. return err;
  228. }
  229. static snd_pcm_uframes_t uac2_pcm_pointer(struct snd_pcm_substream *substream)
  230. {
  231. struct snd_uac2_chip *uac2 = snd_pcm_substream_chip(substream);
  232. struct uac2_rtd_params *prm;
  233. if (substream->stream == SNDRV_PCM_STREAM_PLAYBACK)
  234. prm = &uac2->p_prm;
  235. else
  236. prm = &uac2->c_prm;
  237. return bytes_to_frames(substream->runtime, prm->hw_ptr);
  238. }
  239. static int uac2_pcm_hw_params(struct snd_pcm_substream *substream,
  240. struct snd_pcm_hw_params *hw_params)
  241. {
  242. struct snd_uac2_chip *uac2 = snd_pcm_substream_chip(substream);
  243. struct uac2_rtd_params *prm;
  244. int err;
  245. if (substream->stream == SNDRV_PCM_STREAM_PLAYBACK)
  246. prm = &uac2->p_prm;
  247. else
  248. prm = &uac2->c_prm;
  249. err = snd_pcm_lib_malloc_pages(substream,
  250. params_buffer_bytes(hw_params));
  251. if (err >= 0) {
  252. prm->dma_bytes = substream->runtime->dma_bytes;
  253. prm->dma_area = substream->runtime->dma_area;
  254. prm->period_size = params_period_bytes(hw_params);
  255. }
  256. return err;
  257. }
  258. static int uac2_pcm_hw_free(struct snd_pcm_substream *substream)
  259. {
  260. struct snd_uac2_chip *uac2 = snd_pcm_substream_chip(substream);
  261. struct uac2_rtd_params *prm;
  262. if (substream->stream == SNDRV_PCM_STREAM_PLAYBACK)
  263. prm = &uac2->p_prm;
  264. else
  265. prm = &uac2->c_prm;
  266. prm->dma_area = NULL;
  267. prm->dma_bytes = 0;
  268. prm->period_size = 0;
  269. return snd_pcm_lib_free_pages(substream);
  270. }
  271. static int uac2_pcm_open(struct snd_pcm_substream *substream)
  272. {
  273. struct snd_uac2_chip *uac2 = snd_pcm_substream_chip(substream);
  274. struct snd_pcm_runtime *runtime = substream->runtime;
  275. runtime->hw = uac2_pcm_hardware;
  276. if (substream->stream == SNDRV_PCM_STREAM_PLAYBACK) {
  277. spin_lock_init(&uac2->p_prm.lock);
  278. runtime->hw.rate_min = p_srate;
  279. runtime->hw.formats = SNDRV_PCM_FMTBIT_S16_LE; /* ! p_ssize ! */
  280. runtime->hw.channels_min = num_channels(p_chmask);
  281. runtime->hw.period_bytes_min = 2 * uac2->p_prm.max_psize
  282. / runtime->hw.periods_min;
  283. } else {
  284. spin_lock_init(&uac2->c_prm.lock);
  285. runtime->hw.rate_min = c_srate;
  286. runtime->hw.formats = SNDRV_PCM_FMTBIT_S16_LE; /* ! c_ssize ! */
  287. runtime->hw.channels_min = num_channels(c_chmask);
  288. runtime->hw.period_bytes_min = 2 * uac2->c_prm.max_psize
  289. / runtime->hw.periods_min;
  290. }
  291. runtime->hw.rate_max = runtime->hw.rate_min;
  292. runtime->hw.channels_max = runtime->hw.channels_min;
  293. snd_pcm_hw_constraint_integer(runtime, SNDRV_PCM_HW_PARAM_PERIODS);
  294. return 0;
  295. }
  296. /* ALSA cries without these function pointers */
  297. static int uac2_pcm_null(struct snd_pcm_substream *substream)
  298. {
  299. return 0;
  300. }
  301. static struct snd_pcm_ops uac2_pcm_ops = {
  302. .open = uac2_pcm_open,
  303. .close = uac2_pcm_null,
  304. .ioctl = snd_pcm_lib_ioctl,
  305. .hw_params = uac2_pcm_hw_params,
  306. .hw_free = uac2_pcm_hw_free,
  307. .trigger = uac2_pcm_trigger,
  308. .pointer = uac2_pcm_pointer,
  309. .prepare = uac2_pcm_null,
  310. };
  311. static int snd_uac2_probe(struct platform_device *pdev)
  312. {
  313. struct snd_uac2_chip *uac2 = pdev_to_uac2(pdev);
  314. struct snd_card *card;
  315. struct snd_pcm *pcm;
  316. int err;
  317. /* Choose any slot, with no id */
  318. err = snd_card_new(&pdev->dev, -1, NULL, THIS_MODULE, 0, &card);
  319. if (err < 0)
  320. return err;
  321. uac2->card = card;
  322. /*
  323. * Create first PCM device
  324. * Create a substream only for non-zero channel streams
  325. */
  326. err = snd_pcm_new(uac2->card, "UAC2 PCM", 0,
  327. p_chmask ? 1 : 0, c_chmask ? 1 : 0, &pcm);
  328. if (err < 0)
  329. goto snd_fail;
  330. strcpy(pcm->name, "UAC2 PCM");
  331. pcm->private_data = uac2;
  332. uac2->pcm = pcm;
  333. snd_pcm_set_ops(pcm, SNDRV_PCM_STREAM_PLAYBACK, &uac2_pcm_ops);
  334. snd_pcm_set_ops(pcm, SNDRV_PCM_STREAM_CAPTURE, &uac2_pcm_ops);
  335. strcpy(card->driver, "UAC2_Gadget");
  336. strcpy(card->shortname, "UAC2_Gadget");
  337. sprintf(card->longname, "UAC2_Gadget %i", pdev->id);
  338. snd_pcm_lib_preallocate_pages_for_all(pcm, SNDRV_DMA_TYPE_CONTINUOUS,
  339. snd_dma_continuous_data(GFP_KERNEL), 0, BUFF_SIZE_MAX);
  340. err = snd_card_register(card);
  341. if (!err) {
  342. platform_set_drvdata(pdev, card);
  343. return 0;
  344. }
  345. snd_fail:
  346. snd_card_free(card);
  347. uac2->pcm = NULL;
  348. uac2->card = NULL;
  349. return err;
  350. }
  351. static int snd_uac2_remove(struct platform_device *pdev)
  352. {
  353. struct snd_card *card = platform_get_drvdata(pdev);
  354. if (card)
  355. return snd_card_free(card);
  356. return 0;
  357. }
  358. static int alsa_uac2_init(struct audio_dev *agdev)
  359. {
  360. struct snd_uac2_chip *uac2 = &agdev->uac2;
  361. int err;
  362. uac2->pdrv.probe = snd_uac2_probe;
  363. uac2->pdrv.remove = snd_uac2_remove;
  364. uac2->pdrv.driver.name = uac2_name;
  365. uac2->pdev.id = 0;
  366. uac2->pdev.name = uac2_name;
  367. /* Register snd_uac2 driver */
  368. err = platform_driver_register(&uac2->pdrv);
  369. if (err)
  370. return err;
  371. /* Register snd_uac2 device */
  372. err = platform_device_register(&uac2->pdev);
  373. if (err)
  374. platform_driver_unregister(&uac2->pdrv);
  375. return err;
  376. }
  377. static void alsa_uac2_exit(struct audio_dev *agdev)
  378. {
  379. struct snd_uac2_chip *uac2 = &agdev->uac2;
  380. platform_driver_unregister(&uac2->pdrv);
  381. platform_device_unregister(&uac2->pdev);
  382. }
  383. /* --------- USB Function Interface ------------- */
  384. enum {
  385. STR_ASSOC,
  386. STR_IF_CTRL,
  387. STR_CLKSRC_IN,
  388. STR_CLKSRC_OUT,
  389. STR_USB_IT,
  390. STR_IO_IT,
  391. STR_USB_OT,
  392. STR_IO_OT,
  393. STR_AS_OUT_ALT0,
  394. STR_AS_OUT_ALT1,
  395. STR_AS_IN_ALT0,
  396. STR_AS_IN_ALT1,
  397. };
  398. static char clksrc_in[8];
  399. static char clksrc_out[8];
  400. static struct usb_string strings_fn[] = {
  401. [STR_ASSOC].s = "Source/Sink",
  402. [STR_IF_CTRL].s = "Topology Control",
  403. [STR_CLKSRC_IN].s = clksrc_in,
  404. [STR_CLKSRC_OUT].s = clksrc_out,
  405. [STR_USB_IT].s = "USBH Out",
  406. [STR_IO_IT].s = "USBD Out",
  407. [STR_USB_OT].s = "USBH In",
  408. [STR_IO_OT].s = "USBD In",
  409. [STR_AS_OUT_ALT0].s = "Playback Inactive",
  410. [STR_AS_OUT_ALT1].s = "Playback Active",
  411. [STR_AS_IN_ALT0].s = "Capture Inactive",
  412. [STR_AS_IN_ALT1].s = "Capture Active",
  413. { },
  414. };
  415. static struct usb_gadget_strings str_fn = {
  416. .language = 0x0409, /* en-us */
  417. .strings = strings_fn,
  418. };
  419. static struct usb_gadget_strings *fn_strings[] = {
  420. &str_fn,
  421. NULL,
  422. };
  423. static struct usb_qualifier_descriptor devqual_desc = {
  424. .bLength = sizeof devqual_desc,
  425. .bDescriptorType = USB_DT_DEVICE_QUALIFIER,
  426. .bcdUSB = cpu_to_le16(0x200),
  427. .bDeviceClass = USB_CLASS_MISC,
  428. .bDeviceSubClass = 0x02,
  429. .bDeviceProtocol = 0x01,
  430. .bNumConfigurations = 1,
  431. .bRESERVED = 0,
  432. };
  433. static struct usb_interface_assoc_descriptor iad_desc = {
  434. .bLength = sizeof iad_desc,
  435. .bDescriptorType = USB_DT_INTERFACE_ASSOCIATION,
  436. .bFirstInterface = 0,
  437. .bInterfaceCount = 3,
  438. .bFunctionClass = USB_CLASS_AUDIO,
  439. .bFunctionSubClass = UAC2_FUNCTION_SUBCLASS_UNDEFINED,
  440. .bFunctionProtocol = UAC_VERSION_2,
  441. };
  442. /* Audio Control Interface */
  443. static struct usb_interface_descriptor std_ac_if_desc = {
  444. .bLength = sizeof std_ac_if_desc,
  445. .bDescriptorType = USB_DT_INTERFACE,
  446. .bAlternateSetting = 0,
  447. .bNumEndpoints = 0,
  448. .bInterfaceClass = USB_CLASS_AUDIO,
  449. .bInterfaceSubClass = USB_SUBCLASS_AUDIOCONTROL,
  450. .bInterfaceProtocol = UAC_VERSION_2,
  451. };
  452. /* Clock source for IN traffic */
  453. struct uac_clock_source_descriptor in_clk_src_desc = {
  454. .bLength = sizeof in_clk_src_desc,
  455. .bDescriptorType = USB_DT_CS_INTERFACE,
  456. .bDescriptorSubtype = UAC2_CLOCK_SOURCE,
  457. .bClockID = USB_IN_CLK_ID,
  458. .bmAttributes = UAC_CLOCK_SOURCE_TYPE_INT_FIXED,
  459. .bmControls = (CONTROL_RDONLY << CLK_FREQ_CTRL),
  460. .bAssocTerminal = 0,
  461. };
  462. /* Clock source for OUT traffic */
  463. struct uac_clock_source_descriptor out_clk_src_desc = {
  464. .bLength = sizeof out_clk_src_desc,
  465. .bDescriptorType = USB_DT_CS_INTERFACE,
  466. .bDescriptorSubtype = UAC2_CLOCK_SOURCE,
  467. .bClockID = USB_OUT_CLK_ID,
  468. .bmAttributes = UAC_CLOCK_SOURCE_TYPE_INT_FIXED,
  469. .bmControls = (CONTROL_RDONLY << CLK_FREQ_CTRL),
  470. .bAssocTerminal = 0,
  471. };
  472. /* Input Terminal for USB_OUT */
  473. struct uac2_input_terminal_descriptor usb_out_it_desc = {
  474. .bLength = sizeof usb_out_it_desc,
  475. .bDescriptorType = USB_DT_CS_INTERFACE,
  476. .bDescriptorSubtype = UAC_INPUT_TERMINAL,
  477. .bTerminalID = USB_OUT_IT_ID,
  478. .wTerminalType = cpu_to_le16(UAC_TERMINAL_STREAMING),
  479. .bAssocTerminal = 0,
  480. .bCSourceID = USB_OUT_CLK_ID,
  481. .iChannelNames = 0,
  482. .bmControls = (CONTROL_RDWR << COPY_CTRL),
  483. };
  484. /* Input Terminal for I/O-In */
  485. struct uac2_input_terminal_descriptor io_in_it_desc = {
  486. .bLength = sizeof io_in_it_desc,
  487. .bDescriptorType = USB_DT_CS_INTERFACE,
  488. .bDescriptorSubtype = UAC_INPUT_TERMINAL,
  489. .bTerminalID = IO_IN_IT_ID,
  490. .wTerminalType = cpu_to_le16(UAC_INPUT_TERMINAL_UNDEFINED),
  491. .bAssocTerminal = 0,
  492. .bCSourceID = USB_IN_CLK_ID,
  493. .iChannelNames = 0,
  494. .bmControls = (CONTROL_RDWR << COPY_CTRL),
  495. };
  496. /* Ouput Terminal for USB_IN */
  497. struct uac2_output_terminal_descriptor usb_in_ot_desc = {
  498. .bLength = sizeof usb_in_ot_desc,
  499. .bDescriptorType = USB_DT_CS_INTERFACE,
  500. .bDescriptorSubtype = UAC_OUTPUT_TERMINAL,
  501. .bTerminalID = USB_IN_OT_ID,
  502. .wTerminalType = cpu_to_le16(UAC_TERMINAL_STREAMING),
  503. .bAssocTerminal = 0,
  504. .bSourceID = IO_IN_IT_ID,
  505. .bCSourceID = USB_IN_CLK_ID,
  506. .bmControls = (CONTROL_RDWR << COPY_CTRL),
  507. };
  508. /* Ouput Terminal for I/O-Out */
  509. struct uac2_output_terminal_descriptor io_out_ot_desc = {
  510. .bLength = sizeof io_out_ot_desc,
  511. .bDescriptorType = USB_DT_CS_INTERFACE,
  512. .bDescriptorSubtype = UAC_OUTPUT_TERMINAL,
  513. .bTerminalID = IO_OUT_OT_ID,
  514. .wTerminalType = cpu_to_le16(UAC_OUTPUT_TERMINAL_UNDEFINED),
  515. .bAssocTerminal = 0,
  516. .bSourceID = USB_OUT_IT_ID,
  517. .bCSourceID = USB_OUT_CLK_ID,
  518. .bmControls = (CONTROL_RDWR << COPY_CTRL),
  519. };
  520. struct uac2_ac_header_descriptor ac_hdr_desc = {
  521. .bLength = sizeof ac_hdr_desc,
  522. .bDescriptorType = USB_DT_CS_INTERFACE,
  523. .bDescriptorSubtype = UAC_MS_HEADER,
  524. .bcdADC = cpu_to_le16(0x200),
  525. .bCategory = UAC2_FUNCTION_IO_BOX,
  526. .wTotalLength = sizeof in_clk_src_desc + sizeof out_clk_src_desc
  527. + sizeof usb_out_it_desc + sizeof io_in_it_desc
  528. + sizeof usb_in_ot_desc + sizeof io_out_ot_desc,
  529. .bmControls = 0,
  530. };
  531. /* Audio Streaming OUT Interface - Alt0 */
  532. static struct usb_interface_descriptor std_as_out_if0_desc = {
  533. .bLength = sizeof std_as_out_if0_desc,
  534. .bDescriptorType = USB_DT_INTERFACE,
  535. .bAlternateSetting = 0,
  536. .bNumEndpoints = 0,
  537. .bInterfaceClass = USB_CLASS_AUDIO,
  538. .bInterfaceSubClass = USB_SUBCLASS_AUDIOSTREAMING,
  539. .bInterfaceProtocol = UAC_VERSION_2,
  540. };
  541. /* Audio Streaming OUT Interface - Alt1 */
  542. static struct usb_interface_descriptor std_as_out_if1_desc = {
  543. .bLength = sizeof std_as_out_if1_desc,
  544. .bDescriptorType = USB_DT_INTERFACE,
  545. .bAlternateSetting = 1,
  546. .bNumEndpoints = 1,
  547. .bInterfaceClass = USB_CLASS_AUDIO,
  548. .bInterfaceSubClass = USB_SUBCLASS_AUDIOSTREAMING,
  549. .bInterfaceProtocol = UAC_VERSION_2,
  550. };
  551. /* Audio Stream OUT Intface Desc */
  552. struct uac2_as_header_descriptor as_out_hdr_desc = {
  553. .bLength = sizeof as_out_hdr_desc,
  554. .bDescriptorType = USB_DT_CS_INTERFACE,
  555. .bDescriptorSubtype = UAC_AS_GENERAL,
  556. .bTerminalLink = USB_OUT_IT_ID,
  557. .bmControls = 0,
  558. .bFormatType = UAC_FORMAT_TYPE_I,
  559. .bmFormats = cpu_to_le32(UAC_FORMAT_TYPE_I_PCM),
  560. .iChannelNames = 0,
  561. };
  562. /* Audio USB_OUT Format */
  563. struct uac2_format_type_i_descriptor as_out_fmt1_desc = {
  564. .bLength = sizeof as_out_fmt1_desc,
  565. .bDescriptorType = USB_DT_CS_INTERFACE,
  566. .bDescriptorSubtype = UAC_FORMAT_TYPE,
  567. .bFormatType = UAC_FORMAT_TYPE_I,
  568. };
  569. /* STD AS ISO OUT Endpoint */
  570. struct usb_endpoint_descriptor fs_epout_desc = {
  571. .bLength = USB_DT_ENDPOINT_SIZE,
  572. .bDescriptorType = USB_DT_ENDPOINT,
  573. .bEndpointAddress = USB_DIR_OUT,
  574. .bmAttributes = USB_ENDPOINT_XFER_ISOC | USB_ENDPOINT_SYNC_ASYNC,
  575. .bInterval = 1,
  576. };
  577. struct usb_endpoint_descriptor hs_epout_desc = {
  578. .bLength = USB_DT_ENDPOINT_SIZE,
  579. .bDescriptorType = USB_DT_ENDPOINT,
  580. .bmAttributes = USB_ENDPOINT_XFER_ISOC | USB_ENDPOINT_SYNC_ASYNC,
  581. .bInterval = 4,
  582. };
  583. /* CS AS ISO OUT Endpoint */
  584. static struct uac2_iso_endpoint_descriptor as_iso_out_desc = {
  585. .bLength = sizeof as_iso_out_desc,
  586. .bDescriptorType = USB_DT_CS_ENDPOINT,
  587. .bDescriptorSubtype = UAC_EP_GENERAL,
  588. .bmAttributes = 0,
  589. .bmControls = 0,
  590. .bLockDelayUnits = 0,
  591. .wLockDelay = 0,
  592. };
  593. /* Audio Streaming IN Interface - Alt0 */
  594. static struct usb_interface_descriptor std_as_in_if0_desc = {
  595. .bLength = sizeof std_as_in_if0_desc,
  596. .bDescriptorType = USB_DT_INTERFACE,
  597. .bAlternateSetting = 0,
  598. .bNumEndpoints = 0,
  599. .bInterfaceClass = USB_CLASS_AUDIO,
  600. .bInterfaceSubClass = USB_SUBCLASS_AUDIOSTREAMING,
  601. .bInterfaceProtocol = UAC_VERSION_2,
  602. };
  603. /* Audio Streaming IN Interface - Alt1 */
  604. static struct usb_interface_descriptor std_as_in_if1_desc = {
  605. .bLength = sizeof std_as_in_if1_desc,
  606. .bDescriptorType = USB_DT_INTERFACE,
  607. .bAlternateSetting = 1,
  608. .bNumEndpoints = 1,
  609. .bInterfaceClass = USB_CLASS_AUDIO,
  610. .bInterfaceSubClass = USB_SUBCLASS_AUDIOSTREAMING,
  611. .bInterfaceProtocol = UAC_VERSION_2,
  612. };
  613. /* Audio Stream IN Intface Desc */
  614. struct uac2_as_header_descriptor as_in_hdr_desc = {
  615. .bLength = sizeof as_in_hdr_desc,
  616. .bDescriptorType = USB_DT_CS_INTERFACE,
  617. .bDescriptorSubtype = UAC_AS_GENERAL,
  618. .bTerminalLink = USB_IN_OT_ID,
  619. .bmControls = 0,
  620. .bFormatType = UAC_FORMAT_TYPE_I,
  621. .bmFormats = cpu_to_le32(UAC_FORMAT_TYPE_I_PCM),
  622. .iChannelNames = 0,
  623. };
  624. /* Audio USB_IN Format */
  625. struct uac2_format_type_i_descriptor as_in_fmt1_desc = {
  626. .bLength = sizeof as_in_fmt1_desc,
  627. .bDescriptorType = USB_DT_CS_INTERFACE,
  628. .bDescriptorSubtype = UAC_FORMAT_TYPE,
  629. .bFormatType = UAC_FORMAT_TYPE_I,
  630. };
  631. /* STD AS ISO IN Endpoint */
  632. struct usb_endpoint_descriptor fs_epin_desc = {
  633. .bLength = USB_DT_ENDPOINT_SIZE,
  634. .bDescriptorType = USB_DT_ENDPOINT,
  635. .bEndpointAddress = USB_DIR_IN,
  636. .bmAttributes = USB_ENDPOINT_XFER_ISOC | USB_ENDPOINT_SYNC_ASYNC,
  637. .bInterval = 1,
  638. };
  639. struct usb_endpoint_descriptor hs_epin_desc = {
  640. .bLength = USB_DT_ENDPOINT_SIZE,
  641. .bDescriptorType = USB_DT_ENDPOINT,
  642. .bmAttributes = USB_ENDPOINT_XFER_ISOC | USB_ENDPOINT_SYNC_ASYNC,
  643. .bInterval = 4,
  644. };
  645. /* CS AS ISO IN Endpoint */
  646. static struct uac2_iso_endpoint_descriptor as_iso_in_desc = {
  647. .bLength = sizeof as_iso_in_desc,
  648. .bDescriptorType = USB_DT_CS_ENDPOINT,
  649. .bDescriptorSubtype = UAC_EP_GENERAL,
  650. .bmAttributes = 0,
  651. .bmControls = 0,
  652. .bLockDelayUnits = 0,
  653. .wLockDelay = 0,
  654. };
  655. static struct usb_descriptor_header *fs_audio_desc[] = {
  656. (struct usb_descriptor_header *)&iad_desc,
  657. (struct usb_descriptor_header *)&std_ac_if_desc,
  658. (struct usb_descriptor_header *)&ac_hdr_desc,
  659. (struct usb_descriptor_header *)&in_clk_src_desc,
  660. (struct usb_descriptor_header *)&out_clk_src_desc,
  661. (struct usb_descriptor_header *)&usb_out_it_desc,
  662. (struct usb_descriptor_header *)&io_in_it_desc,
  663. (struct usb_descriptor_header *)&usb_in_ot_desc,
  664. (struct usb_descriptor_header *)&io_out_ot_desc,
  665. (struct usb_descriptor_header *)&std_as_out_if0_desc,
  666. (struct usb_descriptor_header *)&std_as_out_if1_desc,
  667. (struct usb_descriptor_header *)&as_out_hdr_desc,
  668. (struct usb_descriptor_header *)&as_out_fmt1_desc,
  669. (struct usb_descriptor_header *)&fs_epout_desc,
  670. (struct usb_descriptor_header *)&as_iso_out_desc,
  671. (struct usb_descriptor_header *)&std_as_in_if0_desc,
  672. (struct usb_descriptor_header *)&std_as_in_if1_desc,
  673. (struct usb_descriptor_header *)&as_in_hdr_desc,
  674. (struct usb_descriptor_header *)&as_in_fmt1_desc,
  675. (struct usb_descriptor_header *)&fs_epin_desc,
  676. (struct usb_descriptor_header *)&as_iso_in_desc,
  677. NULL,
  678. };
  679. static struct usb_descriptor_header *hs_audio_desc[] = {
  680. (struct usb_descriptor_header *)&iad_desc,
  681. (struct usb_descriptor_header *)&std_ac_if_desc,
  682. (struct usb_descriptor_header *)&ac_hdr_desc,
  683. (struct usb_descriptor_header *)&in_clk_src_desc,
  684. (struct usb_descriptor_header *)&out_clk_src_desc,
  685. (struct usb_descriptor_header *)&usb_out_it_desc,
  686. (struct usb_descriptor_header *)&io_in_it_desc,
  687. (struct usb_descriptor_header *)&usb_in_ot_desc,
  688. (struct usb_descriptor_header *)&io_out_ot_desc,
  689. (struct usb_descriptor_header *)&std_as_out_if0_desc,
  690. (struct usb_descriptor_header *)&std_as_out_if1_desc,
  691. (struct usb_descriptor_header *)&as_out_hdr_desc,
  692. (struct usb_descriptor_header *)&as_out_fmt1_desc,
  693. (struct usb_descriptor_header *)&hs_epout_desc,
  694. (struct usb_descriptor_header *)&as_iso_out_desc,
  695. (struct usb_descriptor_header *)&std_as_in_if0_desc,
  696. (struct usb_descriptor_header *)&std_as_in_if1_desc,
  697. (struct usb_descriptor_header *)&as_in_hdr_desc,
  698. (struct usb_descriptor_header *)&as_in_fmt1_desc,
  699. (struct usb_descriptor_header *)&hs_epin_desc,
  700. (struct usb_descriptor_header *)&as_iso_in_desc,
  701. NULL,
  702. };
  703. struct cntrl_cur_lay3 {
  704. __u32 dCUR;
  705. };
  706. struct cntrl_range_lay3 {
  707. __u16 wNumSubRanges;
  708. __u32 dMIN;
  709. __u32 dMAX;
  710. __u32 dRES;
  711. } __packed;
  712. static inline void
  713. free_ep(struct uac2_rtd_params *prm, struct usb_ep *ep)
  714. {
  715. struct snd_uac2_chip *uac2 = prm->uac2;
  716. int i;
  717. prm->ep_enabled = false;
  718. for (i = 0; i < USB_XFERS; i++) {
  719. if (prm->ureq[i].req) {
  720. usb_ep_dequeue(ep, prm->ureq[i].req);
  721. usb_ep_free_request(ep, prm->ureq[i].req);
  722. prm->ureq[i].req = NULL;
  723. }
  724. }
  725. if (usb_ep_disable(ep))
  726. dev_err(&uac2->pdev.dev,
  727. "%s:%d Error!\n", __func__, __LINE__);
  728. }
  729. static int __init
  730. afunc_bind(struct usb_configuration *cfg, struct usb_function *fn)
  731. {
  732. struct audio_dev *agdev = func_to_agdev(fn);
  733. struct snd_uac2_chip *uac2 = &agdev->uac2;
  734. struct usb_composite_dev *cdev = cfg->cdev;
  735. struct usb_gadget *gadget = cdev->gadget;
  736. struct uac2_rtd_params *prm;
  737. int ret;
  738. ret = usb_interface_id(cfg, fn);
  739. if (ret < 0) {
  740. dev_err(&uac2->pdev.dev,
  741. "%s:%d Error!\n", __func__, __LINE__);
  742. return ret;
  743. }
  744. std_ac_if_desc.bInterfaceNumber = ret;
  745. agdev->ac_intf = ret;
  746. agdev->ac_alt = 0;
  747. ret = usb_interface_id(cfg, fn);
  748. if (ret < 0) {
  749. dev_err(&uac2->pdev.dev,
  750. "%s:%d Error!\n", __func__, __LINE__);
  751. return ret;
  752. }
  753. std_as_out_if0_desc.bInterfaceNumber = ret;
  754. std_as_out_if1_desc.bInterfaceNumber = ret;
  755. agdev->as_out_intf = ret;
  756. agdev->as_out_alt = 0;
  757. ret = usb_interface_id(cfg, fn);
  758. if (ret < 0) {
  759. dev_err(&uac2->pdev.dev,
  760. "%s:%d Error!\n", __func__, __LINE__);
  761. return ret;
  762. }
  763. std_as_in_if0_desc.bInterfaceNumber = ret;
  764. std_as_in_if1_desc.bInterfaceNumber = ret;
  765. agdev->as_in_intf = ret;
  766. agdev->as_in_alt = 0;
  767. agdev->out_ep = usb_ep_autoconfig(gadget, &fs_epout_desc);
  768. if (!agdev->out_ep) {
  769. dev_err(&uac2->pdev.dev,
  770. "%s:%d Error!\n", __func__, __LINE__);
  771. goto err;
  772. }
  773. agdev->out_ep->driver_data = agdev;
  774. agdev->in_ep = usb_ep_autoconfig(gadget, &fs_epin_desc);
  775. if (!agdev->in_ep) {
  776. dev_err(&uac2->pdev.dev,
  777. "%s:%d Error!\n", __func__, __LINE__);
  778. goto err;
  779. }
  780. agdev->in_ep->driver_data = agdev;
  781. uac2->p_prm.uac2 = uac2;
  782. uac2->c_prm.uac2 = uac2;
  783. hs_epout_desc.bEndpointAddress = fs_epout_desc.bEndpointAddress;
  784. hs_epout_desc.wMaxPacketSize = fs_epout_desc.wMaxPacketSize;
  785. hs_epin_desc.bEndpointAddress = fs_epin_desc.bEndpointAddress;
  786. hs_epin_desc.wMaxPacketSize = fs_epin_desc.wMaxPacketSize;
  787. ret = usb_assign_descriptors(fn, fs_audio_desc, hs_audio_desc, NULL);
  788. if (ret)
  789. goto err;
  790. prm = &agdev->uac2.c_prm;
  791. prm->max_psize = hs_epout_desc.wMaxPacketSize;
  792. prm->rbuf = kzalloc(prm->max_psize * USB_XFERS, GFP_KERNEL);
  793. if (!prm->rbuf) {
  794. prm->max_psize = 0;
  795. goto err;
  796. }
  797. prm = &agdev->uac2.p_prm;
  798. prm->max_psize = hs_epin_desc.wMaxPacketSize;
  799. prm->rbuf = kzalloc(prm->max_psize * USB_XFERS, GFP_KERNEL);
  800. if (!prm->rbuf) {
  801. prm->max_psize = 0;
  802. goto err;
  803. }
  804. ret = alsa_uac2_init(agdev);
  805. if (ret)
  806. goto err;
  807. return 0;
  808. err:
  809. kfree(agdev->uac2.p_prm.rbuf);
  810. kfree(agdev->uac2.c_prm.rbuf);
  811. usb_free_all_descriptors(fn);
  812. if (agdev->in_ep)
  813. agdev->in_ep->driver_data = NULL;
  814. if (agdev->out_ep)
  815. agdev->out_ep->driver_data = NULL;
  816. return -EINVAL;
  817. }
  818. static void
  819. afunc_unbind(struct usb_configuration *cfg, struct usb_function *fn)
  820. {
  821. struct audio_dev *agdev = func_to_agdev(fn);
  822. struct uac2_rtd_params *prm;
  823. alsa_uac2_exit(agdev);
  824. prm = &agdev->uac2.p_prm;
  825. kfree(prm->rbuf);
  826. prm = &agdev->uac2.c_prm;
  827. kfree(prm->rbuf);
  828. usb_free_all_descriptors(fn);
  829. if (agdev->in_ep)
  830. agdev->in_ep->driver_data = NULL;
  831. if (agdev->out_ep)
  832. agdev->out_ep->driver_data = NULL;
  833. }
  834. static int
  835. afunc_set_alt(struct usb_function *fn, unsigned intf, unsigned alt)
  836. {
  837. struct usb_composite_dev *cdev = fn->config->cdev;
  838. struct audio_dev *agdev = func_to_agdev(fn);
  839. struct snd_uac2_chip *uac2 = &agdev->uac2;
  840. struct usb_gadget *gadget = cdev->gadget;
  841. struct usb_request *req;
  842. struct usb_ep *ep;
  843. struct uac2_rtd_params *prm;
  844. int i;
  845. /* No i/f has more than 2 alt settings */
  846. if (alt > 1) {
  847. dev_err(&uac2->pdev.dev,
  848. "%s:%d Error!\n", __func__, __LINE__);
  849. return -EINVAL;
  850. }
  851. if (intf == agdev->ac_intf) {
  852. /* Control I/f has only 1 AltSetting - 0 */
  853. if (alt) {
  854. dev_err(&uac2->pdev.dev,
  855. "%s:%d Error!\n", __func__, __LINE__);
  856. return -EINVAL;
  857. }
  858. return 0;
  859. }
  860. if (intf == agdev->as_out_intf) {
  861. ep = agdev->out_ep;
  862. prm = &uac2->c_prm;
  863. config_ep_by_speed(gadget, fn, ep);
  864. agdev->as_out_alt = alt;
  865. } else if (intf == agdev->as_in_intf) {
  866. ep = agdev->in_ep;
  867. prm = &uac2->p_prm;
  868. config_ep_by_speed(gadget, fn, ep);
  869. agdev->as_in_alt = alt;
  870. } else {
  871. dev_err(&uac2->pdev.dev,
  872. "%s:%d Error!\n", __func__, __LINE__);
  873. return -EINVAL;
  874. }
  875. if (alt == 0) {
  876. free_ep(prm, ep);
  877. return 0;
  878. }
  879. prm->ep_enabled = true;
  880. usb_ep_enable(ep);
  881. for (i = 0; i < USB_XFERS; i++) {
  882. if (prm->ureq[i].req) {
  883. if (usb_ep_queue(ep, prm->ureq[i].req, GFP_ATOMIC))
  884. dev_err(&uac2->pdev.dev, "%d Error!\n",
  885. __LINE__);
  886. continue;
  887. }
  888. req = usb_ep_alloc_request(ep, GFP_ATOMIC);
  889. if (req == NULL) {
  890. dev_err(&uac2->pdev.dev,
  891. "%s:%d Error!\n", __func__, __LINE__);
  892. return -EINVAL;
  893. }
  894. prm->ureq[i].req = req;
  895. prm->ureq[i].pp = prm;
  896. req->zero = 0;
  897. req->context = &prm->ureq[i];
  898. req->length = prm->max_psize;
  899. req->complete = agdev_iso_complete;
  900. req->buf = prm->rbuf + i * req->length;
  901. if (usb_ep_queue(ep, req, GFP_ATOMIC))
  902. dev_err(&uac2->pdev.dev, "%d Error!\n", __LINE__);
  903. }
  904. return 0;
  905. }
  906. static int
  907. afunc_get_alt(struct usb_function *fn, unsigned intf)
  908. {
  909. struct audio_dev *agdev = func_to_agdev(fn);
  910. struct snd_uac2_chip *uac2 = &agdev->uac2;
  911. if (intf == agdev->ac_intf)
  912. return agdev->ac_alt;
  913. else if (intf == agdev->as_out_intf)
  914. return agdev->as_out_alt;
  915. else if (intf == agdev->as_in_intf)
  916. return agdev->as_in_alt;
  917. else
  918. dev_err(&uac2->pdev.dev,
  919. "%s:%d Invalid Interface %d!\n",
  920. __func__, __LINE__, intf);
  921. return -EINVAL;
  922. }
  923. static void
  924. afunc_disable(struct usb_function *fn)
  925. {
  926. struct audio_dev *agdev = func_to_agdev(fn);
  927. struct snd_uac2_chip *uac2 = &agdev->uac2;
  928. free_ep(&uac2->p_prm, agdev->in_ep);
  929. agdev->as_in_alt = 0;
  930. free_ep(&uac2->c_prm, agdev->out_ep);
  931. agdev->as_out_alt = 0;
  932. }
  933. static int
  934. in_rq_cur(struct usb_function *fn, const struct usb_ctrlrequest *cr)
  935. {
  936. struct usb_request *req = fn->config->cdev->req;
  937. struct audio_dev *agdev = func_to_agdev(fn);
  938. struct snd_uac2_chip *uac2 = &agdev->uac2;
  939. u16 w_length = le16_to_cpu(cr->wLength);
  940. u16 w_index = le16_to_cpu(cr->wIndex);
  941. u16 w_value = le16_to_cpu(cr->wValue);
  942. u8 entity_id = (w_index >> 8) & 0xff;
  943. u8 control_selector = w_value >> 8;
  944. int value = -EOPNOTSUPP;
  945. if (control_selector == UAC2_CS_CONTROL_SAM_FREQ) {
  946. struct cntrl_cur_lay3 c;
  947. if (entity_id == USB_IN_CLK_ID)
  948. c.dCUR = p_srate;
  949. else if (entity_id == USB_OUT_CLK_ID)
  950. c.dCUR = c_srate;
  951. value = min_t(unsigned, w_length, sizeof c);
  952. memcpy(req->buf, &c, value);
  953. } else if (control_selector == UAC2_CS_CONTROL_CLOCK_VALID) {
  954. *(u8 *)req->buf = 1;
  955. value = min_t(unsigned, w_length, 1);
  956. } else {
  957. dev_err(&uac2->pdev.dev,
  958. "%s:%d control_selector=%d TODO!\n",
  959. __func__, __LINE__, control_selector);
  960. }
  961. return value;
  962. }
  963. static int
  964. in_rq_range(struct usb_function *fn, const struct usb_ctrlrequest *cr)
  965. {
  966. struct usb_request *req = fn->config->cdev->req;
  967. struct audio_dev *agdev = func_to_agdev(fn);
  968. struct snd_uac2_chip *uac2 = &agdev->uac2;
  969. u16 w_length = le16_to_cpu(cr->wLength);
  970. u16 w_index = le16_to_cpu(cr->wIndex);
  971. u16 w_value = le16_to_cpu(cr->wValue);
  972. u8 entity_id = (w_index >> 8) & 0xff;
  973. u8 control_selector = w_value >> 8;
  974. struct cntrl_range_lay3 r;
  975. int value = -EOPNOTSUPP;
  976. if (control_selector == UAC2_CS_CONTROL_SAM_FREQ) {
  977. if (entity_id == USB_IN_CLK_ID)
  978. r.dMIN = p_srate;
  979. else if (entity_id == USB_OUT_CLK_ID)
  980. r.dMIN = c_srate;
  981. else
  982. return -EOPNOTSUPP;
  983. r.dMAX = r.dMIN;
  984. r.dRES = 0;
  985. r.wNumSubRanges = 1;
  986. value = min_t(unsigned, w_length, sizeof r);
  987. memcpy(req->buf, &r, value);
  988. } else {
  989. dev_err(&uac2->pdev.dev,
  990. "%s:%d control_selector=%d TODO!\n",
  991. __func__, __LINE__, control_selector);
  992. }
  993. return value;
  994. }
  995. static int
  996. ac_rq_in(struct usb_function *fn, const struct usb_ctrlrequest *cr)
  997. {
  998. if (cr->bRequest == UAC2_CS_CUR)
  999. return in_rq_cur(fn, cr);
  1000. else if (cr->bRequest == UAC2_CS_RANGE)
  1001. return in_rq_range(fn, cr);
  1002. else
  1003. return -EOPNOTSUPP;
  1004. }
  1005. static int
  1006. out_rq_cur(struct usb_function *fn, const struct usb_ctrlrequest *cr)
  1007. {
  1008. u16 w_length = le16_to_cpu(cr->wLength);
  1009. u16 w_value = le16_to_cpu(cr->wValue);
  1010. u8 control_selector = w_value >> 8;
  1011. if (control_selector == UAC2_CS_CONTROL_SAM_FREQ)
  1012. return w_length;
  1013. return -EOPNOTSUPP;
  1014. }
  1015. static int
  1016. setup_rq_inf(struct usb_function *fn, const struct usb_ctrlrequest *cr)
  1017. {
  1018. struct audio_dev *agdev = func_to_agdev(fn);
  1019. struct snd_uac2_chip *uac2 = &agdev->uac2;
  1020. u16 w_index = le16_to_cpu(cr->wIndex);
  1021. u8 intf = w_index & 0xff;
  1022. if (intf != agdev->ac_intf) {
  1023. dev_err(&uac2->pdev.dev,
  1024. "%s:%d Error!\n", __func__, __LINE__);
  1025. return -EOPNOTSUPP;
  1026. }
  1027. if (cr->bRequestType & USB_DIR_IN)
  1028. return ac_rq_in(fn, cr);
  1029. else if (cr->bRequest == UAC2_CS_CUR)
  1030. return out_rq_cur(fn, cr);
  1031. return -EOPNOTSUPP;
  1032. }
  1033. static int
  1034. afunc_setup(struct usb_function *fn, const struct usb_ctrlrequest *cr)
  1035. {
  1036. struct usb_composite_dev *cdev = fn->config->cdev;
  1037. struct audio_dev *agdev = func_to_agdev(fn);
  1038. struct snd_uac2_chip *uac2 = &agdev->uac2;
  1039. struct usb_request *req = cdev->req;
  1040. u16 w_length = le16_to_cpu(cr->wLength);
  1041. int value = -EOPNOTSUPP;
  1042. /* Only Class specific requests are supposed to reach here */
  1043. if ((cr->bRequestType & USB_TYPE_MASK) != USB_TYPE_CLASS)
  1044. return -EOPNOTSUPP;
  1045. if ((cr->bRequestType & USB_RECIP_MASK) == USB_RECIP_INTERFACE)
  1046. value = setup_rq_inf(fn, cr);
  1047. else
  1048. dev_err(&uac2->pdev.dev, "%s:%d Error!\n", __func__, __LINE__);
  1049. if (value >= 0) {
  1050. req->length = value;
  1051. req->zero = value < w_length;
  1052. value = usb_ep_queue(cdev->gadget->ep0, req, GFP_ATOMIC);
  1053. if (value < 0) {
  1054. dev_err(&uac2->pdev.dev,
  1055. "%s:%d Error!\n", __func__, __LINE__);
  1056. req->status = 0;
  1057. }
  1058. }
  1059. return value;
  1060. }
  1061. static int audio_bind_config(struct usb_configuration *cfg)
  1062. {
  1063. int res;
  1064. agdev_g = kzalloc(sizeof *agdev_g, GFP_KERNEL);
  1065. if (agdev_g == NULL)
  1066. return -ENOMEM;
  1067. res = usb_string_ids_tab(cfg->cdev, strings_fn);
  1068. if (res)
  1069. return res;
  1070. iad_desc.iFunction = strings_fn[STR_ASSOC].id;
  1071. std_ac_if_desc.iInterface = strings_fn[STR_IF_CTRL].id;
  1072. in_clk_src_desc.iClockSource = strings_fn[STR_CLKSRC_IN].id;
  1073. out_clk_src_desc.iClockSource = strings_fn[STR_CLKSRC_OUT].id;
  1074. usb_out_it_desc.iTerminal = strings_fn[STR_USB_IT].id;
  1075. io_in_it_desc.iTerminal = strings_fn[STR_IO_IT].id;
  1076. usb_in_ot_desc.iTerminal = strings_fn[STR_USB_OT].id;
  1077. io_out_ot_desc.iTerminal = strings_fn[STR_IO_OT].id;
  1078. std_as_out_if0_desc.iInterface = strings_fn[STR_AS_OUT_ALT0].id;
  1079. std_as_out_if1_desc.iInterface = strings_fn[STR_AS_OUT_ALT1].id;
  1080. std_as_in_if0_desc.iInterface = strings_fn[STR_AS_IN_ALT0].id;
  1081. std_as_in_if1_desc.iInterface = strings_fn[STR_AS_IN_ALT1].id;
  1082. agdev_g->func.name = "uac2_func";
  1083. agdev_g->func.strings = fn_strings;
  1084. agdev_g->func.bind = afunc_bind;
  1085. agdev_g->func.unbind = afunc_unbind;
  1086. agdev_g->func.set_alt = afunc_set_alt;
  1087. agdev_g->func.get_alt = afunc_get_alt;
  1088. agdev_g->func.disable = afunc_disable;
  1089. agdev_g->func.setup = afunc_setup;
  1090. /* Initialize the configurable parameters */
  1091. usb_out_it_desc.bNrChannels = num_channels(c_chmask);
  1092. usb_out_it_desc.bmChannelConfig = cpu_to_le32(c_chmask);
  1093. io_in_it_desc.bNrChannels = num_channels(p_chmask);
  1094. io_in_it_desc.bmChannelConfig = cpu_to_le32(p_chmask);
  1095. as_out_hdr_desc.bNrChannels = num_channels(c_chmask);
  1096. as_out_hdr_desc.bmChannelConfig = cpu_to_le32(c_chmask);
  1097. as_in_hdr_desc.bNrChannels = num_channels(p_chmask);
  1098. as_in_hdr_desc.bmChannelConfig = cpu_to_le32(p_chmask);
  1099. as_out_fmt1_desc.bSubslotSize = c_ssize;
  1100. as_out_fmt1_desc.bBitResolution = c_ssize * 8;
  1101. as_in_fmt1_desc.bSubslotSize = p_ssize;
  1102. as_in_fmt1_desc.bBitResolution = p_ssize * 8;
  1103. snprintf(clksrc_in, sizeof(clksrc_in), "%uHz", p_srate);
  1104. snprintf(clksrc_out, sizeof(clksrc_out), "%uHz", c_srate);
  1105. res = usb_add_function(cfg, &agdev_g->func);
  1106. if (res < 0)
  1107. kfree(agdev_g);
  1108. return res;
  1109. }
  1110. static void
  1111. uac2_unbind_config(struct usb_configuration *cfg)
  1112. {
  1113. kfree(agdev_g);
  1114. agdev_g = NULL;
  1115. }