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 * This program is free software; you can redistribute it and/or modify 15eb9fecb9SRuslan Bilovol * it under the terms of the GNU General Public License as published by 16eb9fecb9SRuslan Bilovol * the Free Software Foundation; either version 2 of the License, or 17eb9fecb9SRuslan Bilovol * (at your option) any later version. 18eb9fecb9SRuslan Bilovol * 19eb9fecb9SRuslan Bilovol * This program is distributed in the hope that it will be useful, 20eb9fecb9SRuslan Bilovol * but WITHOUT ANY WARRANTY; without even the implied warranty of 21eb9fecb9SRuslan Bilovol * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the 22eb9fecb9SRuslan Bilovol * GNU General Public License for more details. 23eb9fecb9SRuslan Bilovol */ 24eb9fecb9SRuslan Bilovol 25eb9fecb9SRuslan Bilovol #include <linux/module.h> 26eb9fecb9SRuslan Bilovol #include <sound/core.h> 27eb9fecb9SRuslan Bilovol #include <sound/pcm.h> 28eb9fecb9SRuslan Bilovol #include <sound/pcm_params.h> 29eb9fecb9SRuslan Bilovol 30eb9fecb9SRuslan Bilovol #include "u_audio.h" 31eb9fecb9SRuslan Bilovol 32eb9fecb9SRuslan Bilovol #define BUFF_SIZE_MAX (PAGE_SIZE * 16) 33eb9fecb9SRuslan Bilovol #define PRD_SIZE_MAX PAGE_SIZE 34eb9fecb9SRuslan Bilovol #define MIN_PERIODS 4 35eb9fecb9SRuslan Bilovol 36eb9fecb9SRuslan Bilovol struct uac_req { 37eb9fecb9SRuslan Bilovol struct uac_rtd_params *pp; /* parent param */ 38eb9fecb9SRuslan Bilovol struct usb_request *req; 39eb9fecb9SRuslan Bilovol }; 40eb9fecb9SRuslan Bilovol 41eb9fecb9SRuslan Bilovol /* Runtime data params for one stream */ 42eb9fecb9SRuslan Bilovol struct uac_rtd_params { 43eb9fecb9SRuslan Bilovol struct snd_uac_chip *uac; /* parent chip */ 44eb9fecb9SRuslan Bilovol bool ep_enabled; /* if the ep is enabled */ 45eb9fecb9SRuslan Bilovol /* Size of the ring buffer */ 46eb9fecb9SRuslan Bilovol size_t dma_bytes; 47eb9fecb9SRuslan Bilovol unsigned char *dma_area; 48eb9fecb9SRuslan Bilovol 49eb9fecb9SRuslan Bilovol struct snd_pcm_substream *ss; 50eb9fecb9SRuslan Bilovol 51eb9fecb9SRuslan Bilovol /* Ring buffer */ 52eb9fecb9SRuslan Bilovol ssize_t hw_ptr; 53eb9fecb9SRuslan Bilovol 54eb9fecb9SRuslan Bilovol void *rbuf; 55eb9fecb9SRuslan Bilovol 56eb9fecb9SRuslan Bilovol size_t period_size; 57eb9fecb9SRuslan Bilovol 58eb9fecb9SRuslan Bilovol unsigned max_psize; /* MaxPacketSize of endpoint */ 59eb9fecb9SRuslan Bilovol struct uac_req *ureq; 60eb9fecb9SRuslan Bilovol 61eb9fecb9SRuslan Bilovol spinlock_t lock; 62eb9fecb9SRuslan Bilovol }; 63eb9fecb9SRuslan Bilovol 64eb9fecb9SRuslan Bilovol struct snd_uac_chip { 65eb9fecb9SRuslan Bilovol struct g_audio *audio_dev; 66eb9fecb9SRuslan Bilovol 67eb9fecb9SRuslan Bilovol struct uac_rtd_params p_prm; 68eb9fecb9SRuslan Bilovol struct uac_rtd_params c_prm; 69eb9fecb9SRuslan Bilovol 70eb9fecb9SRuslan Bilovol struct snd_card *card; 71eb9fecb9SRuslan Bilovol struct snd_pcm *pcm; 72eb9fecb9SRuslan Bilovol 73eb9fecb9SRuslan Bilovol /* timekeeping for the playback endpoint */ 74eb9fecb9SRuslan Bilovol unsigned int p_interval; 75eb9fecb9SRuslan Bilovol unsigned int p_residue; 76eb9fecb9SRuslan Bilovol 77eb9fecb9SRuslan Bilovol /* pre-calculated values for playback iso completion */ 78eb9fecb9SRuslan Bilovol unsigned int p_pktsize; 79eb9fecb9SRuslan Bilovol unsigned int p_pktsize_residue; 80eb9fecb9SRuslan Bilovol unsigned int p_framesize; 81eb9fecb9SRuslan Bilovol }; 82eb9fecb9SRuslan Bilovol 832ab3c34cSBhumika Goyal static const struct snd_pcm_hardware uac_pcm_hardware = { 84eb9fecb9SRuslan Bilovol .info = SNDRV_PCM_INFO_INTERLEAVED | SNDRV_PCM_INFO_BLOCK_TRANSFER 85eb9fecb9SRuslan Bilovol | SNDRV_PCM_INFO_MMAP | SNDRV_PCM_INFO_MMAP_VALID 86eb9fecb9SRuslan Bilovol | SNDRV_PCM_INFO_PAUSE | SNDRV_PCM_INFO_RESUME, 87eb9fecb9SRuslan Bilovol .rates = SNDRV_PCM_RATE_CONTINUOUS, 88eb9fecb9SRuslan Bilovol .periods_max = BUFF_SIZE_MAX / PRD_SIZE_MAX, 89eb9fecb9SRuslan Bilovol .buffer_bytes_max = BUFF_SIZE_MAX, 90eb9fecb9SRuslan Bilovol .period_bytes_max = PRD_SIZE_MAX, 91eb9fecb9SRuslan Bilovol .periods_min = MIN_PERIODS, 92eb9fecb9SRuslan Bilovol }; 93eb9fecb9SRuslan Bilovol 94eb9fecb9SRuslan Bilovol static void u_audio_iso_complete(struct usb_ep *ep, struct usb_request *req) 95eb9fecb9SRuslan Bilovol { 96eb9fecb9SRuslan Bilovol unsigned pending; 97eb9fecb9SRuslan Bilovol unsigned long flags; 98eb9fecb9SRuslan Bilovol unsigned int hw_ptr; 99eb9fecb9SRuslan Bilovol bool update_alsa = false; 100eb9fecb9SRuslan Bilovol int status = req->status; 101eb9fecb9SRuslan Bilovol struct uac_req *ur = req->context; 102eb9fecb9SRuslan Bilovol struct snd_pcm_substream *substream; 103eb9fecb9SRuslan Bilovol struct uac_rtd_params *prm = ur->pp; 104eb9fecb9SRuslan Bilovol struct snd_uac_chip *uac = prm->uac; 105eb9fecb9SRuslan Bilovol 106eb9fecb9SRuslan Bilovol /* i/f shutting down */ 107eb9fecb9SRuslan Bilovol if (!prm->ep_enabled || req->status == -ESHUTDOWN) 108eb9fecb9SRuslan Bilovol return; 109eb9fecb9SRuslan Bilovol 110eb9fecb9SRuslan Bilovol /* 111eb9fecb9SRuslan Bilovol * We can't really do much about bad xfers. 112eb9fecb9SRuslan Bilovol * Afterall, the ISOCH xfers could fail legitimately. 113eb9fecb9SRuslan Bilovol */ 114eb9fecb9SRuslan Bilovol if (status) 115eb9fecb9SRuslan Bilovol pr_debug("%s: iso_complete status(%d) %d/%d\n", 116eb9fecb9SRuslan Bilovol __func__, status, req->actual, req->length); 117eb9fecb9SRuslan Bilovol 118eb9fecb9SRuslan Bilovol substream = prm->ss; 119eb9fecb9SRuslan Bilovol 120eb9fecb9SRuslan Bilovol /* Do nothing if ALSA isn't active */ 121eb9fecb9SRuslan Bilovol if (!substream) 122eb9fecb9SRuslan Bilovol goto exit; 123eb9fecb9SRuslan Bilovol 124eb9fecb9SRuslan Bilovol spin_lock_irqsave(&prm->lock, flags); 125eb9fecb9SRuslan Bilovol 126eb9fecb9SRuslan Bilovol if (substream->stream == SNDRV_PCM_STREAM_PLAYBACK) { 127eb9fecb9SRuslan Bilovol /* 128eb9fecb9SRuslan Bilovol * For each IN packet, take the quotient of the current data 129eb9fecb9SRuslan Bilovol * rate and the endpoint's interval as the base packet size. 130eb9fecb9SRuslan Bilovol * If there is a residue from this division, add it to the 131eb9fecb9SRuslan Bilovol * residue accumulator. 132eb9fecb9SRuslan Bilovol */ 133eb9fecb9SRuslan Bilovol req->length = uac->p_pktsize; 134eb9fecb9SRuslan Bilovol uac->p_residue += uac->p_pktsize_residue; 135eb9fecb9SRuslan Bilovol 136eb9fecb9SRuslan Bilovol /* 137eb9fecb9SRuslan Bilovol * Whenever there are more bytes in the accumulator than we 138eb9fecb9SRuslan Bilovol * need to add one more sample frame, increase this packet's 139eb9fecb9SRuslan Bilovol * size and decrease the accumulator. 140eb9fecb9SRuslan Bilovol */ 141eb9fecb9SRuslan Bilovol if (uac->p_residue / uac->p_interval >= uac->p_framesize) { 142eb9fecb9SRuslan Bilovol req->length += uac->p_framesize; 143eb9fecb9SRuslan Bilovol uac->p_residue -= uac->p_framesize * 144eb9fecb9SRuslan Bilovol uac->p_interval; 145eb9fecb9SRuslan Bilovol } 146eb9fecb9SRuslan Bilovol 147eb9fecb9SRuslan Bilovol req->actual = req->length; 148eb9fecb9SRuslan Bilovol } 149eb9fecb9SRuslan Bilovol 150eb9fecb9SRuslan Bilovol pending = prm->hw_ptr % prm->period_size; 151eb9fecb9SRuslan Bilovol pending += req->actual; 152eb9fecb9SRuslan Bilovol if (pending >= prm->period_size) 153eb9fecb9SRuslan Bilovol update_alsa = true; 154eb9fecb9SRuslan Bilovol 155eb9fecb9SRuslan Bilovol hw_ptr = prm->hw_ptr; 156eb9fecb9SRuslan Bilovol prm->hw_ptr = (prm->hw_ptr + req->actual) % prm->dma_bytes; 157eb9fecb9SRuslan Bilovol 158eb9fecb9SRuslan Bilovol spin_unlock_irqrestore(&prm->lock, flags); 159eb9fecb9SRuslan Bilovol 160eb9fecb9SRuslan Bilovol /* Pack USB load in ALSA ring buffer */ 161eb9fecb9SRuslan Bilovol pending = prm->dma_bytes - hw_ptr; 162eb9fecb9SRuslan Bilovol 163eb9fecb9SRuslan Bilovol if (substream->stream == SNDRV_PCM_STREAM_PLAYBACK) { 164eb9fecb9SRuslan Bilovol if (unlikely(pending < req->actual)) { 165eb9fecb9SRuslan Bilovol memcpy(req->buf, prm->dma_area + hw_ptr, pending); 166eb9fecb9SRuslan Bilovol memcpy(req->buf + pending, prm->dma_area, 167eb9fecb9SRuslan Bilovol req->actual - pending); 168eb9fecb9SRuslan Bilovol } else { 169eb9fecb9SRuslan Bilovol memcpy(req->buf, prm->dma_area + hw_ptr, req->actual); 170eb9fecb9SRuslan Bilovol } 171eb9fecb9SRuslan Bilovol } else { 172eb9fecb9SRuslan Bilovol if (unlikely(pending < req->actual)) { 173eb9fecb9SRuslan Bilovol memcpy(prm->dma_area + hw_ptr, req->buf, pending); 174eb9fecb9SRuslan Bilovol memcpy(prm->dma_area, req->buf + pending, 175eb9fecb9SRuslan Bilovol req->actual - pending); 176eb9fecb9SRuslan Bilovol } else { 177eb9fecb9SRuslan Bilovol memcpy(prm->dma_area + hw_ptr, req->buf, req->actual); 178eb9fecb9SRuslan Bilovol } 179eb9fecb9SRuslan Bilovol } 180eb9fecb9SRuslan Bilovol 181eb9fecb9SRuslan Bilovol exit: 182eb9fecb9SRuslan Bilovol if (usb_ep_queue(ep, req, GFP_ATOMIC)) 183eb9fecb9SRuslan Bilovol dev_err(uac->card->dev, "%d Error!\n", __LINE__); 184eb9fecb9SRuslan Bilovol 185eb9fecb9SRuslan Bilovol if (update_alsa) 186eb9fecb9SRuslan Bilovol snd_pcm_period_elapsed(substream); 187eb9fecb9SRuslan Bilovol } 188eb9fecb9SRuslan Bilovol 189eb9fecb9SRuslan Bilovol static int uac_pcm_trigger(struct snd_pcm_substream *substream, int cmd) 190eb9fecb9SRuslan Bilovol { 191eb9fecb9SRuslan Bilovol struct snd_uac_chip *uac = snd_pcm_substream_chip(substream); 192eb9fecb9SRuslan Bilovol struct uac_rtd_params *prm; 193eb9fecb9SRuslan Bilovol struct g_audio *audio_dev; 194eb9fecb9SRuslan Bilovol struct uac_params *params; 195eb9fecb9SRuslan Bilovol unsigned long flags; 196eb9fecb9SRuslan Bilovol int err = 0; 197eb9fecb9SRuslan Bilovol 198eb9fecb9SRuslan Bilovol audio_dev = uac->audio_dev; 199eb9fecb9SRuslan Bilovol params = &audio_dev->params; 200eb9fecb9SRuslan Bilovol 201eb9fecb9SRuslan Bilovol if (substream->stream == SNDRV_PCM_STREAM_PLAYBACK) 202eb9fecb9SRuslan Bilovol prm = &uac->p_prm; 203eb9fecb9SRuslan Bilovol else 204eb9fecb9SRuslan Bilovol prm = &uac->c_prm; 205eb9fecb9SRuslan Bilovol 206eb9fecb9SRuslan Bilovol spin_lock_irqsave(&prm->lock, flags); 207eb9fecb9SRuslan Bilovol 208eb9fecb9SRuslan Bilovol /* Reset */ 209eb9fecb9SRuslan Bilovol prm->hw_ptr = 0; 210eb9fecb9SRuslan Bilovol 211eb9fecb9SRuslan Bilovol switch (cmd) { 212eb9fecb9SRuslan Bilovol case SNDRV_PCM_TRIGGER_START: 213eb9fecb9SRuslan Bilovol case SNDRV_PCM_TRIGGER_RESUME: 214eb9fecb9SRuslan Bilovol prm->ss = substream; 215eb9fecb9SRuslan Bilovol break; 216eb9fecb9SRuslan Bilovol case SNDRV_PCM_TRIGGER_STOP: 217eb9fecb9SRuslan Bilovol case SNDRV_PCM_TRIGGER_SUSPEND: 218eb9fecb9SRuslan Bilovol prm->ss = NULL; 219eb9fecb9SRuslan Bilovol break; 220eb9fecb9SRuslan Bilovol default: 221eb9fecb9SRuslan Bilovol err = -EINVAL; 222eb9fecb9SRuslan Bilovol } 223eb9fecb9SRuslan Bilovol 224eb9fecb9SRuslan Bilovol spin_unlock_irqrestore(&prm->lock, flags); 225eb9fecb9SRuslan Bilovol 226eb9fecb9SRuslan Bilovol /* Clear buffer after Play stops */ 227eb9fecb9SRuslan Bilovol if (substream->stream == SNDRV_PCM_STREAM_PLAYBACK && !prm->ss) 228eb9fecb9SRuslan Bilovol memset(prm->rbuf, 0, prm->max_psize * params->req_number); 229eb9fecb9SRuslan Bilovol 230eb9fecb9SRuslan Bilovol return err; 231eb9fecb9SRuslan Bilovol } 232eb9fecb9SRuslan Bilovol 233eb9fecb9SRuslan Bilovol static snd_pcm_uframes_t uac_pcm_pointer(struct snd_pcm_substream *substream) 234eb9fecb9SRuslan Bilovol { 235eb9fecb9SRuslan Bilovol struct snd_uac_chip *uac = snd_pcm_substream_chip(substream); 236eb9fecb9SRuslan Bilovol struct uac_rtd_params *prm; 237eb9fecb9SRuslan Bilovol 238eb9fecb9SRuslan Bilovol if (substream->stream == SNDRV_PCM_STREAM_PLAYBACK) 239eb9fecb9SRuslan Bilovol prm = &uac->p_prm; 240eb9fecb9SRuslan Bilovol else 241eb9fecb9SRuslan Bilovol prm = &uac->c_prm; 242eb9fecb9SRuslan Bilovol 243eb9fecb9SRuslan Bilovol return bytes_to_frames(substream->runtime, prm->hw_ptr); 244eb9fecb9SRuslan Bilovol } 245eb9fecb9SRuslan Bilovol 246eb9fecb9SRuslan Bilovol static int uac_pcm_hw_params(struct snd_pcm_substream *substream, 247eb9fecb9SRuslan Bilovol struct snd_pcm_hw_params *hw_params) 248eb9fecb9SRuslan Bilovol { 249eb9fecb9SRuslan Bilovol struct snd_uac_chip *uac = snd_pcm_substream_chip(substream); 250eb9fecb9SRuslan Bilovol struct uac_rtd_params *prm; 251eb9fecb9SRuslan Bilovol int err; 252eb9fecb9SRuslan Bilovol 253eb9fecb9SRuslan Bilovol if (substream->stream == SNDRV_PCM_STREAM_PLAYBACK) 254eb9fecb9SRuslan Bilovol prm = &uac->p_prm; 255eb9fecb9SRuslan Bilovol else 256eb9fecb9SRuslan Bilovol prm = &uac->c_prm; 257eb9fecb9SRuslan Bilovol 258eb9fecb9SRuslan Bilovol err = snd_pcm_lib_malloc_pages(substream, 259eb9fecb9SRuslan Bilovol params_buffer_bytes(hw_params)); 260eb9fecb9SRuslan Bilovol if (err >= 0) { 261eb9fecb9SRuslan Bilovol prm->dma_bytes = substream->runtime->dma_bytes; 262eb9fecb9SRuslan Bilovol prm->dma_area = substream->runtime->dma_area; 263eb9fecb9SRuslan Bilovol prm->period_size = params_period_bytes(hw_params); 264eb9fecb9SRuslan Bilovol } 265eb9fecb9SRuslan Bilovol 266eb9fecb9SRuslan Bilovol return err; 267eb9fecb9SRuslan Bilovol } 268eb9fecb9SRuslan Bilovol 269eb9fecb9SRuslan Bilovol static int uac_pcm_hw_free(struct snd_pcm_substream *substream) 270eb9fecb9SRuslan Bilovol { 271eb9fecb9SRuslan Bilovol struct snd_uac_chip *uac = snd_pcm_substream_chip(substream); 272eb9fecb9SRuslan Bilovol struct uac_rtd_params *prm; 273eb9fecb9SRuslan Bilovol 274eb9fecb9SRuslan Bilovol if (substream->stream == SNDRV_PCM_STREAM_PLAYBACK) 275eb9fecb9SRuslan Bilovol prm = &uac->p_prm; 276eb9fecb9SRuslan Bilovol else 277eb9fecb9SRuslan Bilovol prm = &uac->c_prm; 278eb9fecb9SRuslan Bilovol 279eb9fecb9SRuslan Bilovol prm->dma_area = NULL; 280eb9fecb9SRuslan Bilovol prm->dma_bytes = 0; 281eb9fecb9SRuslan Bilovol prm->period_size = 0; 282eb9fecb9SRuslan Bilovol 283eb9fecb9SRuslan Bilovol return snd_pcm_lib_free_pages(substream); 284eb9fecb9SRuslan Bilovol } 285eb9fecb9SRuslan Bilovol 286eb9fecb9SRuslan Bilovol static int uac_pcm_open(struct snd_pcm_substream *substream) 287eb9fecb9SRuslan Bilovol { 288eb9fecb9SRuslan Bilovol struct snd_uac_chip *uac = snd_pcm_substream_chip(substream); 289eb9fecb9SRuslan Bilovol struct snd_pcm_runtime *runtime = substream->runtime; 290eb9fecb9SRuslan Bilovol struct g_audio *audio_dev; 291eb9fecb9SRuslan Bilovol struct uac_params *params; 292eb9fecb9SRuslan Bilovol int p_ssize, c_ssize; 293eb9fecb9SRuslan Bilovol int p_srate, c_srate; 294eb9fecb9SRuslan Bilovol int p_chmask, c_chmask; 295eb9fecb9SRuslan Bilovol 296eb9fecb9SRuslan Bilovol audio_dev = uac->audio_dev; 297eb9fecb9SRuslan Bilovol params = &audio_dev->params; 298eb9fecb9SRuslan Bilovol p_ssize = params->p_ssize; 299eb9fecb9SRuslan Bilovol c_ssize = params->c_ssize; 300eb9fecb9SRuslan Bilovol p_srate = params->p_srate; 301eb9fecb9SRuslan Bilovol c_srate = params->c_srate; 302eb9fecb9SRuslan Bilovol p_chmask = params->p_chmask; 303eb9fecb9SRuslan Bilovol c_chmask = params->c_chmask; 304eb9fecb9SRuslan Bilovol uac->p_residue = 0; 305eb9fecb9SRuslan Bilovol 306eb9fecb9SRuslan Bilovol runtime->hw = uac_pcm_hardware; 307eb9fecb9SRuslan Bilovol 308eb9fecb9SRuslan Bilovol if (substream->stream == SNDRV_PCM_STREAM_PLAYBACK) { 309eb9fecb9SRuslan Bilovol spin_lock_init(&uac->p_prm.lock); 310eb9fecb9SRuslan Bilovol runtime->hw.rate_min = p_srate; 311eb9fecb9SRuslan Bilovol switch (p_ssize) { 312eb9fecb9SRuslan Bilovol case 3: 313eb9fecb9SRuslan Bilovol runtime->hw.formats = SNDRV_PCM_FMTBIT_S24_3LE; 314eb9fecb9SRuslan Bilovol break; 315eb9fecb9SRuslan Bilovol case 4: 316eb9fecb9SRuslan Bilovol runtime->hw.formats = SNDRV_PCM_FMTBIT_S32_LE; 317eb9fecb9SRuslan Bilovol break; 318eb9fecb9SRuslan Bilovol default: 319eb9fecb9SRuslan Bilovol runtime->hw.formats = SNDRV_PCM_FMTBIT_S16_LE; 320eb9fecb9SRuslan Bilovol break; 321eb9fecb9SRuslan Bilovol } 322eb9fecb9SRuslan Bilovol runtime->hw.channels_min = num_channels(p_chmask); 323eb9fecb9SRuslan Bilovol runtime->hw.period_bytes_min = 2 * uac->p_prm.max_psize 324eb9fecb9SRuslan Bilovol / runtime->hw.periods_min; 325eb9fecb9SRuslan Bilovol } else { 326eb9fecb9SRuslan Bilovol spin_lock_init(&uac->c_prm.lock); 327eb9fecb9SRuslan Bilovol runtime->hw.rate_min = c_srate; 328eb9fecb9SRuslan Bilovol switch (c_ssize) { 329eb9fecb9SRuslan Bilovol case 3: 330eb9fecb9SRuslan Bilovol runtime->hw.formats = SNDRV_PCM_FMTBIT_S24_3LE; 331eb9fecb9SRuslan Bilovol break; 332eb9fecb9SRuslan Bilovol case 4: 333eb9fecb9SRuslan Bilovol runtime->hw.formats = SNDRV_PCM_FMTBIT_S32_LE; 334eb9fecb9SRuslan Bilovol break; 335eb9fecb9SRuslan Bilovol default: 336eb9fecb9SRuslan Bilovol runtime->hw.formats = SNDRV_PCM_FMTBIT_S16_LE; 337eb9fecb9SRuslan Bilovol break; 338eb9fecb9SRuslan Bilovol } 339eb9fecb9SRuslan Bilovol runtime->hw.channels_min = num_channels(c_chmask); 340eb9fecb9SRuslan Bilovol runtime->hw.period_bytes_min = 2 * uac->c_prm.max_psize 341eb9fecb9SRuslan Bilovol / runtime->hw.periods_min; 342eb9fecb9SRuslan Bilovol } 343eb9fecb9SRuslan Bilovol 344eb9fecb9SRuslan Bilovol runtime->hw.rate_max = runtime->hw.rate_min; 345eb9fecb9SRuslan Bilovol runtime->hw.channels_max = runtime->hw.channels_min; 346eb9fecb9SRuslan Bilovol 347eb9fecb9SRuslan Bilovol snd_pcm_hw_constraint_integer(runtime, SNDRV_PCM_HW_PARAM_PERIODS); 348eb9fecb9SRuslan Bilovol 349eb9fecb9SRuslan Bilovol return 0; 350eb9fecb9SRuslan Bilovol } 351eb9fecb9SRuslan Bilovol 352eb9fecb9SRuslan Bilovol /* ALSA cries without these function pointers */ 353eb9fecb9SRuslan Bilovol static int uac_pcm_null(struct snd_pcm_substream *substream) 354eb9fecb9SRuslan Bilovol { 355eb9fecb9SRuslan Bilovol return 0; 356eb9fecb9SRuslan Bilovol } 357eb9fecb9SRuslan Bilovol 358640c0be8SArvind Yadav static const struct snd_pcm_ops uac_pcm_ops = { 359eb9fecb9SRuslan Bilovol .open = uac_pcm_open, 360eb9fecb9SRuslan Bilovol .close = uac_pcm_null, 361eb9fecb9SRuslan Bilovol .ioctl = snd_pcm_lib_ioctl, 362eb9fecb9SRuslan Bilovol .hw_params = uac_pcm_hw_params, 363eb9fecb9SRuslan Bilovol .hw_free = uac_pcm_hw_free, 364eb9fecb9SRuslan Bilovol .trigger = uac_pcm_trigger, 365eb9fecb9SRuslan Bilovol .pointer = uac_pcm_pointer, 366eb9fecb9SRuslan Bilovol .prepare = uac_pcm_null, 367eb9fecb9SRuslan Bilovol }; 368eb9fecb9SRuslan Bilovol 369eb9fecb9SRuslan Bilovol static inline void free_ep(struct uac_rtd_params *prm, struct usb_ep *ep) 370eb9fecb9SRuslan Bilovol { 371eb9fecb9SRuslan Bilovol struct snd_uac_chip *uac = prm->uac; 372eb9fecb9SRuslan Bilovol struct g_audio *audio_dev; 373eb9fecb9SRuslan Bilovol struct uac_params *params; 374eb9fecb9SRuslan Bilovol int i; 375eb9fecb9SRuslan Bilovol 376eb9fecb9SRuslan Bilovol if (!prm->ep_enabled) 377eb9fecb9SRuslan Bilovol return; 378eb9fecb9SRuslan Bilovol 379eb9fecb9SRuslan Bilovol prm->ep_enabled = false; 380eb9fecb9SRuslan Bilovol 381eb9fecb9SRuslan Bilovol audio_dev = uac->audio_dev; 382eb9fecb9SRuslan Bilovol params = &audio_dev->params; 383eb9fecb9SRuslan Bilovol 384eb9fecb9SRuslan Bilovol for (i = 0; i < params->req_number; i++) { 385eb9fecb9SRuslan Bilovol if (prm->ureq[i].req) { 386eb9fecb9SRuslan Bilovol usb_ep_dequeue(ep, prm->ureq[i].req); 387eb9fecb9SRuslan Bilovol usb_ep_free_request(ep, prm->ureq[i].req); 388eb9fecb9SRuslan Bilovol prm->ureq[i].req = NULL; 389eb9fecb9SRuslan Bilovol } 390eb9fecb9SRuslan Bilovol } 391eb9fecb9SRuslan Bilovol 392eb9fecb9SRuslan Bilovol if (usb_ep_disable(ep)) 393eb9fecb9SRuslan Bilovol dev_err(uac->card->dev, "%s:%d Error!\n", __func__, __LINE__); 394eb9fecb9SRuslan Bilovol } 395eb9fecb9SRuslan Bilovol 396eb9fecb9SRuslan Bilovol 397eb9fecb9SRuslan Bilovol int u_audio_start_capture(struct g_audio *audio_dev) 398eb9fecb9SRuslan Bilovol { 399eb9fecb9SRuslan Bilovol struct snd_uac_chip *uac = audio_dev->uac; 400eb9fecb9SRuslan Bilovol struct usb_gadget *gadget = audio_dev->gadget; 401eb9fecb9SRuslan Bilovol struct device *dev = &gadget->dev; 402eb9fecb9SRuslan Bilovol struct usb_request *req; 403eb9fecb9SRuslan Bilovol struct usb_ep *ep; 404eb9fecb9SRuslan Bilovol struct uac_rtd_params *prm; 405eb9fecb9SRuslan Bilovol struct uac_params *params = &audio_dev->params; 406eb9fecb9SRuslan Bilovol int req_len, i; 407eb9fecb9SRuslan Bilovol 408eb9fecb9SRuslan Bilovol ep = audio_dev->out_ep; 409eb9fecb9SRuslan Bilovol prm = &uac->c_prm; 410eb9fecb9SRuslan Bilovol config_ep_by_speed(gadget, &audio_dev->func, ep); 411eb9fecb9SRuslan Bilovol req_len = prm->max_psize; 412eb9fecb9SRuslan Bilovol 413eb9fecb9SRuslan Bilovol prm->ep_enabled = true; 414eb9fecb9SRuslan Bilovol usb_ep_enable(ep); 415eb9fecb9SRuslan Bilovol 416eb9fecb9SRuslan Bilovol for (i = 0; i < params->req_number; i++) { 417eb9fecb9SRuslan Bilovol if (!prm->ureq[i].req) { 418eb9fecb9SRuslan Bilovol req = usb_ep_alloc_request(ep, GFP_ATOMIC); 419eb9fecb9SRuslan Bilovol if (req == NULL) 420eb9fecb9SRuslan Bilovol return -ENOMEM; 421eb9fecb9SRuslan Bilovol 422eb9fecb9SRuslan Bilovol prm->ureq[i].req = req; 423eb9fecb9SRuslan Bilovol prm->ureq[i].pp = prm; 424eb9fecb9SRuslan Bilovol 425eb9fecb9SRuslan Bilovol req->zero = 0; 426eb9fecb9SRuslan Bilovol req->context = &prm->ureq[i]; 427eb9fecb9SRuslan Bilovol req->length = req_len; 428eb9fecb9SRuslan Bilovol req->complete = u_audio_iso_complete; 429eb9fecb9SRuslan Bilovol req->buf = prm->rbuf + i * prm->max_psize; 430eb9fecb9SRuslan Bilovol } 431eb9fecb9SRuslan Bilovol 432eb9fecb9SRuslan Bilovol if (usb_ep_queue(ep, prm->ureq[i].req, GFP_ATOMIC)) 433eb9fecb9SRuslan Bilovol dev_err(dev, "%s:%d Error!\n", __func__, __LINE__); 434eb9fecb9SRuslan Bilovol } 435eb9fecb9SRuslan Bilovol 436eb9fecb9SRuslan Bilovol return 0; 437eb9fecb9SRuslan Bilovol } 438eb9fecb9SRuslan Bilovol EXPORT_SYMBOL_GPL(u_audio_start_capture); 439eb9fecb9SRuslan Bilovol 440eb9fecb9SRuslan Bilovol void u_audio_stop_capture(struct g_audio *audio_dev) 441eb9fecb9SRuslan Bilovol { 442eb9fecb9SRuslan Bilovol struct snd_uac_chip *uac = audio_dev->uac; 443eb9fecb9SRuslan Bilovol 444eb9fecb9SRuslan Bilovol free_ep(&uac->c_prm, audio_dev->out_ep); 445eb9fecb9SRuslan Bilovol } 446eb9fecb9SRuslan Bilovol EXPORT_SYMBOL_GPL(u_audio_stop_capture); 447eb9fecb9SRuslan Bilovol 448eb9fecb9SRuslan Bilovol int u_audio_start_playback(struct g_audio *audio_dev) 449eb9fecb9SRuslan Bilovol { 450eb9fecb9SRuslan Bilovol struct snd_uac_chip *uac = audio_dev->uac; 451eb9fecb9SRuslan Bilovol struct usb_gadget *gadget = audio_dev->gadget; 452eb9fecb9SRuslan Bilovol struct device *dev = &gadget->dev; 453eb9fecb9SRuslan Bilovol struct usb_request *req; 454eb9fecb9SRuslan Bilovol struct usb_ep *ep; 455eb9fecb9SRuslan Bilovol struct uac_rtd_params *prm; 456eb9fecb9SRuslan Bilovol struct uac_params *params = &audio_dev->params; 457eb9fecb9SRuslan Bilovol unsigned int factor, rate; 458eb9fecb9SRuslan Bilovol const struct usb_endpoint_descriptor *ep_desc; 459eb9fecb9SRuslan Bilovol int req_len, i; 460eb9fecb9SRuslan Bilovol 461eb9fecb9SRuslan Bilovol ep = audio_dev->in_ep; 462eb9fecb9SRuslan Bilovol prm = &uac->p_prm; 463eb9fecb9SRuslan Bilovol config_ep_by_speed(gadget, &audio_dev->func, ep); 464eb9fecb9SRuslan Bilovol 465eb9fecb9SRuslan Bilovol ep_desc = ep->desc; 466eb9fecb9SRuslan Bilovol 467eb9fecb9SRuslan Bilovol /* pre-calculate the playback endpoint's interval */ 468eb9fecb9SRuslan Bilovol if (gadget->speed == USB_SPEED_FULL) 469eb9fecb9SRuslan Bilovol factor = 1000; 470eb9fecb9SRuslan Bilovol else 471eb9fecb9SRuslan Bilovol factor = 8000; 472eb9fecb9SRuslan Bilovol 473eb9fecb9SRuslan Bilovol /* pre-compute some values for iso_complete() */ 474eb9fecb9SRuslan Bilovol uac->p_framesize = params->p_ssize * 475eb9fecb9SRuslan Bilovol num_channels(params->p_chmask); 476eb9fecb9SRuslan Bilovol rate = params->p_srate * uac->p_framesize; 477eb9fecb9SRuslan Bilovol uac->p_interval = factor / (1 << (ep_desc->bInterval - 1)); 478eb9fecb9SRuslan Bilovol uac->p_pktsize = min_t(unsigned int, rate / uac->p_interval, 479eb9fecb9SRuslan Bilovol prm->max_psize); 480eb9fecb9SRuslan Bilovol 481eb9fecb9SRuslan Bilovol if (uac->p_pktsize < prm->max_psize) 482eb9fecb9SRuslan Bilovol uac->p_pktsize_residue = rate % uac->p_interval; 483eb9fecb9SRuslan Bilovol else 484eb9fecb9SRuslan Bilovol uac->p_pktsize_residue = 0; 485eb9fecb9SRuslan Bilovol 486eb9fecb9SRuslan Bilovol req_len = uac->p_pktsize; 487eb9fecb9SRuslan Bilovol uac->p_residue = 0; 488eb9fecb9SRuslan Bilovol 489eb9fecb9SRuslan Bilovol prm->ep_enabled = true; 490eb9fecb9SRuslan Bilovol usb_ep_enable(ep); 491eb9fecb9SRuslan Bilovol 492eb9fecb9SRuslan Bilovol for (i = 0; i < params->req_number; i++) { 493eb9fecb9SRuslan Bilovol if (!prm->ureq[i].req) { 494eb9fecb9SRuslan Bilovol req = usb_ep_alloc_request(ep, GFP_ATOMIC); 495eb9fecb9SRuslan Bilovol if (req == NULL) 496eb9fecb9SRuslan Bilovol return -ENOMEM; 497eb9fecb9SRuslan Bilovol 498eb9fecb9SRuslan Bilovol prm->ureq[i].req = req; 499eb9fecb9SRuslan Bilovol prm->ureq[i].pp = prm; 500eb9fecb9SRuslan Bilovol 501eb9fecb9SRuslan Bilovol req->zero = 0; 502eb9fecb9SRuslan Bilovol req->context = &prm->ureq[i]; 503eb9fecb9SRuslan Bilovol req->length = req_len; 504eb9fecb9SRuslan Bilovol req->complete = u_audio_iso_complete; 505eb9fecb9SRuslan Bilovol req->buf = prm->rbuf + i * prm->max_psize; 506eb9fecb9SRuslan Bilovol } 507eb9fecb9SRuslan Bilovol 508eb9fecb9SRuslan Bilovol if (usb_ep_queue(ep, prm->ureq[i].req, GFP_ATOMIC)) 509eb9fecb9SRuslan Bilovol dev_err(dev, "%s:%d Error!\n", __func__, __LINE__); 510eb9fecb9SRuslan Bilovol } 511eb9fecb9SRuslan Bilovol 512eb9fecb9SRuslan Bilovol return 0; 513eb9fecb9SRuslan Bilovol } 514eb9fecb9SRuslan Bilovol EXPORT_SYMBOL_GPL(u_audio_start_playback); 515eb9fecb9SRuslan Bilovol 516eb9fecb9SRuslan Bilovol void u_audio_stop_playback(struct g_audio *audio_dev) 517eb9fecb9SRuslan Bilovol { 518eb9fecb9SRuslan Bilovol struct snd_uac_chip *uac = audio_dev->uac; 519eb9fecb9SRuslan Bilovol 520eb9fecb9SRuslan Bilovol free_ep(&uac->p_prm, audio_dev->in_ep); 521eb9fecb9SRuslan Bilovol } 522eb9fecb9SRuslan Bilovol EXPORT_SYMBOL_GPL(u_audio_stop_playback); 523eb9fecb9SRuslan Bilovol 524eb9fecb9SRuslan Bilovol int g_audio_setup(struct g_audio *g_audio, const char *pcm_name, 525eb9fecb9SRuslan Bilovol const char *card_name) 526eb9fecb9SRuslan Bilovol { 527eb9fecb9SRuslan Bilovol struct snd_uac_chip *uac; 528eb9fecb9SRuslan Bilovol struct snd_card *card; 529eb9fecb9SRuslan Bilovol struct snd_pcm *pcm; 530eb9fecb9SRuslan Bilovol struct uac_params *params; 531eb9fecb9SRuslan Bilovol int p_chmask, c_chmask; 532eb9fecb9SRuslan Bilovol int err; 533eb9fecb9SRuslan Bilovol 534eb9fecb9SRuslan Bilovol if (!g_audio) 535eb9fecb9SRuslan Bilovol return -EINVAL; 536eb9fecb9SRuslan Bilovol 537eb9fecb9SRuslan Bilovol uac = kzalloc(sizeof(*uac), GFP_KERNEL); 538eb9fecb9SRuslan Bilovol if (!uac) 539eb9fecb9SRuslan Bilovol return -ENOMEM; 540eb9fecb9SRuslan Bilovol g_audio->uac = uac; 541eb9fecb9SRuslan Bilovol uac->audio_dev = g_audio; 542eb9fecb9SRuslan Bilovol 543eb9fecb9SRuslan Bilovol params = &g_audio->params; 544eb9fecb9SRuslan Bilovol p_chmask = params->p_chmask; 545eb9fecb9SRuslan Bilovol c_chmask = params->c_chmask; 546eb9fecb9SRuslan Bilovol 547eb9fecb9SRuslan Bilovol if (c_chmask) { 548eb9fecb9SRuslan Bilovol struct uac_rtd_params *prm = &uac->c_prm; 549eb9fecb9SRuslan Bilovol 550eb9fecb9SRuslan Bilovol uac->c_prm.uac = uac; 551eb9fecb9SRuslan Bilovol prm->max_psize = g_audio->out_ep_maxpsize; 552eb9fecb9SRuslan Bilovol 553eb9fecb9SRuslan Bilovol prm->ureq = kcalloc(params->req_number, sizeof(struct uac_req), 554eb9fecb9SRuslan Bilovol GFP_KERNEL); 555eb9fecb9SRuslan Bilovol if (!prm->ureq) { 556eb9fecb9SRuslan Bilovol err = -ENOMEM; 557eb9fecb9SRuslan Bilovol goto fail; 558eb9fecb9SRuslan Bilovol } 559eb9fecb9SRuslan Bilovol 560eb9fecb9SRuslan Bilovol prm->rbuf = kcalloc(params->req_number, prm->max_psize, 561eb9fecb9SRuslan Bilovol GFP_KERNEL); 562eb9fecb9SRuslan Bilovol if (!prm->rbuf) { 563eb9fecb9SRuslan Bilovol prm->max_psize = 0; 564eb9fecb9SRuslan Bilovol err = -ENOMEM; 565eb9fecb9SRuslan Bilovol goto fail; 566eb9fecb9SRuslan Bilovol } 567eb9fecb9SRuslan Bilovol } 568eb9fecb9SRuslan Bilovol 569eb9fecb9SRuslan Bilovol if (p_chmask) { 570eb9fecb9SRuslan Bilovol struct uac_rtd_params *prm = &uac->p_prm; 571eb9fecb9SRuslan Bilovol 572eb9fecb9SRuslan Bilovol uac->p_prm.uac = uac; 573eb9fecb9SRuslan Bilovol prm->max_psize = g_audio->in_ep_maxpsize; 574eb9fecb9SRuslan Bilovol 575eb9fecb9SRuslan Bilovol prm->ureq = kcalloc(params->req_number, sizeof(struct uac_req), 576eb9fecb9SRuslan Bilovol GFP_KERNEL); 577eb9fecb9SRuslan Bilovol if (!prm->ureq) { 578eb9fecb9SRuslan Bilovol err = -ENOMEM; 579eb9fecb9SRuslan Bilovol goto fail; 580eb9fecb9SRuslan Bilovol } 581eb9fecb9SRuslan Bilovol 582eb9fecb9SRuslan Bilovol prm->rbuf = kcalloc(params->req_number, prm->max_psize, 583eb9fecb9SRuslan Bilovol GFP_KERNEL); 584eb9fecb9SRuslan Bilovol if (!prm->rbuf) { 585eb9fecb9SRuslan Bilovol prm->max_psize = 0; 586eb9fecb9SRuslan Bilovol err = -ENOMEM; 587eb9fecb9SRuslan Bilovol goto fail; 588eb9fecb9SRuslan Bilovol } 589eb9fecb9SRuslan Bilovol } 590eb9fecb9SRuslan Bilovol 591eb9fecb9SRuslan Bilovol /* Choose any slot, with no id */ 592eb9fecb9SRuslan Bilovol err = snd_card_new(&g_audio->gadget->dev, 593eb9fecb9SRuslan Bilovol -1, NULL, THIS_MODULE, 0, &card); 594eb9fecb9SRuslan Bilovol if (err < 0) 595eb9fecb9SRuslan Bilovol goto fail; 596eb9fecb9SRuslan Bilovol 597eb9fecb9SRuslan Bilovol uac->card = card; 598eb9fecb9SRuslan Bilovol 599eb9fecb9SRuslan Bilovol /* 600eb9fecb9SRuslan Bilovol * Create first PCM device 601eb9fecb9SRuslan Bilovol * Create a substream only for non-zero channel streams 602eb9fecb9SRuslan Bilovol */ 603eb9fecb9SRuslan Bilovol err = snd_pcm_new(uac->card, pcm_name, 0, 604eb9fecb9SRuslan Bilovol p_chmask ? 1 : 0, c_chmask ? 1 : 0, &pcm); 605eb9fecb9SRuslan Bilovol if (err < 0) 606eb9fecb9SRuslan Bilovol goto snd_fail; 607eb9fecb9SRuslan Bilovol 608eb9fecb9SRuslan Bilovol strcpy(pcm->name, pcm_name); 609eb9fecb9SRuslan Bilovol pcm->private_data = uac; 610eb9fecb9SRuslan Bilovol uac->pcm = pcm; 611eb9fecb9SRuslan Bilovol 612eb9fecb9SRuslan Bilovol snd_pcm_set_ops(pcm, SNDRV_PCM_STREAM_PLAYBACK, &uac_pcm_ops); 613eb9fecb9SRuslan Bilovol snd_pcm_set_ops(pcm, SNDRV_PCM_STREAM_CAPTURE, &uac_pcm_ops); 614eb9fecb9SRuslan Bilovol 615eb9fecb9SRuslan Bilovol strcpy(card->driver, card_name); 616eb9fecb9SRuslan Bilovol strcpy(card->shortname, card_name); 617eb9fecb9SRuslan Bilovol sprintf(card->longname, "%s %i", card_name, card->dev->id); 618eb9fecb9SRuslan Bilovol 619eb9fecb9SRuslan Bilovol snd_pcm_lib_preallocate_pages_for_all(pcm, SNDRV_DMA_TYPE_CONTINUOUS, 620eb9fecb9SRuslan Bilovol snd_dma_continuous_data(GFP_KERNEL), 0, BUFF_SIZE_MAX); 621eb9fecb9SRuslan Bilovol 622eb9fecb9SRuslan Bilovol err = snd_card_register(card); 623eb9fecb9SRuslan Bilovol 624eb9fecb9SRuslan Bilovol if (!err) 625eb9fecb9SRuslan Bilovol return 0; 626eb9fecb9SRuslan Bilovol 627eb9fecb9SRuslan Bilovol snd_fail: 628eb9fecb9SRuslan Bilovol snd_card_free(card); 629eb9fecb9SRuslan Bilovol fail: 630eb9fecb9SRuslan Bilovol kfree(uac->p_prm.ureq); 631eb9fecb9SRuslan Bilovol kfree(uac->c_prm.ureq); 632eb9fecb9SRuslan Bilovol kfree(uac->p_prm.rbuf); 633eb9fecb9SRuslan Bilovol kfree(uac->c_prm.rbuf); 634eb9fecb9SRuslan Bilovol kfree(uac); 635eb9fecb9SRuslan Bilovol 636eb9fecb9SRuslan Bilovol return err; 637eb9fecb9SRuslan Bilovol } 638eb9fecb9SRuslan Bilovol EXPORT_SYMBOL_GPL(g_audio_setup); 639eb9fecb9SRuslan Bilovol 640eb9fecb9SRuslan Bilovol void g_audio_cleanup(struct g_audio *g_audio) 641eb9fecb9SRuslan Bilovol { 642eb9fecb9SRuslan Bilovol struct snd_uac_chip *uac; 643eb9fecb9SRuslan Bilovol struct snd_card *card; 644eb9fecb9SRuslan Bilovol 645eb9fecb9SRuslan Bilovol if (!g_audio || !g_audio->uac) 646eb9fecb9SRuslan Bilovol return; 647eb9fecb9SRuslan Bilovol 648eb9fecb9SRuslan Bilovol uac = g_audio->uac; 649eb9fecb9SRuslan Bilovol card = uac->card; 650eb9fecb9SRuslan Bilovol if (card) 651eb9fecb9SRuslan Bilovol snd_card_free(card); 652eb9fecb9SRuslan Bilovol 653eb9fecb9SRuslan Bilovol kfree(uac->p_prm.ureq); 654eb9fecb9SRuslan Bilovol kfree(uac->c_prm.ureq); 655eb9fecb9SRuslan Bilovol kfree(uac->p_prm.rbuf); 656eb9fecb9SRuslan Bilovol kfree(uac->c_prm.rbuf); 657eb9fecb9SRuslan Bilovol kfree(uac); 658eb9fecb9SRuslan Bilovol } 659eb9fecb9SRuslan Bilovol EXPORT_SYMBOL_GPL(g_audio_cleanup); 660eb9fecb9SRuslan Bilovol 661eb9fecb9SRuslan Bilovol MODULE_LICENSE("GPL"); 662eb9fecb9SRuslan Bilovol MODULE_DESCRIPTION("USB gadget \"ALSA sound card\" utilities"); 663eb9fecb9SRuslan Bilovol MODULE_AUTHOR("Ruslan Bilovol"); 664