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