1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39#include <sound/core.h>
40#include <sound/initval.h>
41#include <sound/ac97_codec.h>
42#include <sound/pcm_params.h>
43
44#include "usbtv.h"
45
46static const struct snd_pcm_hardware snd_usbtv_digital_hw = {
47 .info = SNDRV_PCM_INFO_BATCH |
48 SNDRV_PCM_INFO_MMAP |
49 SNDRV_PCM_INFO_INTERLEAVED |
50 SNDRV_PCM_INFO_BLOCK_TRANSFER |
51 SNDRV_PCM_INFO_MMAP_VALID,
52 .formats = SNDRV_PCM_FMTBIT_S16_LE,
53 .rates = SNDRV_PCM_RATE_48000,
54 .rate_min = 48000,
55 .rate_max = 48000,
56 .channels_min = 2,
57 .channels_max = 2,
58 .period_bytes_min = 11059,
59 .period_bytes_max = 13516,
60 .periods_min = 2,
61 .periods_max = 98,
62 .buffer_bytes_max = 62720 * 8,
63};
64
65static int snd_usbtv_pcm_open(struct snd_pcm_substream *substream)
66{
67 struct usbtv *chip = snd_pcm_substream_chip(substream);
68 struct snd_pcm_runtime *runtime = substream->runtime;
69
70 chip->snd_substream = substream;
71 runtime->hw = snd_usbtv_digital_hw;
72
73 return 0;
74}
75
76static int snd_usbtv_pcm_close(struct snd_pcm_substream *substream)
77{
78 struct usbtv *chip = snd_pcm_substream_chip(substream);
79
80 if (atomic_read(&chip->snd_stream)) {
81 atomic_set(&chip->snd_stream, 0);
82 schedule_work(&chip->snd_trigger);
83 }
84
85 return 0;
86}
87
88static int snd_usbtv_hw_params(struct snd_pcm_substream *substream,
89 struct snd_pcm_hw_params *hw_params)
90{
91 int rv;
92 struct usbtv *chip = snd_pcm_substream_chip(substream);
93
94 rv = snd_pcm_lib_malloc_pages(substream,
95 params_buffer_bytes(hw_params));
96
97 if (rv < 0) {
98 dev_warn(chip->dev, "pcm audio buffer allocation failure %i\n",
99 rv);
100 return rv;
101 }
102
103 return 0;
104}
105
106static int snd_usbtv_hw_free(struct snd_pcm_substream *substream)
107{
108 snd_pcm_lib_free_pages(substream);
109 return 0;
110}
111
112static int snd_usbtv_prepare(struct snd_pcm_substream *substream)
113{
114 struct usbtv *chip = snd_pcm_substream_chip(substream);
115
116 chip->snd_buffer_pos = 0;
117 chip->snd_period_pos = 0;
118
119 return 0;
120}
121
122static void usbtv_audio_urb_received(struct urb *urb)
123{
124 struct usbtv *chip = urb->context;
125 struct snd_pcm_substream *substream = chip->snd_substream;
126 struct snd_pcm_runtime *runtime = substream->runtime;
127 size_t i, frame_bytes, chunk_length, buffer_pos, period_pos;
128 int period_elapsed;
129 unsigned long flags;
130 void *urb_current;
131
132 switch (urb->status) {
133 case 0:
134 case -ETIMEDOUT:
135 break;
136 case -ENOENT:
137 case -EPROTO:
138 case -ECONNRESET:
139 case -ESHUTDOWN:
140 return;
141 default:
142 dev_warn(chip->dev, "unknown audio urb status %i\n",
143 urb->status);
144 }
145
146 if (!atomic_read(&chip->snd_stream))
147 return;
148
149 frame_bytes = runtime->frame_bits >> 3;
150 chunk_length = USBTV_CHUNK / frame_bytes;
151
152 buffer_pos = chip->snd_buffer_pos;
153 period_pos = chip->snd_period_pos;
154 period_elapsed = 0;
155
156 for (i = 0; i < urb->actual_length; i += USBTV_CHUNK_SIZE) {
157 urb_current = urb->transfer_buffer + i + USBTV_AUDIO_HDRSIZE;
158
159 if (buffer_pos + chunk_length >= runtime->buffer_size) {
160 size_t cnt = (runtime->buffer_size - buffer_pos) *
161 frame_bytes;
162 memcpy(runtime->dma_area + buffer_pos * frame_bytes,
163 urb_current, cnt);
164 memcpy(runtime->dma_area, urb_current + cnt,
165 chunk_length * frame_bytes - cnt);
166 } else {
167 memcpy(runtime->dma_area + buffer_pos * frame_bytes,
168 urb_current, chunk_length * frame_bytes);
169 }
170
171 buffer_pos += chunk_length;
172 period_pos += chunk_length;
173
174 if (buffer_pos >= runtime->buffer_size)
175 buffer_pos -= runtime->buffer_size;
176
177 if (period_pos >= runtime->period_size) {
178 period_pos -= runtime->period_size;
179 period_elapsed = 1;
180 }
181 }
182
183 snd_pcm_stream_lock_irqsave(substream, flags);
184
185 chip->snd_buffer_pos = buffer_pos;
186 chip->snd_period_pos = period_pos;
187
188 snd_pcm_stream_unlock_irqrestore(substream, flags);
189
190 if (period_elapsed)
191 snd_pcm_period_elapsed(substream);
192
193 usb_submit_urb(urb, GFP_ATOMIC);
194}
195
196static int usbtv_audio_start(struct usbtv *chip)
197{
198 unsigned int pipe;
199 static const u16 setup[][2] = {
200
201 { USBTV_BASE + 0x0008, 0x0001 },
202 { USBTV_BASE + 0x01d0, 0x00ff },
203 { USBTV_BASE + 0x01d9, 0x0002 },
204
205 { USBTV_BASE + 0x01da, 0x0013 },
206 { USBTV_BASE + 0x01db, 0x0012 },
207 { USBTV_BASE + 0x01e9, 0x0002 },
208 { USBTV_BASE + 0x01ec, 0x006c },
209 { USBTV_BASE + 0x0294, 0x0020 },
210 { USBTV_BASE + 0x0255, 0x00cf },
211 { USBTV_BASE + 0x0256, 0x0020 },
212 { USBTV_BASE + 0x01eb, 0x0030 },
213 { USBTV_BASE + 0x027d, 0x00a6 },
214 { USBTV_BASE + 0x0280, 0x0011 },
215 { USBTV_BASE + 0x0281, 0x0040 },
216 { USBTV_BASE + 0x0282, 0x0011 },
217 { USBTV_BASE + 0x0283, 0x0040 },
218 { 0xf891, 0x0010 },
219
220
221 { USBTV_BASE + 0x0284, 0x00aa },
222 };
223
224 chip->snd_bulk_urb = usb_alloc_urb(0, GFP_KERNEL);
225 if (chip->snd_bulk_urb == NULL)
226 goto err_alloc_urb;
227
228 pipe = usb_rcvbulkpipe(chip->udev, USBTV_AUDIO_ENDP);
229
230 chip->snd_bulk_urb->transfer_buffer = kzalloc(
231 USBTV_AUDIO_URBSIZE, GFP_KERNEL);
232 if (chip->snd_bulk_urb->transfer_buffer == NULL)
233 goto err_transfer_buffer;
234
235 usb_fill_bulk_urb(chip->snd_bulk_urb, chip->udev, pipe,
236 chip->snd_bulk_urb->transfer_buffer, USBTV_AUDIO_URBSIZE,
237 usbtv_audio_urb_received, chip);
238
239
240 usbtv_set_regs(chip, setup, ARRAY_SIZE(setup));
241
242 usb_clear_halt(chip->udev, pipe);
243 usb_submit_urb(chip->snd_bulk_urb, GFP_ATOMIC);
244
245 return 0;
246
247err_transfer_buffer:
248 usb_free_urb(chip->snd_bulk_urb);
249 chip->snd_bulk_urb = NULL;
250
251err_alloc_urb:
252 return -ENOMEM;
253}
254
255static int usbtv_audio_stop(struct usbtv *chip)
256{
257 static const u16 setup[][2] = {
258
259
260
261
262
263 { USBTV_BASE + 0x027d, 0x0000 },
264 { USBTV_BASE + 0x0280, 0x0010 },
265 { USBTV_BASE + 0x0282, 0x0010 },
266 };
267
268 if (chip->snd_bulk_urb) {
269 usb_kill_urb(chip->snd_bulk_urb);
270 kfree(chip->snd_bulk_urb->transfer_buffer);
271 usb_free_urb(chip->snd_bulk_urb);
272 chip->snd_bulk_urb = NULL;
273 }
274
275 usbtv_set_regs(chip, setup, ARRAY_SIZE(setup));
276
277 return 0;
278}
279
280void usbtv_audio_suspend(struct usbtv *usbtv)
281{
282 if (atomic_read(&usbtv->snd_stream) && usbtv->snd_bulk_urb)
283 usb_kill_urb(usbtv->snd_bulk_urb);
284}
285
286void usbtv_audio_resume(struct usbtv *usbtv)
287{
288 if (atomic_read(&usbtv->snd_stream) && usbtv->snd_bulk_urb)
289 usb_submit_urb(usbtv->snd_bulk_urb, GFP_ATOMIC);
290}
291
292static void snd_usbtv_trigger(struct work_struct *work)
293{
294 struct usbtv *chip = container_of(work, struct usbtv, snd_trigger);
295
296 if (!chip->snd)
297 return;
298
299 if (atomic_read(&chip->snd_stream))
300 usbtv_audio_start(chip);
301 else
302 usbtv_audio_stop(chip);
303}
304
305static int snd_usbtv_card_trigger(struct snd_pcm_substream *substream, int cmd)
306{
307 struct usbtv *chip = snd_pcm_substream_chip(substream);
308
309 switch (cmd) {
310 case SNDRV_PCM_TRIGGER_START:
311 case SNDRV_PCM_TRIGGER_RESUME:
312 case SNDRV_PCM_TRIGGER_PAUSE_RELEASE:
313 atomic_set(&chip->snd_stream, 1);
314 break;
315 case SNDRV_PCM_TRIGGER_STOP:
316 case SNDRV_PCM_TRIGGER_SUSPEND:
317 case SNDRV_PCM_TRIGGER_PAUSE_PUSH:
318 atomic_set(&chip->snd_stream, 0);
319 break;
320 default:
321 return -EINVAL;
322 }
323
324 schedule_work(&chip->snd_trigger);
325
326 return 0;
327}
328
329static snd_pcm_uframes_t snd_usbtv_pointer(struct snd_pcm_substream *substream)
330{
331 struct usbtv *chip = snd_pcm_substream_chip(substream);
332
333 return chip->snd_buffer_pos;
334}
335
336static const struct snd_pcm_ops snd_usbtv_pcm_ops = {
337 .open = snd_usbtv_pcm_open,
338 .close = snd_usbtv_pcm_close,
339 .ioctl = snd_pcm_lib_ioctl,
340 .hw_params = snd_usbtv_hw_params,
341 .hw_free = snd_usbtv_hw_free,
342 .prepare = snd_usbtv_prepare,
343 .trigger = snd_usbtv_card_trigger,
344 .pointer = snd_usbtv_pointer,
345};
346
347int usbtv_audio_init(struct usbtv *usbtv)
348{
349 int rv;
350 struct snd_card *card;
351 struct snd_pcm *pcm;
352
353 INIT_WORK(&usbtv->snd_trigger, snd_usbtv_trigger);
354 atomic_set(&usbtv->snd_stream, 0);
355
356 rv = snd_card_new(&usbtv->udev->dev, SNDRV_DEFAULT_IDX1, "usbtv",
357 THIS_MODULE, 0, &card);
358 if (rv < 0)
359 return rv;
360
361 strscpy(card->driver, usbtv->dev->driver->name, sizeof(card->driver));
362 strscpy(card->shortname, "usbtv", sizeof(card->shortname));
363 snprintf(card->longname, sizeof(card->longname),
364 "USBTV Audio at bus %d device %d", usbtv->udev->bus->busnum,
365 usbtv->udev->devnum);
366
367 snd_card_set_dev(card, usbtv->dev);
368
369 usbtv->snd = card;
370
371 rv = snd_pcm_new(card, "USBTV Audio", 0, 0, 1, &pcm);
372 if (rv < 0)
373 goto err;
374
375 strscpy(pcm->name, "USBTV Audio Input", sizeof(pcm->name));
376 pcm->info_flags = 0;
377 pcm->private_data = usbtv;
378
379 snd_pcm_set_ops(pcm, SNDRV_PCM_STREAM_CAPTURE, &snd_usbtv_pcm_ops);
380 snd_pcm_lib_preallocate_pages_for_all(pcm, SNDRV_DMA_TYPE_CONTINUOUS,
381 snd_dma_continuous_data(GFP_KERNEL), USBTV_AUDIO_BUFFER,
382 USBTV_AUDIO_BUFFER);
383
384 rv = snd_card_register(card);
385 if (rv)
386 goto err;
387
388 return 0;
389
390err:
391 usbtv->snd = NULL;
392 snd_card_free(card);
393
394 return rv;
395}
396
397void usbtv_audio_free(struct usbtv *usbtv)
398{
399 cancel_work_sync(&usbtv->snd_trigger);
400
401 if (usbtv->snd && usbtv->udev) {
402 snd_card_free(usbtv->snd);
403 usbtv->snd = NULL;
404 }
405}
406
