15fd54aceSGreg Kroah-Hartman // SPDX-License-Identifier: GPL-2.0+ 2eb9fecb9SRuslan Bilovol /* 3eb9fecb9SRuslan Bilovol * u_audio.c -- interface to USB gadget "ALSA sound card" utilities 4eb9fecb9SRuslan Bilovol * 5eb9fecb9SRuslan Bilovol * Copyright (C) 2016 6eb9fecb9SRuslan Bilovol * Author: Ruslan Bilovol <ruslan.bilovol@gmail.com> 7eb9fecb9SRuslan Bilovol * 8eb9fecb9SRuslan Bilovol * Sound card implementation was cut-and-pasted with changes 9eb9fecb9SRuslan Bilovol * from f_uac2.c and has: 10eb9fecb9SRuslan Bilovol * Copyright (C) 2011 11eb9fecb9SRuslan Bilovol * Yadwinder Singh (yadi.brar01@gmail.com) 12eb9fecb9SRuslan Bilovol * Jaswinder Singh (jaswinder.singh@linaro.org) 13eb9fecb9SRuslan Bilovol */ 14eb9fecb9SRuslan Bilovol 15eb9fecb9SRuslan Bilovol #include <linux/module.h> 16eb9fecb9SRuslan Bilovol #include <sound/core.h> 17eb9fecb9SRuslan Bilovol #include <sound/pcm.h> 18eb9fecb9SRuslan Bilovol #include <sound/pcm_params.h> 19eb9fecb9SRuslan Bilovol 20eb9fecb9SRuslan Bilovol #include "u_audio.h" 21eb9fecb9SRuslan Bilovol 22eb9fecb9SRuslan Bilovol #define BUFF_SIZE_MAX (PAGE_SIZE * 16) 23eb9fecb9SRuslan Bilovol #define PRD_SIZE_MAX PAGE_SIZE 24eb9fecb9SRuslan Bilovol #define MIN_PERIODS 4 25eb9fecb9SRuslan Bilovol 26eb9fecb9SRuslan Bilovol /* Runtime data params for one stream */ 27eb9fecb9SRuslan Bilovol struct uac_rtd_params { 28eb9fecb9SRuslan Bilovol struct snd_uac_chip *uac; /* parent chip */ 29eb9fecb9SRuslan Bilovol bool ep_enabled; /* if the ep is enabled */ 30eb9fecb9SRuslan Bilovol 31eb9fecb9SRuslan Bilovol struct snd_pcm_substream *ss; 32eb9fecb9SRuslan Bilovol 33eb9fecb9SRuslan Bilovol /* Ring buffer */ 34eb9fecb9SRuslan Bilovol ssize_t hw_ptr; 35eb9fecb9SRuslan Bilovol 36eb9fecb9SRuslan Bilovol void *rbuf; 37eb9fecb9SRuslan Bilovol 38f4408a98SJonas Stenvall unsigned int max_psize; /* MaxPacketSize of endpoint */ 39eb9fecb9SRuslan Bilovol 40d70f7598SJerome Brunet struct usb_request **reqs; 41eb9fecb9SRuslan Bilovol }; 42eb9fecb9SRuslan Bilovol 43eb9fecb9SRuslan Bilovol struct snd_uac_chip { 44eb9fecb9SRuslan Bilovol struct g_audio *audio_dev; 45eb9fecb9SRuslan Bilovol 46eb9fecb9SRuslan Bilovol struct uac_rtd_params p_prm; 47eb9fecb9SRuslan Bilovol struct uac_rtd_params c_prm; 48eb9fecb9SRuslan Bilovol 49eb9fecb9SRuslan Bilovol struct snd_card *card; 50eb9fecb9SRuslan Bilovol struct snd_pcm *pcm; 51eb9fecb9SRuslan Bilovol 52eb9fecb9SRuslan Bilovol /* timekeeping for the playback endpoint */ 53eb9fecb9SRuslan Bilovol unsigned int p_interval; 54eb9fecb9SRuslan Bilovol unsigned int p_residue; 55eb9fecb9SRuslan Bilovol 56eb9fecb9SRuslan Bilovol /* pre-calculated values for playback iso completion */ 57eb9fecb9SRuslan Bilovol unsigned int p_pktsize; 58eb9fecb9SRuslan Bilovol unsigned int p_pktsize_residue; 59eb9fecb9SRuslan Bilovol unsigned int p_framesize; 60eb9fecb9SRuslan Bilovol }; 61eb9fecb9SRuslan Bilovol 622ab3c34cSBhumika Goyal static const struct snd_pcm_hardware uac_pcm_hardware = { 63eb9fecb9SRuslan Bilovol .info = SNDRV_PCM_INFO_INTERLEAVED | SNDRV_PCM_INFO_BLOCK_TRANSFER 64eb9fecb9SRuslan Bilovol | SNDRV_PCM_INFO_MMAP | SNDRV_PCM_INFO_MMAP_VALID 65eb9fecb9SRuslan Bilovol | SNDRV_PCM_INFO_PAUSE | SNDRV_PCM_INFO_RESUME, 66eb9fecb9SRuslan Bilovol .rates = SNDRV_PCM_RATE_CONTINUOUS, 67eb9fecb9SRuslan Bilovol .periods_max = BUFF_SIZE_MAX / PRD_SIZE_MAX, 68eb9fecb9SRuslan Bilovol .buffer_bytes_max = BUFF_SIZE_MAX, 69eb9fecb9SRuslan Bilovol .period_bytes_max = PRD_SIZE_MAX, 70eb9fecb9SRuslan Bilovol .periods_min = MIN_PERIODS, 71eb9fecb9SRuslan Bilovol }; 72eb9fecb9SRuslan Bilovol 73eb9fecb9SRuslan Bilovol static void u_audio_iso_complete(struct usb_ep *ep, struct usb_request *req) 74eb9fecb9SRuslan Bilovol { 75f4408a98SJonas Stenvall unsigned int pending; 76eb9fecb9SRuslan Bilovol unsigned int hw_ptr; 77eb9fecb9SRuslan Bilovol int status = req->status; 78eb9fecb9SRuslan Bilovol struct snd_pcm_substream *substream; 7996afb54eSVladimir Zapolskiy struct snd_pcm_runtime *runtime; 8029865117SJerome Brunet struct uac_rtd_params *prm = req->context; 81eb9fecb9SRuslan Bilovol struct snd_uac_chip *uac = prm->uac; 82eb9fecb9SRuslan Bilovol 83eb9fecb9SRuslan Bilovol /* i/f shutting down */ 847de8681bSJack Pham if (!prm->ep_enabled) { 857de8681bSJack Pham usb_ep_free_request(ep, req); 867de8681bSJack Pham return; 877de8681bSJack Pham } 887de8681bSJack Pham 897de8681bSJack Pham if (req->status == -ESHUTDOWN) 90eb9fecb9SRuslan Bilovol return; 91eb9fecb9SRuslan Bilovol 92eb9fecb9SRuslan Bilovol /* 93eb9fecb9SRuslan Bilovol * We can't really do much about bad xfers. 94eb9fecb9SRuslan Bilovol * Afterall, the ISOCH xfers could fail legitimately. 95eb9fecb9SRuslan Bilovol */ 96eb9fecb9SRuslan Bilovol if (status) 97eb9fecb9SRuslan Bilovol pr_debug("%s: iso_complete status(%d) %d/%d\n", 98eb9fecb9SRuslan Bilovol __func__, status, req->actual, req->length); 99eb9fecb9SRuslan Bilovol 100eb9fecb9SRuslan Bilovol substream = prm->ss; 101eb9fecb9SRuslan Bilovol 102eb9fecb9SRuslan Bilovol /* Do nothing if ALSA isn't active */ 103eb9fecb9SRuslan Bilovol if (!substream) 104eb9fecb9SRuslan Bilovol goto exit; 105eb9fecb9SRuslan Bilovol 106d70f7598SJerome Brunet snd_pcm_stream_lock(substream); 10756bc6158SVladimir Zapolskiy 10896afb54eSVladimir Zapolskiy runtime = substream->runtime; 10956bc6158SVladimir Zapolskiy if (!runtime || !snd_pcm_running(substream)) { 110d70f7598SJerome Brunet snd_pcm_stream_unlock(substream); 11156bc6158SVladimir Zapolskiy goto exit; 11256bc6158SVladimir Zapolskiy } 11356bc6158SVladimir Zapolskiy 114eb9fecb9SRuslan Bilovol if (substream->stream == SNDRV_PCM_STREAM_PLAYBACK) { 115eb9fecb9SRuslan Bilovol /* 116eb9fecb9SRuslan Bilovol * For each IN packet, take the quotient of the current data 117eb9fecb9SRuslan Bilovol * rate and the endpoint's interval as the base packet size. 118eb9fecb9SRuslan Bilovol * If there is a residue from this division, add it to the 119eb9fecb9SRuslan Bilovol * residue accumulator. 120eb9fecb9SRuslan Bilovol */ 121eb9fecb9SRuslan Bilovol req->length = uac->p_pktsize; 122eb9fecb9SRuslan Bilovol uac->p_residue += uac->p_pktsize_residue; 123eb9fecb9SRuslan Bilovol 124eb9fecb9SRuslan Bilovol /* 125eb9fecb9SRuslan Bilovol * Whenever there are more bytes in the accumulator than we 126eb9fecb9SRuslan Bilovol * need to add one more sample frame, increase this packet's 127eb9fecb9SRuslan Bilovol * size and decrease the accumulator. 128eb9fecb9SRuslan Bilovol */ 129eb9fecb9SRuslan Bilovol if (uac->p_residue / uac->p_interval >= uac->p_framesize) { 130eb9fecb9SRuslan Bilovol req->length += uac->p_framesize; 131eb9fecb9SRuslan Bilovol uac->p_residue -= uac->p_framesize * 132eb9fecb9SRuslan Bilovol uac->p_interval; 133eb9fecb9SRuslan Bilovol } 134eb9fecb9SRuslan Bilovol 135eb9fecb9SRuslan Bilovol req->actual = req->length; 136eb9fecb9SRuslan Bilovol } 137eb9fecb9SRuslan Bilovol 138eb9fecb9SRuslan Bilovol hw_ptr = prm->hw_ptr; 139eb9fecb9SRuslan Bilovol 140eb9fecb9SRuslan Bilovol /* Pack USB load in ALSA ring buffer */ 14196afb54eSVladimir Zapolskiy pending = runtime->dma_bytes - hw_ptr; 142eb9fecb9SRuslan Bilovol 143eb9fecb9SRuslan Bilovol if (substream->stream == SNDRV_PCM_STREAM_PLAYBACK) { 144eb9fecb9SRuslan Bilovol if (unlikely(pending < req->actual)) { 14596afb54eSVladimir Zapolskiy memcpy(req->buf, runtime->dma_area + hw_ptr, pending); 14696afb54eSVladimir Zapolskiy memcpy(req->buf + pending, runtime->dma_area, 147eb9fecb9SRuslan Bilovol req->actual - pending); 148eb9fecb9SRuslan Bilovol } else { 14996afb54eSVladimir Zapolskiy memcpy(req->buf, runtime->dma_area + hw_ptr, 15096afb54eSVladimir Zapolskiy req->actual); 151eb9fecb9SRuslan Bilovol } 152eb9fecb9SRuslan Bilovol } else { 153eb9fecb9SRuslan Bilovol if (unlikely(pending < req->actual)) { 15496afb54eSVladimir Zapolskiy memcpy(runtime->dma_area + hw_ptr, req->buf, pending); 15596afb54eSVladimir Zapolskiy memcpy(runtime->dma_area, req->buf + pending, 156eb9fecb9SRuslan Bilovol req->actual - pending); 157eb9fecb9SRuslan Bilovol } else { 15896afb54eSVladimir Zapolskiy memcpy(runtime->dma_area + hw_ptr, req->buf, 15996afb54eSVladimir Zapolskiy req->actual); 160eb9fecb9SRuslan Bilovol } 161eb9fecb9SRuslan Bilovol } 162eb9fecb9SRuslan Bilovol 1636b37bd78SJoshua Frkuska /* update hw_ptr after data is copied to memory */ 16496afb54eSVladimir Zapolskiy prm->hw_ptr = (hw_ptr + req->actual) % runtime->dma_bytes; 165773e53d5SVladimir Zapolskiy hw_ptr = prm->hw_ptr; 166d70f7598SJerome Brunet snd_pcm_stream_unlock(substream); 1676b37bd78SJoshua Frkuska 168773e53d5SVladimir Zapolskiy if ((hw_ptr % snd_pcm_lib_period_bytes(substream)) < req->actual) 169773e53d5SVladimir Zapolskiy snd_pcm_period_elapsed(substream); 170773e53d5SVladimir Zapolskiy 171eb9fecb9SRuslan Bilovol exit: 172eb9fecb9SRuslan Bilovol if (usb_ep_queue(ep, req, GFP_ATOMIC)) 173eb9fecb9SRuslan Bilovol dev_err(uac->card->dev, "%d Error!\n", __LINE__); 174eb9fecb9SRuslan Bilovol } 175eb9fecb9SRuslan Bilovol 176eb9fecb9SRuslan Bilovol static int uac_pcm_trigger(struct snd_pcm_substream *substream, int cmd) 177eb9fecb9SRuslan Bilovol { 178eb9fecb9SRuslan Bilovol struct snd_uac_chip *uac = snd_pcm_substream_chip(substream); 179eb9fecb9SRuslan Bilovol struct uac_rtd_params *prm; 180eb9fecb9SRuslan Bilovol struct g_audio *audio_dev; 181eb9fecb9SRuslan Bilovol struct uac_params *params; 182eb9fecb9SRuslan Bilovol int err = 0; 183eb9fecb9SRuslan Bilovol 184eb9fecb9SRuslan Bilovol audio_dev = uac->audio_dev; 185eb9fecb9SRuslan Bilovol params = &audio_dev->params; 186eb9fecb9SRuslan Bilovol 187eb9fecb9SRuslan Bilovol if (substream->stream == SNDRV_PCM_STREAM_PLAYBACK) 188eb9fecb9SRuslan Bilovol prm = &uac->p_prm; 189eb9fecb9SRuslan Bilovol else 190eb9fecb9SRuslan Bilovol prm = &uac->c_prm; 191eb9fecb9SRuslan Bilovol 192eb9fecb9SRuslan Bilovol /* Reset */ 193eb9fecb9SRuslan Bilovol prm->hw_ptr = 0; 194eb9fecb9SRuslan Bilovol 195eb9fecb9SRuslan Bilovol switch (cmd) { 196eb9fecb9SRuslan Bilovol case SNDRV_PCM_TRIGGER_START: 197eb9fecb9SRuslan Bilovol case SNDRV_PCM_TRIGGER_RESUME: 198eb9fecb9SRuslan Bilovol prm->ss = substream; 199eb9fecb9SRuslan Bilovol break; 200eb9fecb9SRuslan Bilovol case SNDRV_PCM_TRIGGER_STOP: 201eb9fecb9SRuslan Bilovol case SNDRV_PCM_TRIGGER_SUSPEND: 202eb9fecb9SRuslan Bilovol prm->ss = NULL; 203eb9fecb9SRuslan Bilovol break; 204eb9fecb9SRuslan Bilovol default: 205eb9fecb9SRuslan Bilovol err = -EINVAL; 206eb9fecb9SRuslan Bilovol } 207eb9fecb9SRuslan Bilovol 208eb9fecb9SRuslan Bilovol /* Clear buffer after Play stops */ 209eb9fecb9SRuslan Bilovol if (substream->stream == SNDRV_PCM_STREAM_PLAYBACK && !prm->ss) 210eb9fecb9SRuslan Bilovol memset(prm->rbuf, 0, prm->max_psize * params->req_number); 211eb9fecb9SRuslan Bilovol 212eb9fecb9SRuslan Bilovol return err; 213eb9fecb9SRuslan Bilovol } 214eb9fecb9SRuslan Bilovol 215eb9fecb9SRuslan Bilovol static snd_pcm_uframes_t uac_pcm_pointer(struct snd_pcm_substream *substream) 216eb9fecb9SRuslan Bilovol { 217eb9fecb9SRuslan Bilovol struct snd_uac_chip *uac = snd_pcm_substream_chip(substream); 218eb9fecb9SRuslan Bilovol struct uac_rtd_params *prm; 219eb9fecb9SRuslan Bilovol 220eb9fecb9SRuslan Bilovol if (substream->stream == SNDRV_PCM_STREAM_PLAYBACK) 221eb9fecb9SRuslan Bilovol prm = &uac->p_prm; 222eb9fecb9SRuslan Bilovol else 223eb9fecb9SRuslan Bilovol prm = &uac->c_prm; 224eb9fecb9SRuslan Bilovol 225eb9fecb9SRuslan Bilovol return bytes_to_frames(substream->runtime, prm->hw_ptr); 226eb9fecb9SRuslan Bilovol } 227eb9fecb9SRuslan Bilovol 22825dbd75dSJerome Brunet static u64 uac_ssize_to_fmt(int ssize) 22925dbd75dSJerome Brunet { 23025dbd75dSJerome Brunet u64 ret; 23125dbd75dSJerome Brunet 23225dbd75dSJerome Brunet switch (ssize) { 23325dbd75dSJerome Brunet case 3: 23425dbd75dSJerome Brunet ret = SNDRV_PCM_FMTBIT_S24_3LE; 23525dbd75dSJerome Brunet break; 23625dbd75dSJerome Brunet case 4: 23725dbd75dSJerome Brunet ret = SNDRV_PCM_FMTBIT_S32_LE; 23825dbd75dSJerome Brunet break; 23925dbd75dSJerome Brunet default: 24025dbd75dSJerome Brunet ret = SNDRV_PCM_FMTBIT_S16_LE; 24125dbd75dSJerome Brunet break; 24225dbd75dSJerome Brunet } 24325dbd75dSJerome Brunet 24425dbd75dSJerome Brunet return ret; 24525dbd75dSJerome Brunet } 24625dbd75dSJerome Brunet 247eb9fecb9SRuslan Bilovol static int uac_pcm_open(struct snd_pcm_substream *substream) 248eb9fecb9SRuslan Bilovol { 249eb9fecb9SRuslan Bilovol struct snd_uac_chip *uac = snd_pcm_substream_chip(substream); 250eb9fecb9SRuslan Bilovol struct snd_pcm_runtime *runtime = substream->runtime; 251eb9fecb9SRuslan Bilovol struct g_audio *audio_dev; 252eb9fecb9SRuslan Bilovol struct uac_params *params; 253eb9fecb9SRuslan Bilovol int p_ssize, c_ssize; 254eb9fecb9SRuslan Bilovol int p_srate, c_srate; 255eb9fecb9SRuslan Bilovol int p_chmask, c_chmask; 256eb9fecb9SRuslan Bilovol 257eb9fecb9SRuslan Bilovol audio_dev = uac->audio_dev; 258eb9fecb9SRuslan Bilovol params = &audio_dev->params; 259eb9fecb9SRuslan Bilovol p_ssize = params->p_ssize; 260eb9fecb9SRuslan Bilovol c_ssize = params->c_ssize; 261eb9fecb9SRuslan Bilovol p_srate = params->p_srate; 262eb9fecb9SRuslan Bilovol c_srate = params->c_srate; 263eb9fecb9SRuslan Bilovol p_chmask = params->p_chmask; 264eb9fecb9SRuslan Bilovol c_chmask = params->c_chmask; 265eb9fecb9SRuslan Bilovol uac->p_residue = 0; 266eb9fecb9SRuslan Bilovol 267eb9fecb9SRuslan Bilovol runtime->hw = uac_pcm_hardware; 268eb9fecb9SRuslan Bilovol 269eb9fecb9SRuslan Bilovol if (substream->stream == SNDRV_PCM_STREAM_PLAYBACK) { 270eb9fecb9SRuslan Bilovol runtime->hw.rate_min = p_srate; 27125dbd75dSJerome Brunet runtime->hw.formats = uac_ssize_to_fmt(p_ssize); 272eb9fecb9SRuslan Bilovol runtime->hw.channels_min = num_channels(p_chmask); 273eb9fecb9SRuslan Bilovol runtime->hw.period_bytes_min = 2 * uac->p_prm.max_psize 274eb9fecb9SRuslan Bilovol / runtime->hw.periods_min; 275eb9fecb9SRuslan Bilovol } else { 276eb9fecb9SRuslan Bilovol runtime->hw.rate_min = c_srate; 27725dbd75dSJerome Brunet runtime->hw.formats = uac_ssize_to_fmt(c_ssize); 278eb9fecb9SRuslan Bilovol runtime->hw.channels_min = num_channels(c_chmask); 279eb9fecb9SRuslan Bilovol runtime->hw.period_bytes_min = 2 * uac->c_prm.max_psize 280eb9fecb9SRuslan Bilovol / runtime->hw.periods_min; 281eb9fecb9SRuslan Bilovol } 282eb9fecb9SRuslan Bilovol 283eb9fecb9SRuslan Bilovol runtime->hw.rate_max = runtime->hw.rate_min; 284eb9fecb9SRuslan Bilovol runtime->hw.channels_max = runtime->hw.channels_min; 285eb9fecb9SRuslan Bilovol 286eb9fecb9SRuslan Bilovol snd_pcm_hw_constraint_integer(runtime, SNDRV_PCM_HW_PARAM_PERIODS); 287eb9fecb9SRuslan Bilovol 288eb9fecb9SRuslan Bilovol return 0; 289eb9fecb9SRuslan Bilovol } 290eb9fecb9SRuslan Bilovol 291eb9fecb9SRuslan Bilovol /* ALSA cries without these function pointers */ 292eb9fecb9SRuslan Bilovol static int uac_pcm_null(struct snd_pcm_substream *substream) 293eb9fecb9SRuslan Bilovol { 294eb9fecb9SRuslan Bilovol return 0; 295eb9fecb9SRuslan Bilovol } 296eb9fecb9SRuslan Bilovol 297640c0be8SArvind Yadav static const struct snd_pcm_ops uac_pcm_ops = { 298eb9fecb9SRuslan Bilovol .open = uac_pcm_open, 299eb9fecb9SRuslan Bilovol .close = uac_pcm_null, 300eb9fecb9SRuslan Bilovol .trigger = uac_pcm_trigger, 301eb9fecb9SRuslan Bilovol .pointer = uac_pcm_pointer, 302eb9fecb9SRuslan Bilovol .prepare = uac_pcm_null, 303eb9fecb9SRuslan Bilovol }; 304eb9fecb9SRuslan Bilovol 305eb9fecb9SRuslan Bilovol static inline void free_ep(struct uac_rtd_params *prm, struct usb_ep *ep) 306eb9fecb9SRuslan Bilovol { 307eb9fecb9SRuslan Bilovol struct snd_uac_chip *uac = prm->uac; 308eb9fecb9SRuslan Bilovol struct g_audio *audio_dev; 309eb9fecb9SRuslan Bilovol struct uac_params *params; 310eb9fecb9SRuslan Bilovol int i; 311eb9fecb9SRuslan Bilovol 312eb9fecb9SRuslan Bilovol if (!prm->ep_enabled) 313eb9fecb9SRuslan Bilovol return; 314eb9fecb9SRuslan Bilovol 315eb9fecb9SRuslan Bilovol prm->ep_enabled = false; 316eb9fecb9SRuslan Bilovol 317eb9fecb9SRuslan Bilovol audio_dev = uac->audio_dev; 318eb9fecb9SRuslan Bilovol params = &audio_dev->params; 319eb9fecb9SRuslan Bilovol 320eb9fecb9SRuslan Bilovol for (i = 0; i < params->req_number; i++) { 32129865117SJerome Brunet if (prm->reqs[i]) { 32229865117SJerome Brunet if (usb_ep_dequeue(ep, prm->reqs[i])) 32329865117SJerome Brunet usb_ep_free_request(ep, prm->reqs[i]); 3247de8681bSJack Pham /* 3257de8681bSJack Pham * If usb_ep_dequeue() cannot successfully dequeue the 3267de8681bSJack Pham * request, the request will be freed by the completion 3277de8681bSJack Pham * callback. 3287de8681bSJack Pham */ 3297de8681bSJack Pham 33029865117SJerome Brunet prm->reqs[i] = NULL; 331eb9fecb9SRuslan Bilovol } 332eb9fecb9SRuslan Bilovol } 333eb9fecb9SRuslan Bilovol 334eb9fecb9SRuslan Bilovol if (usb_ep_disable(ep)) 335eb9fecb9SRuslan Bilovol dev_err(uac->card->dev, "%s:%d Error!\n", __func__, __LINE__); 336eb9fecb9SRuslan Bilovol } 337eb9fecb9SRuslan Bilovol 338eb9fecb9SRuslan Bilovol 339eb9fecb9SRuslan Bilovol int u_audio_start_capture(struct g_audio *audio_dev) 340eb9fecb9SRuslan Bilovol { 341eb9fecb9SRuslan Bilovol struct snd_uac_chip *uac = audio_dev->uac; 342eb9fecb9SRuslan Bilovol struct usb_gadget *gadget = audio_dev->gadget; 343eb9fecb9SRuslan Bilovol struct device *dev = &gadget->dev; 344eb9fecb9SRuslan Bilovol struct usb_request *req; 345eb9fecb9SRuslan Bilovol struct usb_ep *ep; 346eb9fecb9SRuslan Bilovol struct uac_rtd_params *prm; 347eb9fecb9SRuslan Bilovol struct uac_params *params = &audio_dev->params; 348eb9fecb9SRuslan Bilovol int req_len, i; 349eb9fecb9SRuslan Bilovol 350eb9fecb9SRuslan Bilovol ep = audio_dev->out_ep; 351eb9fecb9SRuslan Bilovol prm = &uac->c_prm; 352eb9fecb9SRuslan Bilovol config_ep_by_speed(gadget, &audio_dev->func, ep); 353904967c6SJohn Keeping req_len = ep->maxpacket; 354eb9fecb9SRuslan Bilovol 355eb9fecb9SRuslan Bilovol prm->ep_enabled = true; 356eb9fecb9SRuslan Bilovol usb_ep_enable(ep); 357eb9fecb9SRuslan Bilovol 358eb9fecb9SRuslan Bilovol for (i = 0; i < params->req_number; i++) { 35929865117SJerome Brunet if (!prm->reqs[i]) { 360eb9fecb9SRuslan Bilovol req = usb_ep_alloc_request(ep, GFP_ATOMIC); 361eb9fecb9SRuslan Bilovol if (req == NULL) 362eb9fecb9SRuslan Bilovol return -ENOMEM; 363eb9fecb9SRuslan Bilovol 36429865117SJerome Brunet prm->reqs[i] = req; 365eb9fecb9SRuslan Bilovol 366eb9fecb9SRuslan Bilovol req->zero = 0; 36729865117SJerome Brunet req->context = prm; 368eb9fecb9SRuslan Bilovol req->length = req_len; 369eb9fecb9SRuslan Bilovol req->complete = u_audio_iso_complete; 370904967c6SJohn Keeping req->buf = prm->rbuf + i * ep->maxpacket; 371eb9fecb9SRuslan Bilovol } 372eb9fecb9SRuslan Bilovol 37329865117SJerome Brunet if (usb_ep_queue(ep, prm->reqs[i], GFP_ATOMIC)) 374eb9fecb9SRuslan Bilovol dev_err(dev, "%s:%d Error!\n", __func__, __LINE__); 375eb9fecb9SRuslan Bilovol } 376eb9fecb9SRuslan Bilovol 377eb9fecb9SRuslan Bilovol return 0; 378eb9fecb9SRuslan Bilovol } 379eb9fecb9SRuslan Bilovol EXPORT_SYMBOL_GPL(u_audio_start_capture); 380eb9fecb9SRuslan Bilovol 381eb9fecb9SRuslan Bilovol void u_audio_stop_capture(struct g_audio *audio_dev) 382eb9fecb9SRuslan Bilovol { 383eb9fecb9SRuslan Bilovol struct snd_uac_chip *uac = audio_dev->uac; 384eb9fecb9SRuslan Bilovol 385eb9fecb9SRuslan Bilovol free_ep(&uac->c_prm, audio_dev->out_ep); 386eb9fecb9SRuslan Bilovol } 387eb9fecb9SRuslan Bilovol EXPORT_SYMBOL_GPL(u_audio_stop_capture); 388eb9fecb9SRuslan Bilovol 389eb9fecb9SRuslan Bilovol int u_audio_start_playback(struct g_audio *audio_dev) 390eb9fecb9SRuslan Bilovol { 391eb9fecb9SRuslan Bilovol struct snd_uac_chip *uac = audio_dev->uac; 392eb9fecb9SRuslan Bilovol struct usb_gadget *gadget = audio_dev->gadget; 393eb9fecb9SRuslan Bilovol struct device *dev = &gadget->dev; 394eb9fecb9SRuslan Bilovol struct usb_request *req; 395eb9fecb9SRuslan Bilovol struct usb_ep *ep; 396eb9fecb9SRuslan Bilovol struct uac_rtd_params *prm; 397eb9fecb9SRuslan Bilovol struct uac_params *params = &audio_dev->params; 3986b02af34SJohn Keeping unsigned int factor; 399eb9fecb9SRuslan Bilovol const struct usb_endpoint_descriptor *ep_desc; 400eb9fecb9SRuslan Bilovol int req_len, i; 401eb9fecb9SRuslan Bilovol 402eb9fecb9SRuslan Bilovol ep = audio_dev->in_ep; 403eb9fecb9SRuslan Bilovol prm = &uac->p_prm; 404eb9fecb9SRuslan Bilovol config_ep_by_speed(gadget, &audio_dev->func, ep); 405eb9fecb9SRuslan Bilovol 406eb9fecb9SRuslan Bilovol ep_desc = ep->desc; 407eb9fecb9SRuslan Bilovol 408eb9fecb9SRuslan Bilovol /* pre-calculate the playback endpoint's interval */ 409eb9fecb9SRuslan Bilovol if (gadget->speed == USB_SPEED_FULL) 410eb9fecb9SRuslan Bilovol factor = 1000; 411eb9fecb9SRuslan Bilovol else 412eb9fecb9SRuslan Bilovol factor = 8000; 413eb9fecb9SRuslan Bilovol 414eb9fecb9SRuslan Bilovol /* pre-compute some values for iso_complete() */ 415eb9fecb9SRuslan Bilovol uac->p_framesize = params->p_ssize * 416eb9fecb9SRuslan Bilovol num_channels(params->p_chmask); 417eb9fecb9SRuslan Bilovol uac->p_interval = factor / (1 << (ep_desc->bInterval - 1)); 4186b02af34SJohn Keeping uac->p_pktsize = min_t(unsigned int, 4196b02af34SJohn Keeping uac->p_framesize * 4206b02af34SJohn Keeping (params->p_srate / uac->p_interval), 421904967c6SJohn Keeping ep->maxpacket); 422eb9fecb9SRuslan Bilovol 423904967c6SJohn Keeping if (uac->p_pktsize < ep->maxpacket) 4246b02af34SJohn Keeping uac->p_pktsize_residue = uac->p_framesize * 4256b02af34SJohn Keeping (params->p_srate % uac->p_interval); 426eb9fecb9SRuslan Bilovol else 427eb9fecb9SRuslan Bilovol uac->p_pktsize_residue = 0; 428eb9fecb9SRuslan Bilovol 429eb9fecb9SRuslan Bilovol req_len = uac->p_pktsize; 430eb9fecb9SRuslan Bilovol uac->p_residue = 0; 431eb9fecb9SRuslan Bilovol 432eb9fecb9SRuslan Bilovol prm->ep_enabled = true; 433eb9fecb9SRuslan Bilovol usb_ep_enable(ep); 434eb9fecb9SRuslan Bilovol 435eb9fecb9SRuslan Bilovol for (i = 0; i < params->req_number; i++) { 43629865117SJerome Brunet if (!prm->reqs[i]) { 437eb9fecb9SRuslan Bilovol req = usb_ep_alloc_request(ep, GFP_ATOMIC); 438eb9fecb9SRuslan Bilovol if (req == NULL) 439eb9fecb9SRuslan Bilovol return -ENOMEM; 440eb9fecb9SRuslan Bilovol 44129865117SJerome Brunet prm->reqs[i] = req; 442eb9fecb9SRuslan Bilovol 443eb9fecb9SRuslan Bilovol req->zero = 0; 44429865117SJerome Brunet req->context = prm; 445eb9fecb9SRuslan Bilovol req->length = req_len; 446eb9fecb9SRuslan Bilovol req->complete = u_audio_iso_complete; 447904967c6SJohn Keeping req->buf = prm->rbuf + i * ep->maxpacket; 448eb9fecb9SRuslan Bilovol } 449eb9fecb9SRuslan Bilovol 45029865117SJerome Brunet if (usb_ep_queue(ep, prm->reqs[i], GFP_ATOMIC)) 451eb9fecb9SRuslan Bilovol dev_err(dev, "%s:%d Error!\n", __func__, __LINE__); 452eb9fecb9SRuslan Bilovol } 453eb9fecb9SRuslan Bilovol 454eb9fecb9SRuslan Bilovol return 0; 455eb9fecb9SRuslan Bilovol } 456eb9fecb9SRuslan Bilovol EXPORT_SYMBOL_GPL(u_audio_start_playback); 457eb9fecb9SRuslan Bilovol 458eb9fecb9SRuslan Bilovol void u_audio_stop_playback(struct g_audio *audio_dev) 459eb9fecb9SRuslan Bilovol { 460eb9fecb9SRuslan Bilovol struct snd_uac_chip *uac = audio_dev->uac; 461eb9fecb9SRuslan Bilovol 462eb9fecb9SRuslan Bilovol free_ep(&uac->p_prm, audio_dev->in_ep); 463eb9fecb9SRuslan Bilovol } 464eb9fecb9SRuslan Bilovol EXPORT_SYMBOL_GPL(u_audio_stop_playback); 465eb9fecb9SRuslan Bilovol 466eb9fecb9SRuslan Bilovol int g_audio_setup(struct g_audio *g_audio, const char *pcm_name, 467eb9fecb9SRuslan Bilovol const char *card_name) 468eb9fecb9SRuslan Bilovol { 469eb9fecb9SRuslan Bilovol struct snd_uac_chip *uac; 470eb9fecb9SRuslan Bilovol struct snd_card *card; 471eb9fecb9SRuslan Bilovol struct snd_pcm *pcm; 472eb9fecb9SRuslan Bilovol struct uac_params *params; 473eb9fecb9SRuslan Bilovol int p_chmask, c_chmask; 474eb9fecb9SRuslan Bilovol int err; 475eb9fecb9SRuslan Bilovol 476eb9fecb9SRuslan Bilovol if (!g_audio) 477eb9fecb9SRuslan Bilovol return -EINVAL; 478eb9fecb9SRuslan Bilovol 479eb9fecb9SRuslan Bilovol uac = kzalloc(sizeof(*uac), GFP_KERNEL); 480eb9fecb9SRuslan Bilovol if (!uac) 481eb9fecb9SRuslan Bilovol return -ENOMEM; 482eb9fecb9SRuslan Bilovol g_audio->uac = uac; 483eb9fecb9SRuslan Bilovol uac->audio_dev = g_audio; 484eb9fecb9SRuslan Bilovol 485eb9fecb9SRuslan Bilovol params = &g_audio->params; 486eb9fecb9SRuslan Bilovol p_chmask = params->p_chmask; 487eb9fecb9SRuslan Bilovol c_chmask = params->c_chmask; 488eb9fecb9SRuslan Bilovol 489eb9fecb9SRuslan Bilovol if (c_chmask) { 490eb9fecb9SRuslan Bilovol struct uac_rtd_params *prm = &uac->c_prm; 491eb9fecb9SRuslan Bilovol 492eb9fecb9SRuslan Bilovol uac->c_prm.uac = uac; 493eb9fecb9SRuslan Bilovol prm->max_psize = g_audio->out_ep_maxpsize; 494eb9fecb9SRuslan Bilovol 49529865117SJerome Brunet prm->reqs = kcalloc(params->req_number, 49629865117SJerome Brunet sizeof(struct usb_request *), 497eb9fecb9SRuslan Bilovol GFP_KERNEL); 49829865117SJerome Brunet if (!prm->reqs) { 499eb9fecb9SRuslan Bilovol err = -ENOMEM; 500eb9fecb9SRuslan Bilovol goto fail; 501eb9fecb9SRuslan Bilovol } 502eb9fecb9SRuslan Bilovol 503eb9fecb9SRuslan Bilovol prm->rbuf = kcalloc(params->req_number, prm->max_psize, 504eb9fecb9SRuslan Bilovol GFP_KERNEL); 505eb9fecb9SRuslan Bilovol if (!prm->rbuf) { 506eb9fecb9SRuslan Bilovol prm->max_psize = 0; 507eb9fecb9SRuslan Bilovol err = -ENOMEM; 508eb9fecb9SRuslan Bilovol goto fail; 509eb9fecb9SRuslan Bilovol } 510eb9fecb9SRuslan Bilovol } 511eb9fecb9SRuslan Bilovol 512eb9fecb9SRuslan Bilovol if (p_chmask) { 513eb9fecb9SRuslan Bilovol struct uac_rtd_params *prm = &uac->p_prm; 514eb9fecb9SRuslan Bilovol 515eb9fecb9SRuslan Bilovol uac->p_prm.uac = uac; 516eb9fecb9SRuslan Bilovol prm->max_psize = g_audio->in_ep_maxpsize; 517eb9fecb9SRuslan Bilovol 51829865117SJerome Brunet prm->reqs = kcalloc(params->req_number, 51929865117SJerome Brunet sizeof(struct usb_request *), 520eb9fecb9SRuslan Bilovol GFP_KERNEL); 52129865117SJerome Brunet if (!prm->reqs) { 522eb9fecb9SRuslan Bilovol err = -ENOMEM; 523eb9fecb9SRuslan Bilovol goto fail; 524eb9fecb9SRuslan Bilovol } 525eb9fecb9SRuslan Bilovol 526eb9fecb9SRuslan Bilovol prm->rbuf = kcalloc(params->req_number, prm->max_psize, 527eb9fecb9SRuslan Bilovol GFP_KERNEL); 528eb9fecb9SRuslan Bilovol if (!prm->rbuf) { 529eb9fecb9SRuslan Bilovol prm->max_psize = 0; 530eb9fecb9SRuslan Bilovol err = -ENOMEM; 531eb9fecb9SRuslan Bilovol goto fail; 532eb9fecb9SRuslan Bilovol } 533eb9fecb9SRuslan Bilovol } 534eb9fecb9SRuslan Bilovol 535eb9fecb9SRuslan Bilovol /* Choose any slot, with no id */ 536eb9fecb9SRuslan Bilovol err = snd_card_new(&g_audio->gadget->dev, 537eb9fecb9SRuslan Bilovol -1, NULL, THIS_MODULE, 0, &card); 538eb9fecb9SRuslan Bilovol if (err < 0) 539eb9fecb9SRuslan Bilovol goto fail; 540eb9fecb9SRuslan Bilovol 541eb9fecb9SRuslan Bilovol uac->card = card; 542eb9fecb9SRuslan Bilovol 543eb9fecb9SRuslan Bilovol /* 544eb9fecb9SRuslan Bilovol * Create first PCM device 545eb9fecb9SRuslan Bilovol * Create a substream only for non-zero channel streams 546eb9fecb9SRuslan Bilovol */ 547eb9fecb9SRuslan Bilovol err = snd_pcm_new(uac->card, pcm_name, 0, 548eb9fecb9SRuslan Bilovol p_chmask ? 1 : 0, c_chmask ? 1 : 0, &pcm); 549eb9fecb9SRuslan Bilovol if (err < 0) 550eb9fecb9SRuslan Bilovol goto snd_fail; 551eb9fecb9SRuslan Bilovol 552*d23922fcSRuslan Bilovol strscpy(pcm->name, pcm_name, sizeof(pcm->name)); 553eb9fecb9SRuslan Bilovol pcm->private_data = uac; 554eb9fecb9SRuslan Bilovol uac->pcm = pcm; 555eb9fecb9SRuslan Bilovol 556eb9fecb9SRuslan Bilovol snd_pcm_set_ops(pcm, SNDRV_PCM_STREAM_PLAYBACK, &uac_pcm_ops); 557eb9fecb9SRuslan Bilovol snd_pcm_set_ops(pcm, SNDRV_PCM_STREAM_CAPTURE, &uac_pcm_ops); 558eb9fecb9SRuslan Bilovol 559*d23922fcSRuslan Bilovol strscpy(card->driver, card_name, sizeof(card->driver)); 560*d23922fcSRuslan Bilovol strscpy(card->shortname, card_name, sizeof(card->shortname)); 561eb9fecb9SRuslan Bilovol sprintf(card->longname, "%s %i", card_name, card->dev->id); 562eb9fecb9SRuslan Bilovol 563d27ab1e6STakashi Iwai snd_pcm_set_managed_buffer_all(pcm, SNDRV_DMA_TYPE_CONTINUOUS, 56467b2945dSTakashi Iwai NULL, 0, BUFF_SIZE_MAX); 565eb9fecb9SRuslan Bilovol 566eb9fecb9SRuslan Bilovol err = snd_card_register(card); 567eb9fecb9SRuslan Bilovol 568eb9fecb9SRuslan Bilovol if (!err) 569eb9fecb9SRuslan Bilovol return 0; 570eb9fecb9SRuslan Bilovol 571eb9fecb9SRuslan Bilovol snd_fail: 572eb9fecb9SRuslan Bilovol snd_card_free(card); 573eb9fecb9SRuslan Bilovol fail: 57429865117SJerome Brunet kfree(uac->p_prm.reqs); 57529865117SJerome Brunet kfree(uac->c_prm.reqs); 576eb9fecb9SRuslan Bilovol kfree(uac->p_prm.rbuf); 577eb9fecb9SRuslan Bilovol kfree(uac->c_prm.rbuf); 578eb9fecb9SRuslan Bilovol kfree(uac); 579eb9fecb9SRuslan Bilovol 580eb9fecb9SRuslan Bilovol return err; 581eb9fecb9SRuslan Bilovol } 582eb9fecb9SRuslan Bilovol EXPORT_SYMBOL_GPL(g_audio_setup); 583eb9fecb9SRuslan Bilovol 584eb9fecb9SRuslan Bilovol void g_audio_cleanup(struct g_audio *g_audio) 585eb9fecb9SRuslan Bilovol { 586eb9fecb9SRuslan Bilovol struct snd_uac_chip *uac; 587eb9fecb9SRuslan Bilovol struct snd_card *card; 588eb9fecb9SRuslan Bilovol 589eb9fecb9SRuslan Bilovol if (!g_audio || !g_audio->uac) 590eb9fecb9SRuslan Bilovol return; 591eb9fecb9SRuslan Bilovol 592eb9fecb9SRuslan Bilovol uac = g_audio->uac; 593eb9fecb9SRuslan Bilovol card = uac->card; 594eb9fecb9SRuslan Bilovol if (card) 595eb9fecb9SRuslan Bilovol snd_card_free(card); 596eb9fecb9SRuslan Bilovol 59729865117SJerome Brunet kfree(uac->p_prm.reqs); 59829865117SJerome Brunet kfree(uac->c_prm.reqs); 599eb9fecb9SRuslan Bilovol kfree(uac->p_prm.rbuf); 600eb9fecb9SRuslan Bilovol kfree(uac->c_prm.rbuf); 601eb9fecb9SRuslan Bilovol kfree(uac); 602eb9fecb9SRuslan Bilovol } 603eb9fecb9SRuslan Bilovol EXPORT_SYMBOL_GPL(g_audio_cleanup); 604eb9fecb9SRuslan Bilovol 605eb9fecb9SRuslan Bilovol MODULE_LICENSE("GPL"); 606eb9fecb9SRuslan Bilovol MODULE_DESCRIPTION("USB gadget \"ALSA sound card\" utilities"); 607eb9fecb9SRuslan Bilovol MODULE_AUTHOR("Ruslan Bilovol"); 608