Commit | Line | Data |
---|---|---|
a52932b4 MR |
1 | /* |
2 | * Empiatech em28x1 audio extension | |
3 | * | |
4 | * Copyright (C) 2006 Markus Rechberger <mrechberger@gmail.com> | |
5 | * | |
f5f894d1 | 6 | * Copyright (C) 2007-2014 Mauro Carvalho Chehab |
6d79468d | 7 | * - Port to work with the in-kernel driver |
4f83e7b3 | 8 | * - Cleanups, fixes, alsa-controls, etc. |
6d79468d | 9 | * |
a52932b4 MR |
10 | * This driver is based on my previous au600 usb pstn audio driver |
11 | * and inherits all the copyrights | |
12 | * | |
13 | * This program is free software; you can redistribute it and/or modify | |
14 | * it under the terms of the GNU General Public License as published by | |
15 | * the Free Software Foundation; either version 2 of the License, or | |
16 | * (at your option) any later version. | |
17 | * | |
18 | * This program is distributed in the hope that it will be useful, | |
19 | * but WITHOUT ANY WARRANTY; without even the implied warranty of | |
20 | * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the | |
21 | * GNU General Public License for more details. | |
22 | * | |
23 | * You should have received a copy of the GNU General Public License | |
24 | * along with this program; if not, write to the Free Software | |
25 | * Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA. | |
26 | */ | |
27 | ||
28 | #include <linux/kernel.h> | |
29 | #include <linux/usb.h> | |
30 | #include <linux/init.h> | |
31 | #include <linux/sound.h> | |
32 | #include <linux/spinlock.h> | |
33 | #include <linux/soundcard.h> | |
34 | #include <linux/slab.h> | |
35 | #include <linux/vmalloc.h> | |
36 | #include <linux/proc_fs.h> | |
6d79468d | 37 | #include <linux/module.h> |
a52932b4 MR |
38 | #include <sound/core.h> |
39 | #include <sound/pcm.h> | |
40 | #include <sound/pcm_params.h> | |
41 | #include <sound/info.h> | |
42 | #include <sound/initval.h> | |
43 | #include <sound/control.h> | |
850d24a5 | 44 | #include <sound/tlv.h> |
67b8d033 | 45 | #include <sound/ac97_codec.h> |
a52932b4 MR |
46 | #include <media/v4l2-common.h> |
47 | #include "em28xx.h" | |
48 | ||
6d79468d MCC |
49 | static int debug; |
50 | module_param(debug, int, 0644); | |
51 | MODULE_PARM_DESC(debug, "activates debug info"); | |
a52932b4 | 52 | |
1b3fd2d3 MCC |
53 | #define EM28XX_MAX_AUDIO_BUFS 5 |
54 | #define EM28XX_MIN_AUDIO_PACKETS 64 | |
49677aef | 55 | |
6d79468d MCC |
56 | #define dprintk(fmt, arg...) do { \ |
57 | if (debug) \ | |
58 | printk(KERN_INFO "em28xx-audio %s: " fmt, \ | |
d80e134d | 59 | __func__, ##arg); \ |
6d79468d | 60 | } while (0) |
a52932b4 | 61 | |
6d79468d | 62 | static int index[SNDRV_CARDS] = SNDRV_DEFAULT_IDX; |
a52932b4 | 63 | |
aa5a1821 | 64 | static int em28xx_deinit_isoc_audio(struct em28xx *dev) |
a52932b4 | 65 | { |
6d79468d | 66 | int i; |
a52932b4 | 67 | |
6d79468d | 68 | dprintk("Stopping isoc\n"); |
1b3fd2d3 | 69 | for (i = 0; i < dev->adev.num_urb; i++) { |
46c704d7 MCC |
70 | struct urb *urb = dev->adev.urb[i]; |
71 | ||
9c06210b | 72 | if (!irqs_disabled()) |
46c704d7 | 73 | usb_kill_urb(urb); |
9c06210b | 74 | else |
46c704d7 | 75 | usb_unlink_urb(urb); |
a52932b4 | 76 | } |
a52932b4 | 77 | |
a52932b4 MR |
78 | return 0; |
79 | } | |
80 | ||
a52932b4 MR |
81 | static void em28xx_audio_isocirq(struct urb *urb) |
82 | { | |
6d79468d MCC |
83 | struct em28xx *dev = urb->context; |
84 | int i; | |
85 | unsigned int oldptr; | |
6d79468d MCC |
86 | int period_elapsed = 0; |
87 | int status; | |
88 | unsigned char *cp; | |
89 | unsigned int stride; | |
a52932b4 | 90 | struct snd_pcm_substream *substream; |
6d79468d | 91 | struct snd_pcm_runtime *runtime; |
aa5a1821 | 92 | |
8b1fa579 MCC |
93 | if (dev->disconnected) { |
94 | dprintk("device disconnected while streaming. URB status=%d.\n", urb->status); | |
95 | atomic_set(&dev->stream_started, 0); | |
96 | return; | |
97 | } | |
98 | ||
aa5a1821 RK |
99 | switch (urb->status) { |
100 | case 0: /* success */ | |
101 | case -ETIMEDOUT: /* NAK */ | |
102 | break; | |
103 | case -ECONNRESET: /* kill */ | |
104 | case -ENOENT: | |
105 | case -ESHUTDOWN: | |
106 | return; | |
107 | default: /* error */ | |
108 | dprintk("urb completition error %d.\n", urb->status); | |
109 | break; | |
110 | } | |
111 | ||
39a96b4c MCC |
112 | if (atomic_read(&dev->stream_started) == 0) |
113 | return; | |
114 | ||
9baed99e MCC |
115 | if (dev->adev.capture_pcm_substream) { |
116 | substream = dev->adev.capture_pcm_substream; | |
1a6f11e0 | 117 | runtime = substream->runtime; |
a52932b4 | 118 | stride = runtime->frame_bits >> 3; |
6d79468d | 119 | |
1a6f11e0 MCC |
120 | for (i = 0; i < urb->number_of_packets; i++) { |
121 | int length = | |
122 | urb->iso_frame_desc[i].actual_length / stride; | |
123 | cp = (unsigned char *)urb->transfer_buffer + | |
124 | urb->iso_frame_desc[i].offset; | |
a52932b4 | 125 | |
1a6f11e0 | 126 | if (!length) |
a52932b4 MR |
127 | continue; |
128 | ||
9baed99e | 129 | oldptr = dev->adev.hwptr_done_capture; |
50f3beb5 MCC |
130 | if (oldptr + length >= runtime->buffer_size) { |
131 | unsigned int cnt = | |
132 | runtime->buffer_size - oldptr; | |
133 | memcpy(runtime->dma_area + oldptr * stride, cp, | |
134 | cnt * stride); | |
135 | memcpy(runtime->dma_area, cp + cnt * stride, | |
136 | length * stride - cnt * stride); | |
137 | } else { | |
138 | memcpy(runtime->dma_area + oldptr * stride, cp, | |
139 | length * stride); | |
140 | } | |
141 | ||
50f3beb5 | 142 | snd_pcm_stream_lock(substream); |
50f3beb5 | 143 | |
9baed99e MCC |
144 | dev->adev.hwptr_done_capture += length; |
145 | if (dev->adev.hwptr_done_capture >= | |
1a6f11e0 | 146 | runtime->buffer_size) |
9baed99e | 147 | dev->adev.hwptr_done_capture -= |
1a6f11e0 | 148 | runtime->buffer_size; |
a52932b4 | 149 | |
9baed99e MCC |
150 | dev->adev.capture_transfer_done += length; |
151 | if (dev->adev.capture_transfer_done >= | |
1a6f11e0 | 152 | runtime->period_size) { |
9baed99e | 153 | dev->adev.capture_transfer_done -= |
1a6f11e0 MCC |
154 | runtime->period_size; |
155 | period_elapsed = 1; | |
a52932b4 | 156 | } |
6d79468d | 157 | |
50f3beb5 | 158 | snd_pcm_stream_unlock(substream); |
a52932b4 | 159 | } |
6d79468d | 160 | if (period_elapsed) |
a52932b4 | 161 | snd_pcm_period_elapsed(substream); |
a52932b4 MR |
162 | } |
163 | urb->status = 0; | |
1a6f11e0 | 164 | |
6d79468d MCC |
165 | status = usb_submit_urb(urb, GFP_ATOMIC); |
166 | if (status < 0) { | |
1a6f11e0 MCC |
167 | em28xx_errdev("resubmit of audio urb failed (error=%i)\n", |
168 | status); | |
a52932b4 MR |
169 | } |
170 | return; | |
171 | } | |
172 | ||
a52932b4 MR |
173 | static int em28xx_init_audio_isoc(struct em28xx *dev) |
174 | { | |
6d79468d | 175 | int i, errCode; |
6d79468d MCC |
176 | |
177 | dprintk("Starting isoc transfers\n"); | |
a52932b4 | 178 | |
f5f894d1 | 179 | /* Start streaming */ |
1b3fd2d3 | 180 | for (i = 0; i < dev->adev.num_urb; i++) { |
f5f894d1 MCC |
181 | memset(dev->adev.transfer_buffer[i], 0x80, |
182 | dev->adev.urb[i]->transfer_buffer_length); | |
6d79468d | 183 | |
9baed99e | 184 | errCode = usb_submit_urb(dev->adev.urb[i], GFP_ATOMIC); |
1a6f11e0 | 185 | if (errCode) { |
debb7241 | 186 | em28xx_errdev("submit of audio urb failed\n"); |
aa5a1821 | 187 | em28xx_deinit_isoc_audio(dev); |
debb7241 | 188 | atomic_set(&dev->stream_started, 0); |
a52932b4 MR |
189 | return errCode; |
190 | } | |
debb7241 | 191 | |
a52932b4 | 192 | } |
6d79468d | 193 | |
a52932b4 MR |
194 | return 0; |
195 | } | |
196 | ||
6d79468d MCC |
197 | static int snd_pcm_alloc_vmalloc_buffer(struct snd_pcm_substream *subs, |
198 | size_t size) | |
199 | { | |
200 | struct snd_pcm_runtime *runtime = subs->runtime; | |
201 | ||
a1a6ee74 | 202 | dprintk("Allocating vbuffer\n"); |
6d79468d MCC |
203 | if (runtime->dma_area) { |
204 | if (runtime->dma_bytes > size) | |
205 | return 0; | |
206 | ||
207 | vfree(runtime->dma_area); | |
208 | } | |
209 | runtime->dma_area = vmalloc(size); | |
210 | if (!runtime->dma_area) | |
211 | return -ENOMEM; | |
212 | ||
213 | runtime->dma_bytes = size; | |
214 | ||
215 | return 0; | |
216 | } | |
217 | ||
218 | static struct snd_pcm_hardware snd_em28xx_hw_capture = { | |
219 | .info = SNDRV_PCM_INFO_BLOCK_TRANSFER | | |
220 | SNDRV_PCM_INFO_MMAP | | |
221 | SNDRV_PCM_INFO_INTERLEAVED | | |
dff0f8c2 | 222 | SNDRV_PCM_INFO_BATCH | |
6d79468d MCC |
223 | SNDRV_PCM_INFO_MMAP_VALID, |
224 | ||
225 | .formats = SNDRV_PCM_FMTBIT_S16_LE, | |
226 | ||
49677aef | 227 | .rates = SNDRV_PCM_RATE_48000, |
6d79468d MCC |
228 | |
229 | .rate_min = 48000, | |
230 | .rate_max = 48000, | |
231 | .channels_min = 2, | |
232 | .channels_max = 2, | |
233 | .buffer_bytes_max = 62720 * 8, /* just about the value in usbaudio.c */ | |
49677aef MCC |
234 | |
235 | ||
236 | /* | |
237 | * The period is 12.288 bytes. Allow a 10% of variation along its | |
238 | * value, in order to avoid overruns/underruns due to some clock | |
239 | * drift. | |
240 | * | |
241 | * FIXME: This period assumes 64 packets, and a 48000 PCM rate. | |
242 | * Calculate it dynamically. | |
243 | */ | |
244 | .period_bytes_min = 11059, | |
245 | .period_bytes_max = 13516, | |
246 | ||
6d79468d MCC |
247 | .periods_min = 2, |
248 | .periods_max = 98, /* 12544, */ | |
249 | }; | |
250 | ||
251 | static int snd_em28xx_capture_open(struct snd_pcm_substream *substream) | |
252 | { | |
253 | struct em28xx *dev = snd_pcm_substream_chip(substream); | |
254 | struct snd_pcm_runtime *runtime = substream->runtime; | |
255 | int ret = 0; | |
256 | ||
83ee87a3 | 257 | if (!dev) { |
0bc23083 | 258 | em28xx_err("BUG: em28xx can't find device struct." |
83ee87a3 MCC |
259 | " Can't proceed with open\n"); |
260 | return -ENODEV; | |
261 | } | |
262 | ||
8b1fa579 MCC |
263 | if (dev->disconnected) |
264 | return -ENODEV; | |
265 | ||
266 | dprintk("opening device and trying to acquire exclusive lock\n"); | |
267 | ||
4f83e7b3 MCC |
268 | runtime->hw = snd_em28xx_hw_capture; |
269 | if ((dev->alt == 0 || dev->audio_ifnum) && dev->adev.users == 0) { | |
34906633 MCC |
270 | int nonblock = !!(substream->f_flags & O_NONBLOCK); |
271 | ||
272 | if (nonblock) { | |
273 | if (!mutex_trylock(&dev->lock)) | |
274 | return -EAGAIN; | |
275 | } else | |
276 | mutex_lock(&dev->lock); | |
4f83e7b3 MCC |
277 | if (dev->audio_ifnum) |
278 | dev->alt = 1; | |
279 | else | |
280 | dev->alt = 7; | |
92ea42f4 | 281 | |
4f83e7b3 MCC |
282 | dprintk("changing alternate number on interface %d to %d\n", |
283 | dev->audio_ifnum, dev->alt); | |
284 | usb_set_interface(dev->udev, dev->audio_ifnum, dev->alt); | |
6d79468d | 285 | |
4f83e7b3 MCC |
286 | /* Sets volume, mute, etc */ |
287 | dev->mute = 0; | |
4f83e7b3 MCC |
288 | ret = em28xx_audio_analog_set(dev); |
289 | if (ret < 0) | |
290 | goto err; | |
6d79468d | 291 | |
4f83e7b3 MCC |
292 | dev->adev.users++; |
293 | mutex_unlock(&dev->lock); | |
294 | } | |
6d79468d MCC |
295 | |
296 | snd_pcm_hw_constraint_integer(runtime, SNDRV_PCM_HW_PARAM_PERIODS); | |
9baed99e | 297 | dev->adev.capture_pcm_substream = substream; |
6d79468d MCC |
298 | |
299 | return 0; | |
300 | err: | |
39a96b4c MCC |
301 | mutex_unlock(&dev->lock); |
302 | ||
0bc23083 | 303 | em28xx_err("Error while configuring em28xx mixer\n"); |
6d79468d MCC |
304 | return ret; |
305 | } | |
306 | ||
307 | static int snd_em28xx_pcm_close(struct snd_pcm_substream *substream) | |
308 | { | |
309 | struct em28xx *dev = snd_pcm_substream_chip(substream); | |
6d79468d MCC |
310 | |
311 | dprintk("closing device\n"); | |
312 | ||
313 | dev->mute = 1; | |
92ea42f4 | 314 | mutex_lock(&dev->lock); |
bf510ac3 | 315 | dev->adev.users--; |
39a96b4c MCC |
316 | if (atomic_read(&dev->stream_started) > 0) { |
317 | atomic_set(&dev->stream_started, 0); | |
318 | schedule_work(&dev->wq_trigger); | |
319 | } | |
320 | ||
6d79468d | 321 | em28xx_audio_analog_set(dev); |
75c74d1c RK |
322 | if (substream->runtime->dma_area) { |
323 | dprintk("freeing\n"); | |
324 | vfree(substream->runtime->dma_area); | |
325 | substream->runtime->dma_area = NULL; | |
326 | } | |
92ea42f4 | 327 | mutex_unlock(&dev->lock); |
6d79468d | 328 | |
6d79468d MCC |
329 | return 0; |
330 | } | |
331 | ||
332 | static int snd_em28xx_hw_capture_params(struct snd_pcm_substream *substream, | |
333 | struct snd_pcm_hw_params *hw_params) | |
334 | { | |
6d79468d | 335 | int ret; |
8b1fa579 MCC |
336 | struct em28xx *dev = snd_pcm_substream_chip(substream); |
337 | ||
338 | if (dev->disconnected) | |
339 | return -ENODEV; | |
6d79468d MCC |
340 | |
341 | dprintk("Setting capture parameters\n"); | |
342 | ||
343 | ret = snd_pcm_alloc_vmalloc_buffer(substream, | |
344 | params_buffer_bytes(hw_params)); | |
00d2e7ad MCC |
345 | if (ret < 0) |
346 | return ret; | |
e92ba283 HV |
347 | #if 0 |
348 | /* TODO: set up em28xx audio chip to deliver the correct audio format, | |
349 | current default is 48000hz multiplexed => 96000hz mono | |
350 | which shouldn't matter since analogue TV only supports mono */ | |
351 | unsigned int channels, rate, format; | |
352 | ||
6d79468d MCC |
353 | format = params_format(hw_params); |
354 | rate = params_rate(hw_params); | |
355 | channels = params_channels(hw_params); | |
e92ba283 | 356 | #endif |
6d79468d | 357 | |
6d79468d MCC |
358 | return 0; |
359 | } | |
360 | ||
361 | static int snd_em28xx_hw_capture_free(struct snd_pcm_substream *substream) | |
362 | { | |
363 | struct em28xx *dev = snd_pcm_substream_chip(substream); | |
364 | ||
365 | dprintk("Stop capture, if needed\n"); | |
366 | ||
39a96b4c MCC |
367 | if (atomic_read(&dev->stream_started) > 0) { |
368 | atomic_set(&dev->stream_started, 0); | |
369 | schedule_work(&dev->wq_trigger); | |
370 | } | |
6d79468d MCC |
371 | |
372 | return 0; | |
373 | } | |
374 | ||
375 | static int snd_em28xx_prepare(struct snd_pcm_substream *substream) | |
376 | { | |
96fbf771 DH |
377 | struct em28xx *dev = snd_pcm_substream_chip(substream); |
378 | ||
8b1fa579 MCC |
379 | if (dev->disconnected) |
380 | return -ENODEV; | |
381 | ||
96fbf771 DH |
382 | dev->adev.hwptr_done_capture = 0; |
383 | dev->adev.capture_transfer_done = 0; | |
384 | ||
6d79468d MCC |
385 | return 0; |
386 | } | |
387 | ||
39a96b4c MCC |
388 | static void audio_trigger(struct work_struct *work) |
389 | { | |
390 | struct em28xx *dev = container_of(work, struct em28xx, wq_trigger); | |
391 | ||
392 | if (atomic_read(&dev->stream_started)) { | |
393 | dprintk("starting capture"); | |
394 | em28xx_init_audio_isoc(dev); | |
395 | } else { | |
396 | dprintk("stopping capture"); | |
397 | em28xx_deinit_isoc_audio(dev); | |
398 | } | |
399 | } | |
400 | ||
6d79468d MCC |
401 | static int snd_em28xx_capture_trigger(struct snd_pcm_substream *substream, |
402 | int cmd) | |
403 | { | |
404 | struct em28xx *dev = snd_pcm_substream_chip(substream); | |
00d2e7ad | 405 | int retval = 0; |
6d79468d | 406 | |
8b1fa579 MCC |
407 | if (dev->disconnected) |
408 | return -ENODEV; | |
409 | ||
6d79468d | 410 | switch (cmd) { |
dff0f8c2 MCC |
411 | case SNDRV_PCM_TRIGGER_PAUSE_RELEASE: /* fall through */ |
412 | case SNDRV_PCM_TRIGGER_RESUME: /* fall through */ | |
6d79468d | 413 | case SNDRV_PCM_TRIGGER_START: |
39a96b4c | 414 | atomic_set(&dev->stream_started, 1); |
df39ca64 | 415 | break; |
dff0f8c2 MCC |
416 | case SNDRV_PCM_TRIGGER_PAUSE_PUSH: /* fall through */ |
417 | case SNDRV_PCM_TRIGGER_SUSPEND: /* fall through */ | |
6d79468d | 418 | case SNDRV_PCM_TRIGGER_STOP: |
dff0f8c2 | 419 | atomic_set(&dev->stream_started, 0); |
df39ca64 | 420 | break; |
6d79468d | 421 | default: |
df39ca64 | 422 | retval = -EINVAL; |
6d79468d | 423 | } |
39a96b4c | 424 | schedule_work(&dev->wq_trigger); |
00d2e7ad | 425 | return retval; |
6d79468d MCC |
426 | } |
427 | ||
1a6f11e0 MCC |
428 | static snd_pcm_uframes_t snd_em28xx_capture_pointer(struct snd_pcm_substream |
429 | *substream) | |
a52932b4 | 430 | { |
a1a6ee74 | 431 | unsigned long flags; |
53d12e5a | 432 | struct em28xx *dev; |
a52932b4 | 433 | snd_pcm_uframes_t hwptr_done; |
53d12e5a | 434 | |
a52932b4 | 435 | dev = snd_pcm_substream_chip(substream); |
8b1fa579 | 436 | if (dev->disconnected) |
229295f1 | 437 | return SNDRV_PCM_POS_XRUN; |
8b1fa579 | 438 | |
00bc0645 | 439 | spin_lock_irqsave(&dev->adev.slock, flags); |
9baed99e | 440 | hwptr_done = dev->adev.hwptr_done_capture; |
00bc0645 | 441 | spin_unlock_irqrestore(&dev->adev.slock, flags); |
6d79468d | 442 | |
a52932b4 MR |
443 | return hwptr_done; |
444 | } | |
445 | ||
446 | static struct page *snd_pcm_get_vmalloc_page(struct snd_pcm_substream *subs, | |
447 | unsigned long offset) | |
448 | { | |
449 | void *pageptr = subs->runtime->dma_area + offset; | |
6d79468d | 450 | |
a52932b4 MR |
451 | return vmalloc_to_page(pageptr); |
452 | } | |
453 | ||
850d24a5 MCC |
454 | /* |
455 | * AC97 volume control support | |
456 | */ | |
457 | static int em28xx_vol_info(struct snd_kcontrol *kcontrol, | |
458 | struct snd_ctl_elem_info *info) | |
459 | { | |
8b1fa579 MCC |
460 | struct em28xx *dev = snd_kcontrol_chip(kcontrol); |
461 | ||
462 | if (dev->disconnected) | |
463 | return -ENODEV; | |
464 | ||
850d24a5 MCC |
465 | info->type = SNDRV_CTL_ELEM_TYPE_INTEGER; |
466 | info->count = 2; | |
467 | info->value.integer.min = 0; | |
468 | info->value.integer.max = 0x1f; | |
469 | ||
470 | return 0; | |
471 | } | |
472 | ||
850d24a5 MCC |
473 | static int em28xx_vol_put(struct snd_kcontrol *kcontrol, |
474 | struct snd_ctl_elem_value *value) | |
475 | { | |
476 | struct em28xx *dev = snd_kcontrol_chip(kcontrol); | |
34906633 | 477 | struct snd_pcm_substream *substream = dev->adev.capture_pcm_substream; |
71d7d83e MCC |
478 | u16 val = (0x1f - (value->value.integer.value[0] & 0x1f)) | |
479 | (0x1f - (value->value.integer.value[1] & 0x1f)) << 8; | |
34906633 | 480 | int nonblock = 0; |
850d24a5 MCC |
481 | int rc; |
482 | ||
8b1fa579 MCC |
483 | if (dev->disconnected) |
484 | return -ENODEV; | |
485 | ||
34906633 MCC |
486 | if (substream) |
487 | nonblock = !!(substream->f_flags & O_NONBLOCK); | |
488 | if (nonblock) { | |
489 | if (!mutex_trylock(&dev->lock)) | |
490 | return -EAGAIN; | |
491 | } else | |
492 | mutex_lock(&dev->lock); | |
850d24a5 MCC |
493 | rc = em28xx_read_ac97(dev, kcontrol->private_value); |
494 | if (rc < 0) | |
495 | goto err; | |
496 | ||
43131a2c | 497 | val |= rc & 0x8000; /* Preserve the mute flag */ |
850d24a5 MCC |
498 | |
499 | rc = em28xx_write_ac97(dev, kcontrol->private_value, val); | |
66cb6957 MCC |
500 | if (rc < 0) |
501 | goto err; | |
502 | ||
503 | dprintk("%sleft vol %d, right vol %d (0x%04x) to ac97 volume control 0x%04x\n", | |
504 | (val & 0x8000) ? "muted " : "", | |
505 | 0x1f - ((val >> 8) & 0x1f), 0x1f - (val & 0x1f), | |
506 | val, (int)kcontrol->private_value); | |
850d24a5 MCC |
507 | |
508 | err: | |
509 | mutex_unlock(&dev->lock); | |
510 | return rc; | |
511 | } | |
512 | ||
513 | static int em28xx_vol_get(struct snd_kcontrol *kcontrol, | |
514 | struct snd_ctl_elem_value *value) | |
515 | { | |
516 | struct em28xx *dev = snd_kcontrol_chip(kcontrol); | |
34906633 MCC |
517 | struct snd_pcm_substream *substream = dev->adev.capture_pcm_substream; |
518 | int nonblock = 0; | |
850d24a5 MCC |
519 | int val; |
520 | ||
8b1fa579 MCC |
521 | if (dev->disconnected) |
522 | return -ENODEV; | |
523 | ||
34906633 MCC |
524 | if (substream) |
525 | nonblock = !!(substream->f_flags & O_NONBLOCK); | |
526 | if (nonblock) { | |
527 | if (!mutex_trylock(&dev->lock)) | |
528 | return -EAGAIN; | |
529 | } else | |
530 | mutex_lock(&dev->lock); | |
850d24a5 MCC |
531 | val = em28xx_read_ac97(dev, kcontrol->private_value); |
532 | mutex_unlock(&dev->lock); | |
533 | if (val < 0) | |
534 | return val; | |
535 | ||
66cb6957 MCC |
536 | dprintk("%sleft vol %d, right vol %d (0x%04x) from ac97 volume control 0x%04x\n", |
537 | (val & 0x8000) ? "muted " : "", | |
538 | 0x1f - ((val >> 8) & 0x1f), 0x1f - (val & 0x1f), | |
539 | val, (int)kcontrol->private_value); | |
540 | ||
71d7d83e MCC |
541 | value->value.integer.value[0] = 0x1f - (val & 0x1f); |
542 | value->value.integer.value[1] = 0x1f - ((val << 8) & 0x1f); | |
850d24a5 MCC |
543 | |
544 | return 0; | |
545 | } | |
546 | ||
43131a2c MCC |
547 | static int em28xx_vol_put_mute(struct snd_kcontrol *kcontrol, |
548 | struct snd_ctl_elem_value *value) | |
549 | { | |
550 | struct em28xx *dev = snd_kcontrol_chip(kcontrol); | |
551 | u16 val = value->value.integer.value[0]; | |
34906633 MCC |
552 | struct snd_pcm_substream *substream = dev->adev.capture_pcm_substream; |
553 | int nonblock = 0; | |
43131a2c MCC |
554 | int rc; |
555 | ||
8b1fa579 MCC |
556 | if (dev->disconnected) |
557 | return -ENODEV; | |
558 | ||
34906633 MCC |
559 | if (substream) |
560 | nonblock = !!(substream->f_flags & O_NONBLOCK); | |
561 | if (nonblock) { | |
562 | if (!mutex_trylock(&dev->lock)) | |
563 | return -EAGAIN; | |
564 | } else | |
565 | mutex_lock(&dev->lock); | |
43131a2c MCC |
566 | rc = em28xx_read_ac97(dev, kcontrol->private_value); |
567 | if (rc < 0) | |
568 | goto err; | |
569 | ||
570 | if (val) | |
71d7d83e | 571 | rc &= 0x1f1f; |
43131a2c | 572 | else |
71d7d83e | 573 | rc |= 0x8000; |
43131a2c MCC |
574 | |
575 | rc = em28xx_write_ac97(dev, kcontrol->private_value, rc); | |
66cb6957 MCC |
576 | if (rc < 0) |
577 | goto err; | |
578 | ||
579 | dprintk("%sleft vol %d, right vol %d (0x%04x) to ac97 volume control 0x%04x\n", | |
580 | (val & 0x8000) ? "muted " : "", | |
581 | 0x1f - ((val >> 8) & 0x1f), 0x1f - (val & 0x1f), | |
582 | val, (int)kcontrol->private_value); | |
43131a2c MCC |
583 | |
584 | err: | |
585 | mutex_unlock(&dev->lock); | |
586 | return rc; | |
587 | } | |
588 | ||
589 | static int em28xx_vol_get_mute(struct snd_kcontrol *kcontrol, | |
590 | struct snd_ctl_elem_value *value) | |
591 | { | |
592 | struct em28xx *dev = snd_kcontrol_chip(kcontrol); | |
34906633 MCC |
593 | struct snd_pcm_substream *substream = dev->adev.capture_pcm_substream; |
594 | int nonblock = 0; | |
43131a2c MCC |
595 | int val; |
596 | ||
8b1fa579 MCC |
597 | if (dev->disconnected) |
598 | return -ENODEV; | |
599 | ||
34906633 MCC |
600 | if (substream) |
601 | nonblock = !!(substream->f_flags & O_NONBLOCK); | |
602 | if (nonblock) { | |
603 | if (!mutex_trylock(&dev->lock)) | |
604 | return -EAGAIN; | |
605 | } else | |
606 | mutex_lock(&dev->lock); | |
43131a2c MCC |
607 | val = em28xx_read_ac97(dev, kcontrol->private_value); |
608 | mutex_unlock(&dev->lock); | |
609 | if (val < 0) | |
610 | return val; | |
611 | ||
612 | if (val & 0x8000) | |
43131a2c | 613 | value->value.integer.value[0] = 0; |
71d7d83e MCC |
614 | else |
615 | value->value.integer.value[0] = 1; | |
43131a2c | 616 | |
66cb6957 MCC |
617 | dprintk("%sleft vol %d, right vol %d (0x%04x) from ac97 volume control 0x%04x\n", |
618 | (val & 0x8000) ? "muted " : "", | |
619 | 0x1f - ((val >> 8) & 0x1f), 0x1f - (val & 0x1f), | |
620 | val, (int)kcontrol->private_value); | |
621 | ||
43131a2c MCC |
622 | return 0; |
623 | } | |
624 | ||
850d24a5 MCC |
625 | static const DECLARE_TLV_DB_SCALE(em28xx_db_scale, -3450, 150, 0); |
626 | ||
627 | static int em28xx_cvol_new(struct snd_card *card, struct em28xx *dev, | |
628 | char *name, int id) | |
629 | { | |
630 | int err; | |
43131a2c | 631 | char ctl_name[44]; |
850d24a5 | 632 | struct snd_kcontrol *kctl; |
43131a2c MCC |
633 | struct snd_kcontrol_new tmp; |
634 | ||
635 | memset (&tmp, 0, sizeof(tmp)); | |
636 | tmp.iface = SNDRV_CTL_ELEM_IFACE_MIXER, | |
637 | tmp.private_value = id, | |
638 | tmp.name = ctl_name, | |
639 | ||
640 | /* Add Mute Control */ | |
641 | sprintf(ctl_name, "%s Switch", name); | |
642 | tmp.get = em28xx_vol_get_mute; | |
643 | tmp.put = em28xx_vol_put_mute; | |
644 | tmp.info = snd_ctl_boolean_mono_info; | |
850d24a5 | 645 | kctl = snd_ctl_new1(&tmp, dev); |
43131a2c MCC |
646 | err = snd_ctl_add(card, kctl); |
647 | if (err < 0) | |
648 | return err; | |
66cb6957 MCC |
649 | dprintk("Added control %s for ac97 volume control 0x%04x\n", |
650 | ctl_name, id); | |
850d24a5 | 651 | |
43131a2c MCC |
652 | memset (&tmp, 0, sizeof(tmp)); |
653 | tmp.iface = SNDRV_CTL_ELEM_IFACE_MIXER, | |
654 | tmp.private_value = id, | |
655 | tmp.name = ctl_name, | |
656 | ||
657 | /* Add Volume Control */ | |
658 | sprintf(ctl_name, "%s Volume", name); | |
659 | tmp.get = em28xx_vol_get; | |
660 | tmp.put = em28xx_vol_put; | |
661 | tmp.info = em28xx_vol_info; | |
662 | tmp.tlv.p = em28xx_db_scale, | |
663 | kctl = snd_ctl_new1(&tmp, dev); | |
850d24a5 MCC |
664 | err = snd_ctl_add(card, kctl); |
665 | if (err < 0) | |
666 | return err; | |
66cb6957 MCC |
667 | dprintk("Added control %s for ac97 volume control 0x%04x\n", |
668 | ctl_name, id); | |
850d24a5 MCC |
669 | |
670 | return 0; | |
671 | } | |
672 | ||
850d24a5 MCC |
673 | /* |
674 | * register/unregister code and data | |
675 | */ | |
a52932b4 | 676 | static struct snd_pcm_ops snd_em28xx_pcm_capture = { |
6d79468d MCC |
677 | .open = snd_em28xx_capture_open, |
678 | .close = snd_em28xx_pcm_close, | |
679 | .ioctl = snd_pcm_lib_ioctl, | |
a52932b4 | 680 | .hw_params = snd_em28xx_hw_capture_params, |
6d79468d MCC |
681 | .hw_free = snd_em28xx_hw_capture_free, |
682 | .prepare = snd_em28xx_prepare, | |
683 | .trigger = snd_em28xx_capture_trigger, | |
684 | .pointer = snd_em28xx_capture_pointer, | |
685 | .page = snd_pcm_get_vmalloc_page, | |
a52932b4 MR |
686 | }; |
687 | ||
f5f894d1 MCC |
688 | static void em28xx_audio_free_urb(struct em28xx *dev) |
689 | { | |
690 | int i; | |
691 | ||
1b3fd2d3 | 692 | for (i = 0; i < dev->adev.num_urb; i++) { |
f5f894d1 MCC |
693 | struct urb *urb = dev->adev.urb[i]; |
694 | ||
1b3fd2d3 | 695 | if (!urb) |
f5f894d1 MCC |
696 | continue; |
697 | ||
1b3fd2d3 MCC |
698 | if (dev->adev.transfer_buffer[i]) |
699 | usb_free_coherent(dev->udev, | |
700 | urb->transfer_buffer_length, | |
701 | dev->adev.transfer_buffer[i], | |
702 | urb->transfer_dma); | |
f5f894d1 MCC |
703 | |
704 | usb_free_urb(urb); | |
f5f894d1 | 705 | } |
1b3fd2d3 MCC |
706 | kfree(dev->adev.urb); |
707 | kfree(dev->adev.transfer_buffer); | |
708 | dev->adev.num_urb = 0; | |
709 | } | |
710 | ||
711 | /* high bandwidth multiplier, as encoded in highspeed endpoint descriptors */ | |
712 | static int em28xx_audio_ep_packet_size(struct usb_device *udev, | |
713 | struct usb_endpoint_descriptor *e) | |
714 | { | |
715 | int size = le16_to_cpu(e->wMaxPacketSize); | |
716 | ||
717 | if (udev->speed == USB_SPEED_HIGH) | |
718 | return (size & 0x7ff) * (1 + (((size) >> 11) & 0x03)); | |
719 | ||
720 | return size & 0x7ff; | |
f5f894d1 MCC |
721 | } |
722 | ||
966f4163 | 723 | static int em28xx_audio_urb_init(struct em28xx *dev) |
a52932b4 | 724 | { |
d2849fa5 MCC |
725 | struct usb_interface *intf; |
726 | struct usb_endpoint_descriptor *e, *ep = NULL; | |
966f4163 | 727 | int i, ep_size, interval, num_urb, npackets; |
1b3fd2d3 | 728 | int urb_size, bytes_per_transfer; |
d2849fa5 | 729 | u8 alt; |
6d79468d | 730 | |
d2849fa5 MCC |
731 | if (dev->audio_ifnum) |
732 | alt = 1; | |
733 | else | |
734 | alt = 7; | |
735 | ||
736 | intf = usb_ifnum_to_if(dev->udev, dev->audio_ifnum); | |
737 | ||
738 | if (intf->num_altsetting <= alt) { | |
739 | em28xx_errdev("alt %d doesn't exist on interface %d\n", | |
740 | dev->audio_ifnum, alt); | |
741 | return -ENODEV; | |
742 | } | |
743 | ||
744 | for (i = 0; i < intf->altsetting[alt].desc.bNumEndpoints; i++) { | |
745 | e = &intf->altsetting[alt].endpoint[i].desc; | |
746 | if (!usb_endpoint_dir_in(e)) | |
747 | continue; | |
748 | if (e->bEndpointAddress == EM28XX_EP_AUDIO) { | |
749 | ep = e; | |
750 | break; | |
751 | } | |
752 | } | |
753 | ||
754 | if (!ep) { | |
755 | em28xx_errdev("Couldn't find an audio endpoint"); | |
756 | return -ENODEV; | |
757 | } | |
758 | ||
1b3fd2d3 MCC |
759 | ep_size = em28xx_audio_ep_packet_size(dev->udev, ep); |
760 | interval = 1 << (ep->bInterval - 1); | |
761 | ||
762 | em28xx_info("Endpoint 0x%02x %s on intf %d alt %d interval = %d, size %d\n", | |
763 | EM28XX_EP_AUDIO, usb_speed_string(dev->udev->speed), | |
764 | dev->audio_ifnum, alt, | |
765 | interval, | |
766 | ep_size); | |
767 | ||
768 | /* Calculate the number and size of URBs to better fit the audio samples */ | |
769 | ||
770 | /* | |
771 | * Estimate the number of bytes per DMA transfer. | |
772 | * | |
773 | * This is given by the bit rate (for now, only 48000 Hz) multiplied | |
774 | * by 2 channels and 2 bytes/sample divided by the number of microframe | |
775 | * intervals and by the microframe rate (125 us) | |
776 | */ | |
777 | bytes_per_transfer = DIV_ROUND_UP(48000 * 2 * 2, 125 * interval); | |
778 | ||
779 | /* | |
780 | * Estimate the number of transfer URBs. Don't let it go past the | |
781 | * maximum number of URBs that is known to be supported by the device. | |
782 | */ | |
783 | num_urb = DIV_ROUND_UP(bytes_per_transfer, ep_size); | |
784 | if (num_urb > EM28XX_MAX_AUDIO_BUFS) | |
785 | num_urb = EM28XX_MAX_AUDIO_BUFS; | |
786 | ||
787 | /* | |
788 | * Now that we know the number of bytes per transfer and the number of | |
789 | * URBs, estimate the typical size of an URB, in order to adjust the | |
790 | * minimal number of packets. | |
791 | */ | |
792 | urb_size = bytes_per_transfer / num_urb; | |
793 | ||
794 | /* | |
795 | * Now, calculate the amount of audio packets to be filled on each | |
796 | * URB. In order to preserve the old behaviour, use a minimal | |
797 | * threshold for this value. | |
798 | */ | |
799 | npackets = EM28XX_MIN_AUDIO_PACKETS; | |
800 | if (urb_size > ep_size * npackets) | |
801 | npackets = DIV_ROUND_UP(urb_size, ep_size); | |
802 | ||
803 | em28xx_info("Number of URBs: %d, with %d packets and %d size", | |
804 | num_urb, npackets, urb_size); | |
805 | ||
806 | /* Allocate space to store the number of URBs to be used */ | |
807 | ||
808 | dev->adev.transfer_buffer = kcalloc(num_urb, | |
809 | sizeof(*dev->adev.transfer_buffer), | |
810 | GFP_ATOMIC); | |
811 | if (!dev->adev.transfer_buffer) { | |
1b3fd2d3 MCC |
812 | return -ENOMEM; |
813 | } | |
814 | ||
815 | dev->adev.urb = kcalloc(num_urb, sizeof(*dev->adev.urb), GFP_ATOMIC); | |
816 | if (!dev->adev.urb) { | |
1b3fd2d3 MCC |
817 | kfree(dev->adev.transfer_buffer); |
818 | return -ENOMEM; | |
819 | } | |
820 | ||
821 | /* Alloc memory for each URB and for each transfer buffer */ | |
822 | dev->adev.num_urb = num_urb; | |
823 | for (i = 0; i < num_urb; i++) { | |
f5f894d1 MCC |
824 | struct urb *urb; |
825 | int j, k; | |
826 | void *buf; | |
827 | ||
1b3fd2d3 | 828 | urb = usb_alloc_urb(npackets, GFP_ATOMIC); |
f5f894d1 MCC |
829 | if (!urb) { |
830 | em28xx_errdev("usb_alloc_urb failed!\n"); | |
831 | em28xx_audio_free_urb(dev); | |
832 | return -ENOMEM; | |
833 | } | |
834 | dev->adev.urb[i] = urb; | |
835 | ||
1b3fd2d3 | 836 | buf = usb_alloc_coherent(dev->udev, npackets * ep_size, GFP_ATOMIC, |
f5f894d1 MCC |
837 | &urb->transfer_dma); |
838 | if (!buf) { | |
839 | em28xx_errdev("usb_alloc_coherent failed!\n"); | |
840 | em28xx_audio_free_urb(dev); | |
841 | return -ENOMEM; | |
842 | } | |
843 | dev->adev.transfer_buffer[i] = buf; | |
844 | ||
845 | urb->dev = dev->udev; | |
846 | urb->context = dev; | |
847 | urb->pipe = usb_rcvisocpipe(dev->udev, EM28XX_EP_AUDIO); | |
848 | urb->transfer_flags = URB_ISO_ASAP | URB_NO_TRANSFER_DMA_MAP; | |
1b3fd2d3 MCC |
849 | urb->transfer_buffer = buf; |
850 | urb->interval = interval; | |
f5f894d1 | 851 | urb->complete = em28xx_audio_isocirq; |
1b3fd2d3 MCC |
852 | urb->number_of_packets = npackets; |
853 | urb->transfer_buffer_length = ep_size * npackets; | |
d2849fa5 | 854 | |
1b3fd2d3 | 855 | for (j = k = 0; j < npackets; j++, k += ep_size) { |
f5f894d1 | 856 | urb->iso_frame_desc[j].offset = k; |
1b3fd2d3 | 857 | urb->iso_frame_desc[j].length = ep_size; |
f5f894d1 MCC |
858 | } |
859 | } | |
860 | ||
966f4163 MCC |
861 | return 0; |
862 | } | |
863 | ||
864 | static int em28xx_audio_init(struct em28xx *dev) | |
865 | { | |
866 | struct em28xx_audio *adev = &dev->adev; | |
867 | struct snd_pcm *pcm; | |
868 | struct snd_card *card; | |
869 | static int devnr; | |
870 | int err; | |
871 | ||
872 | if (!dev->has_alsa_audio || dev->audio_ifnum < 0) { | |
873 | /* This device does not support the extension (in this case | |
874 | the device is expecting the snd-usb-audio module or | |
875 | doesn't have analog audio support at all) */ | |
876 | return 0; | |
877 | } | |
878 | ||
879 | em28xx_info("Binding audio extension\n"); | |
880 | ||
881 | printk(KERN_INFO "em28xx-audio.c: Copyright (C) 2006 Markus " | |
882 | "Rechberger\n"); | |
883 | printk(KERN_INFO | |
884 | "em28xx-audio.c: Copyright (C) 2007-2014 Mauro Carvalho Chehab\n"); | |
885 | ||
886 | err = snd_card_create(index[devnr], "Em28xx Audio", THIS_MODULE, 0, | |
887 | &card); | |
888 | if (err < 0) | |
889 | return err; | |
890 | ||
891 | spin_lock_init(&adev->slock); | |
892 | adev->sndcard = card; | |
893 | adev->udev = dev->udev; | |
894 | ||
895 | err = snd_pcm_new(card, "Em28xx Audio", 0, 0, 1, &pcm); | |
896 | if (err < 0) { | |
897 | snd_card_free(card); | |
898 | return err; | |
899 | } | |
900 | ||
901 | snd_pcm_set_ops(pcm, SNDRV_PCM_STREAM_CAPTURE, &snd_em28xx_pcm_capture); | |
902 | pcm->info_flags = 0; | |
903 | pcm->private_data = dev; | |
904 | strcpy(pcm->name, "Empia 28xx Capture"); | |
905 | ||
906 | snd_card_set_dev(card, &dev->udev->dev); | |
907 | strcpy(card->driver, "Em28xx-Audio"); | |
908 | strcpy(card->shortname, "Em28xx Audio"); | |
909 | strcpy(card->longname, "Empia Em28xx Audio"); | |
910 | ||
911 | INIT_WORK(&dev->wq_trigger, audio_trigger); | |
912 | ||
913 | if (dev->audio_mode.ac97 != EM28XX_NO_AC97) { | |
914 | em28xx_cvol_new(card, dev, "Video", AC97_VIDEO); | |
915 | em28xx_cvol_new(card, dev, "Line In", AC97_LINE); | |
916 | em28xx_cvol_new(card, dev, "Phone", AC97_PHONE); | |
917 | em28xx_cvol_new(card, dev, "Microphone", AC97_MIC); | |
918 | em28xx_cvol_new(card, dev, "CD", AC97_CD); | |
919 | em28xx_cvol_new(card, dev, "AUX", AC97_AUX); | |
920 | em28xx_cvol_new(card, dev, "PCM", AC97_PCM); | |
921 | ||
922 | em28xx_cvol_new(card, dev, "Master", AC97_MASTER); | |
923 | em28xx_cvol_new(card, dev, "Line", AC97_HEADPHONE); | |
924 | em28xx_cvol_new(card, dev, "Mono", AC97_MASTER_MONO); | |
925 | em28xx_cvol_new(card, dev, "LFE", AC97_CENTER_LFE_MASTER); | |
926 | em28xx_cvol_new(card, dev, "Surround", AC97_SURROUND_MASTER); | |
927 | } | |
928 | ||
929 | err = em28xx_audio_urb_init(dev); | |
930 | if (err) { | |
931 | snd_card_free(card); | |
932 | return -ENODEV; | |
933 | } | |
934 | ||
6d79468d MCC |
935 | err = snd_card_register(card); |
936 | if (err < 0) { | |
439c491c | 937 | em28xx_audio_free_urb(dev); |
a52932b4 | 938 | snd_card_free(card); |
1f6340bd | 939 | return err; |
a52932b4 | 940 | } |
6d79468d | 941 | |
9634614f | 942 | em28xx_info("Audio extension successfully initialized\n"); |
a52932b4 MR |
943 | return 0; |
944 | } | |
945 | ||
946 | static int em28xx_audio_fini(struct em28xx *dev) | |
947 | { | |
1a6f11e0 | 948 | if (dev == NULL) |
a52932b4 | 949 | return 0; |
6d79468d | 950 | |
24a613e4 | 951 | if (dev->has_alsa_audio != 1) { |
df619181 | 952 | /* This device does not support the extension (in this case |
24a613e4 DH |
953 | the device is expecting the snd-usb-audio module or |
954 | doesn't have analog audio support at all) */ | |
df619181 DH |
955 | return 0; |
956 | } | |
957 | ||
f5f894d1 MCC |
958 | em28xx_audio_free_urb(dev); |
959 | ||
9baed99e MCC |
960 | if (dev->adev.sndcard) { |
961 | snd_card_free(dev->adev.sndcard); | |
962 | dev->adev.sndcard = NULL; | |
a52932b4 | 963 | } |
6d79468d | 964 | |
a52932b4 MR |
965 | return 0; |
966 | } | |
967 | ||
968 | static struct em28xx_ops audio_ops = { | |
6d79468d | 969 | .id = EM28XX_AUDIO, |
1a6f11e0 MCC |
970 | .name = "Em28xx Audio Extension", |
971 | .init = em28xx_audio_init, | |
972 | .fini = em28xx_audio_fini, | |
a52932b4 MR |
973 | }; |
974 | ||
975 | static int __init em28xx_alsa_register(void) | |
976 | { | |
a52932b4 MR |
977 | return em28xx_register_extension(&audio_ops); |
978 | } | |
979 | ||
980 | static void __exit em28xx_alsa_unregister(void) | |
981 | { | |
982 | em28xx_unregister_extension(&audio_ops); | |
983 | } | |
984 | ||
985 | MODULE_LICENSE("GPL"); | |
986 | MODULE_AUTHOR("Markus Rechberger <mrechberger@gmail.com>"); | |
4f83e7b3 | 987 | MODULE_AUTHOR("Mauro Carvalho Chehab <mchehab@redhat.com>"); |
d8992b09 MCC |
988 | MODULE_DESCRIPTION(DRIVER_DESC " - audio interface"); |
989 | MODULE_VERSION(EM28XX_VERSION); | |
a52932b4 MR |
990 | |
991 | module_init(em28xx_alsa_register); | |
992 | module_exit(em28xx_alsa_unregister); |