[media] em28xx: Don't initialize a var if won't be using it
[linux-2.6.git] / drivers / media / video / em28xx / em28xx-audio.c
bloba24e1770db489b307777954cb6f8b3b693d98dd5
1 /*
2 * Empiatech em28x1 audio extension
4 * Copyright (C) 2006 Markus Rechberger <mrechberger@gmail.com>
6 * Copyright (C) 2007 Mauro Carvalho Chehab <mchehab@infradead.org>
7 * - Port to work with the in-kernel driver
8 * - Several cleanups
10 * This driver is based on my previous au600 usb pstn audio driver
11 * and inherits all the copyrights
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.
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.
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.
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>
37 #include <linux/module.h>
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>
44 #include <media/v4l2-common.h>
45 #include "em28xx.h"
47 static int debug;
48 module_param(debug, int, 0644);
49 MODULE_PARM_DESC(debug, "activates debug info");
51 #define dprintk(fmt, arg...) do { \
52 if (debug) \
53 printk(KERN_INFO "em28xx-audio %s: " fmt, \
54 __func__, ##arg); \
55 } while (0)
57 static int index[SNDRV_CARDS] = SNDRV_DEFAULT_IDX;
59 static int em28xx_deinit_isoc_audio(struct em28xx *dev)
61 int i;
63 dprintk("Stopping isoc\n");
64 for (i = 0; i < EM28XX_AUDIO_BUFS; i++) {
65 if (!irqs_disabled())
66 usb_kill_urb(dev->adev.urb[i]);
67 else
68 usb_unlink_urb(dev->adev.urb[i]);
70 usb_free_urb(dev->adev.urb[i]);
71 dev->adev.urb[i] = NULL;
73 kfree(dev->adev.transfer_buffer[i]);
74 dev->adev.transfer_buffer[i] = NULL;
77 return 0;
80 static void em28xx_audio_isocirq(struct urb *urb)
82 struct em28xx *dev = urb->context;
83 int i;
84 unsigned int oldptr;
85 int period_elapsed = 0;
86 int status;
87 unsigned char *cp;
88 unsigned int stride;
89 struct snd_pcm_substream *substream;
90 struct snd_pcm_runtime *runtime;
92 switch (urb->status) {
93 case 0: /* success */
94 case -ETIMEDOUT: /* NAK */
95 break;
96 case -ECONNRESET: /* kill */
97 case -ENOENT:
98 case -ESHUTDOWN:
99 return;
100 default: /* error */
101 dprintk("urb completition error %d.\n", urb->status);
102 break;
105 if (atomic_read(&dev->stream_started) == 0)
106 return;
108 if (dev->adev.capture_pcm_substream) {
109 substream = dev->adev.capture_pcm_substream;
110 runtime = substream->runtime;
111 stride = runtime->frame_bits >> 3;
113 for (i = 0; i < urb->number_of_packets; i++) {
114 int length =
115 urb->iso_frame_desc[i].actual_length / stride;
116 cp = (unsigned char *)urb->transfer_buffer +
117 urb->iso_frame_desc[i].offset;
119 if (!length)
120 continue;
122 oldptr = dev->adev.hwptr_done_capture;
123 if (oldptr + length >= runtime->buffer_size) {
124 unsigned int cnt =
125 runtime->buffer_size - oldptr;
126 memcpy(runtime->dma_area + oldptr * stride, cp,
127 cnt * stride);
128 memcpy(runtime->dma_area, cp + cnt * stride,
129 length * stride - cnt * stride);
130 } else {
131 memcpy(runtime->dma_area + oldptr * stride, cp,
132 length * stride);
135 snd_pcm_stream_lock(substream);
137 dev->adev.hwptr_done_capture += length;
138 if (dev->adev.hwptr_done_capture >=
139 runtime->buffer_size)
140 dev->adev.hwptr_done_capture -=
141 runtime->buffer_size;
143 dev->adev.capture_transfer_done += length;
144 if (dev->adev.capture_transfer_done >=
145 runtime->period_size) {
146 dev->adev.capture_transfer_done -=
147 runtime->period_size;
148 period_elapsed = 1;
151 snd_pcm_stream_unlock(substream);
153 if (period_elapsed)
154 snd_pcm_period_elapsed(substream);
156 urb->status = 0;
158 status = usb_submit_urb(urb, GFP_ATOMIC);
159 if (status < 0) {
160 em28xx_errdev("resubmit of audio urb failed (error=%i)\n",
161 status);
163 return;
166 static int em28xx_init_audio_isoc(struct em28xx *dev)
168 int i, errCode;
169 const int sb_size = EM28XX_NUM_AUDIO_PACKETS *
170 EM28XX_AUDIO_MAX_PACKET_SIZE;
172 dprintk("Starting isoc transfers\n");
174 for (i = 0; i < EM28XX_AUDIO_BUFS; i++) {
175 struct urb *urb;
176 int j, k;
178 dev->adev.transfer_buffer[i] = kmalloc(sb_size, GFP_ATOMIC);
179 if (!dev->adev.transfer_buffer[i])
180 return -ENOMEM;
182 memset(dev->adev.transfer_buffer[i], 0x80, sb_size);
183 urb = usb_alloc_urb(EM28XX_NUM_AUDIO_PACKETS, GFP_ATOMIC);
184 if (!urb) {
185 em28xx_errdev("usb_alloc_urb failed!\n");
186 for (j = 0; j < i; j++) {
187 usb_free_urb(dev->adev.urb[j]);
188 kfree(dev->adev.transfer_buffer[j]);
190 return -ENOMEM;
193 urb->dev = dev->udev;
194 urb->context = dev;
195 urb->pipe = usb_rcvisocpipe(dev->udev, 0x83);
196 urb->transfer_flags = URB_ISO_ASAP;
197 urb->transfer_buffer = dev->adev.transfer_buffer[i];
198 urb->interval = 1;
199 urb->complete = em28xx_audio_isocirq;
200 urb->number_of_packets = EM28XX_NUM_AUDIO_PACKETS;
201 urb->transfer_buffer_length = sb_size;
203 for (j = k = 0; j < EM28XX_NUM_AUDIO_PACKETS;
204 j++, k += EM28XX_AUDIO_MAX_PACKET_SIZE) {
205 urb->iso_frame_desc[j].offset = k;
206 urb->iso_frame_desc[j].length =
207 EM28XX_AUDIO_MAX_PACKET_SIZE;
209 dev->adev.urb[i] = urb;
212 for (i = 0; i < EM28XX_AUDIO_BUFS; i++) {
213 errCode = usb_submit_urb(dev->adev.urb[i], GFP_ATOMIC);
214 if (errCode) {
215 em28xx_deinit_isoc_audio(dev);
216 return errCode;
220 return 0;
223 static int snd_pcm_alloc_vmalloc_buffer(struct snd_pcm_substream *subs,
224 size_t size)
226 struct snd_pcm_runtime *runtime = subs->runtime;
228 dprintk("Allocating vbuffer\n");
229 if (runtime->dma_area) {
230 if (runtime->dma_bytes > size)
231 return 0;
233 vfree(runtime->dma_area);
235 runtime->dma_area = vmalloc(size);
236 if (!runtime->dma_area)
237 return -ENOMEM;
239 runtime->dma_bytes = size;
241 return 0;
244 static struct snd_pcm_hardware snd_em28xx_hw_capture = {
245 .info = SNDRV_PCM_INFO_BLOCK_TRANSFER |
246 SNDRV_PCM_INFO_MMAP |
247 SNDRV_PCM_INFO_INTERLEAVED |
248 SNDRV_PCM_INFO_MMAP_VALID,
250 .formats = SNDRV_PCM_FMTBIT_S16_LE,
252 .rates = SNDRV_PCM_RATE_CONTINUOUS | SNDRV_PCM_RATE_KNOT,
254 .rate_min = 48000,
255 .rate_max = 48000,
256 .channels_min = 2,
257 .channels_max = 2,
258 .buffer_bytes_max = 62720 * 8, /* just about the value in usbaudio.c */
259 .period_bytes_min = 64, /* 12544/2, */
260 .period_bytes_max = 12544,
261 .periods_min = 2,
262 .periods_max = 98, /* 12544, */
265 static int snd_em28xx_capture_open(struct snd_pcm_substream *substream)
267 struct em28xx *dev = snd_pcm_substream_chip(substream);
268 struct snd_pcm_runtime *runtime = substream->runtime;
269 int ret = 0;
271 dprintk("opening device and trying to acquire exclusive lock\n");
273 if (!dev) {
274 em28xx_err("BUG: em28xx can't find device struct."
275 " Can't proceed with open\n");
276 return -ENODEV;
279 /* Sets volume, mute, etc */
281 dev->mute = 0;
282 mutex_lock(&dev->lock);
283 ret = em28xx_audio_analog_set(dev);
284 if (ret < 0)
285 goto err;
287 runtime->hw = snd_em28xx_hw_capture;
288 if (dev->alt == 0 && dev->adev.users == 0) {
289 dev->alt = 7;
290 dprintk("changing alternate number to 7\n");
291 usb_set_interface(dev->udev, 0, 7);
294 dev->adev.users++;
295 mutex_unlock(&dev->lock);
297 snd_pcm_hw_constraint_integer(runtime, SNDRV_PCM_HW_PARAM_PERIODS);
298 dev->adev.capture_pcm_substream = substream;
299 runtime->private_data = dev;
301 return 0;
302 err:
303 mutex_unlock(&dev->lock);
305 em28xx_err("Error while configuring em28xx mixer\n");
306 return ret;
309 static int snd_em28xx_pcm_close(struct snd_pcm_substream *substream)
311 struct em28xx *dev = snd_pcm_substream_chip(substream);
313 dprintk("closing device\n");
315 dev->mute = 1;
316 mutex_lock(&dev->lock);
317 dev->adev.users--;
318 if (atomic_read(&dev->stream_started) > 0) {
319 atomic_set(&dev->stream_started, 0);
320 schedule_work(&dev->wq_trigger);
323 em28xx_audio_analog_set(dev);
324 if (substream->runtime->dma_area) {
325 dprintk("freeing\n");
326 vfree(substream->runtime->dma_area);
327 substream->runtime->dma_area = NULL;
329 mutex_unlock(&dev->lock);
331 return 0;
334 static int snd_em28xx_hw_capture_params(struct snd_pcm_substream *substream,
335 struct snd_pcm_hw_params *hw_params)
337 unsigned int channels, rate, format;
338 int ret;
340 dprintk("Setting capture parameters\n");
342 ret = snd_pcm_alloc_vmalloc_buffer(substream,
343 params_buffer_bytes(hw_params));
344 if (ret < 0)
345 return ret;
346 format = params_format(hw_params);
347 rate = params_rate(hw_params);
348 channels = params_channels(hw_params);
350 /* TODO: set up em28xx audio chip to deliver the correct audio format,
351 current default is 48000hz multiplexed => 96000hz mono
352 which shouldn't matter since analogue TV only supports mono */
353 return 0;
356 static int snd_em28xx_hw_capture_free(struct snd_pcm_substream *substream)
358 struct em28xx *dev = snd_pcm_substream_chip(substream);
360 dprintk("Stop capture, if needed\n");
362 if (atomic_read(&dev->stream_started) > 0) {
363 atomic_set(&dev->stream_started, 0);
364 schedule_work(&dev->wq_trigger);
367 return 0;
370 static int snd_em28xx_prepare(struct snd_pcm_substream *substream)
372 struct em28xx *dev = snd_pcm_substream_chip(substream);
374 dev->adev.hwptr_done_capture = 0;
375 dev->adev.capture_transfer_done = 0;
377 return 0;
380 static void audio_trigger(struct work_struct *work)
382 struct em28xx *dev = container_of(work, struct em28xx, wq_trigger);
384 if (atomic_read(&dev->stream_started)) {
385 dprintk("starting capture");
386 em28xx_init_audio_isoc(dev);
387 } else {
388 dprintk("stopping capture");
389 em28xx_deinit_isoc_audio(dev);
393 static int snd_em28xx_capture_trigger(struct snd_pcm_substream *substream,
394 int cmd)
396 struct em28xx *dev = snd_pcm_substream_chip(substream);
397 int retval = 0;
399 switch (cmd) {
400 case SNDRV_PCM_TRIGGER_START:
401 atomic_set(&dev->stream_started, 1);
402 break;
403 case SNDRV_PCM_TRIGGER_STOP:
404 atomic_set(&dev->stream_started, 1);
405 break;
406 default:
407 retval = -EINVAL;
409 schedule_work(&dev->wq_trigger);
410 return retval;
413 static snd_pcm_uframes_t snd_em28xx_capture_pointer(struct snd_pcm_substream
414 *substream)
416 unsigned long flags;
417 struct em28xx *dev;
418 snd_pcm_uframes_t hwptr_done;
420 dev = snd_pcm_substream_chip(substream);
421 spin_lock_irqsave(&dev->adev.slock, flags);
422 hwptr_done = dev->adev.hwptr_done_capture;
423 spin_unlock_irqrestore(&dev->adev.slock, flags);
425 return hwptr_done;
428 static struct page *snd_pcm_get_vmalloc_page(struct snd_pcm_substream *subs,
429 unsigned long offset)
431 void *pageptr = subs->runtime->dma_area + offset;
433 return vmalloc_to_page(pageptr);
436 static struct snd_pcm_ops snd_em28xx_pcm_capture = {
437 .open = snd_em28xx_capture_open,
438 .close = snd_em28xx_pcm_close,
439 .ioctl = snd_pcm_lib_ioctl,
440 .hw_params = snd_em28xx_hw_capture_params,
441 .hw_free = snd_em28xx_hw_capture_free,
442 .prepare = snd_em28xx_prepare,
443 .trigger = snd_em28xx_capture_trigger,
444 .pointer = snd_em28xx_capture_pointer,
445 .page = snd_pcm_get_vmalloc_page,
448 static int em28xx_audio_init(struct em28xx *dev)
450 struct em28xx_audio *adev = &dev->adev;
451 struct snd_pcm *pcm;
452 struct snd_card *card;
453 static int devnr;
454 int err;
456 if (dev->has_alsa_audio != 1) {
457 /* This device does not support the extension (in this case
458 the device is expecting the snd-usb-audio module or
459 doesn't have analog audio support at all) */
460 return 0;
463 printk(KERN_INFO "em28xx-audio.c: probing for em28x1 "
464 "non standard usbaudio\n");
465 printk(KERN_INFO "em28xx-audio.c: Copyright (C) 2006 Markus "
466 "Rechberger\n");
468 err = snd_card_create(index[devnr], "Em28xx Audio", THIS_MODULE, 0,
469 &card);
470 if (err < 0)
471 return err;
473 spin_lock_init(&adev->slock);
474 err = snd_pcm_new(card, "Em28xx Audio", 0, 0, 1, &pcm);
475 if (err < 0) {
476 snd_card_free(card);
477 return err;
480 snd_pcm_set_ops(pcm, SNDRV_PCM_STREAM_CAPTURE, &snd_em28xx_pcm_capture);
481 pcm->info_flags = 0;
482 pcm->private_data = dev;
483 strcpy(pcm->name, "Empia 28xx Capture");
485 snd_card_set_dev(card, &dev->udev->dev);
486 strcpy(card->driver, "Em28xx-Audio");
487 strcpy(card->shortname, "Em28xx Audio");
488 strcpy(card->longname, "Empia Em28xx Audio");
490 INIT_WORK(&dev->wq_trigger, audio_trigger);
492 err = snd_card_register(card);
493 if (err < 0) {
494 snd_card_free(card);
495 return err;
497 adev->sndcard = card;
498 adev->udev = dev->udev;
500 return 0;
503 static int em28xx_audio_fini(struct em28xx *dev)
505 if (dev == NULL)
506 return 0;
508 if (dev->has_alsa_audio != 1) {
509 /* This device does not support the extension (in this case
510 the device is expecting the snd-usb-audio module or
511 doesn't have analog audio support at all) */
512 return 0;
515 if (dev->adev.sndcard) {
516 snd_card_free(dev->adev.sndcard);
517 dev->adev.sndcard = NULL;
520 return 0;
523 static struct em28xx_ops audio_ops = {
524 .id = EM28XX_AUDIO,
525 .name = "Em28xx Audio Extension",
526 .init = em28xx_audio_init,
527 .fini = em28xx_audio_fini,
530 static int __init em28xx_alsa_register(void)
532 return em28xx_register_extension(&audio_ops);
535 static void __exit em28xx_alsa_unregister(void)
537 em28xx_unregister_extension(&audio_ops);
540 MODULE_LICENSE("GPL");
541 MODULE_AUTHOR("Markus Rechberger <mrechberger@gmail.com>");
542 MODULE_AUTHOR("Mauro Carvalho Chehab <mchehab@infradead.org>");
543 MODULE_DESCRIPTION("Em28xx Audio driver");
545 module_init(em28xx_alsa_register);
546 module_exit(em28xx_alsa_unregister);