1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20#include <linux/module.h>
21#include <linux/init.h>
22#include <linux/device.h>
23#include <linux/interrupt.h>
24#include <linux/vmalloc.h>
25#include <linux/dma-mapping.h>
26#include <linux/pci.h>
27
28#include <asm/delay.h>
29
30#include <sound/core.h>
31#include <sound/pcm.h>
32#include <sound/pcm_params.h>
33#include <sound/control.h>
34#include <sound/initval.h>
35
36#include <sound/tlv.h>
37
38
39#include "cx23885.h"
40#include "cx23885-reg.h"
41
42#define AUDIO_SRAM_CHANNEL SRAM_CH07
43
44#define dprintk(level, fmt, arg...) do { \
45 if (audio_debug + 1 > level) \
46 printk(KERN_INFO "%s: " fmt, chip->dev->name , ## arg); \
47} while(0)
48
49#define dprintk_core(level, fmt, arg...) if (audio_debug >= level) \
50 printk(KERN_DEBUG "%s: " fmt, chip->dev->name , ## arg)
51
52
53
54
55
56static unsigned int disable_analog_audio;
57module_param(disable_analog_audio, int, 0644);
58MODULE_PARM_DESC(disable_analog_audio, "disable analog audio ALSA driver");
59
60static unsigned int audio_debug;
61module_param(audio_debug, int, 0644);
62MODULE_PARM_DESC(audio_debug, "enable debug messages [analog audio]");
63
64
65
66
67
68
69#define AUD_INT_DN_RISCI1 (1 << 0)
70#define AUD_INT_UP_RISCI1 (1 << 1)
71#define AUD_INT_RDS_DN_RISCI1 (1 << 2)
72#define AUD_INT_DN_RISCI2 (1 << 4)
73#define AUD_INT_UP_RISCI2 (1 << 5)
74#define AUD_INT_RDS_DN_RISCI2 (1 << 6)
75#define AUD_INT_DN_SYNC (1 << 12)
76#define AUD_INT_UP_SYNC (1 << 13)
77#define AUD_INT_RDS_DN_SYNC (1 << 14)
78#define AUD_INT_OPC_ERR (1 << 16)
79#define AUD_INT_BER_IRQ (1 << 20)
80#define AUD_INT_MCHG_IRQ (1 << 21)
81#define GP_COUNT_CONTROL_RESET 0x3
82
83static int cx23885_alsa_dma_init(struct cx23885_audio_dev *chip, int nr_pages)
84{
85 struct cx23885_audio_buffer *buf = chip->buf;
86 struct page *pg;
87 int i;
88
89 buf->vaddr = vmalloc_32(nr_pages << PAGE_SHIFT);
90 if (NULL == buf->vaddr) {
91 dprintk(1, "vmalloc_32(%d pages) failed\n", nr_pages);
92 return -ENOMEM;
93 }
94
95 dprintk(1, "vmalloc is at addr 0x%08lx, size=%d\n",
96 (unsigned long)buf->vaddr,
97 nr_pages << PAGE_SHIFT);
98
99 memset(buf->vaddr, 0, nr_pages << PAGE_SHIFT);
100 buf->nr_pages = nr_pages;
101
102 buf->sglist = vzalloc(buf->nr_pages * sizeof(*buf->sglist));
103 if (NULL == buf->sglist)
104 goto vzalloc_err;
105
106 sg_init_table(buf->sglist, buf->nr_pages);
107 for (i = 0; i < buf->nr_pages; i++) {
108 pg = vmalloc_to_page(buf->vaddr + i * PAGE_SIZE);
109 if (NULL == pg)
110 goto vmalloc_to_page_err;
111 sg_set_page(&buf->sglist[i], pg, PAGE_SIZE, 0);
112 }
113 return 0;
114
115vmalloc_to_page_err:
116 vfree(buf->sglist);
117 buf->sglist = NULL;
118vzalloc_err:
119 vfree(buf->vaddr);
120 buf->vaddr = NULL;
121 return -ENOMEM;
122}
123
124static int cx23885_alsa_dma_map(struct cx23885_audio_dev *dev)
125{
126 struct cx23885_audio_buffer *buf = dev->buf;
127
128 buf->sglen = dma_map_sg(&dev->pci->dev, buf->sglist,
129 buf->nr_pages, PCI_DMA_FROMDEVICE);
130
131 if (0 == buf->sglen) {
132 pr_warn("%s: cx23885_alsa_map_sg failed\n", __func__);
133 return -ENOMEM;
134 }
135 return 0;
136}
137
138static int cx23885_alsa_dma_unmap(struct cx23885_audio_dev *dev)
139{
140 struct cx23885_audio_buffer *buf = dev->buf;
141
142 if (!buf->sglen)
143 return 0;
144
145 dma_unmap_sg(&dev->pci->dev, buf->sglist, buf->sglen, PCI_DMA_FROMDEVICE);
146 buf->sglen = 0;
147 return 0;
148}
149
150static int cx23885_alsa_dma_free(struct cx23885_audio_buffer *buf)
151{
152 vfree(buf->sglist);
153 buf->sglist = NULL;
154 vfree(buf->vaddr);
155 buf->vaddr = NULL;
156 return 0;
157}
158
159
160
161
162
163static int cx23885_start_audio_dma(struct cx23885_audio_dev *chip)
164{
165 struct cx23885_audio_buffer *buf = chip->buf;
166 struct cx23885_dev *dev = chip->dev;
167 struct sram_channel *audio_ch =
168 &dev->sram_channels[AUDIO_SRAM_CHANNEL];
169
170 dprintk(1, "%s()\n", __func__);
171
172
173 cx_clear(AUD_INT_DMA_CTL, 0x11);
174
175
176 cx23885_sram_channel_setup(chip->dev, audio_ch, buf->bpl,
177 buf->risc.dma);
178
179
180 cx_write(AUD_INT_A_LNGTH, buf->bpl);
181
182
183 cx_write(AUD_INT_A_MODE, 1);
184
185
186 cx_write(AUD_INT_A_GPCNT_CTL, GP_COUNT_CONTROL_RESET);
187 atomic_set(&chip->count, 0);
188
189 dprintk(1, "Start audio DMA, %d B/line, %d lines/FIFO, %d periods, %d "
190 "byte buffer\n", buf->bpl, cx_read(audio_ch->cmds_start+12)>>1,
191 chip->num_periods, buf->bpl * chip->num_periods);
192
193
194 cx_write(AUDIO_INT_INT_MSK, AUD_INT_OPC_ERR | AUD_INT_DN_SYNC |
195 AUD_INT_DN_RISCI1);
196
197
198 cx_write(AUDIO_INT_INT_STAT, ~0);
199
200
201 cx_set(PCI_INT_MSK, chip->dev->pci_irqmask | PCI_MSK_AUD_INT);
202
203
204 cx_set(DEV_CNTRL2, (1<<5));
205 cx_set(AUD_INT_DMA_CTL, 0x11);
206
207 if (audio_debug)
208 cx23885_sram_channel_dump(chip->dev, audio_ch);
209
210 return 0;
211}
212
213
214
215
216static int cx23885_stop_audio_dma(struct cx23885_audio_dev *chip)
217{
218 struct cx23885_dev *dev = chip->dev;
219 dprintk(1, "Stopping audio DMA\n");
220
221
222 cx_clear(AUD_INT_DMA_CTL, 0x11);
223
224
225 cx_clear(PCI_INT_MSK, PCI_MSK_AUD_INT);
226 cx_clear(AUDIO_INT_INT_MSK, AUD_INT_OPC_ERR | AUD_INT_DN_SYNC |
227 AUD_INT_DN_RISCI1);
228
229 if (audio_debug)
230 cx23885_sram_channel_dump(chip->dev,
231 &dev->sram_channels[AUDIO_SRAM_CHANNEL]);
232
233 return 0;
234}
235
236
237
238
239int cx23885_audio_irq(struct cx23885_dev *dev, u32 status, u32 mask)
240{
241 struct cx23885_audio_dev *chip = dev->audio_dev;
242
243 if (0 == (status & mask))
244 return 0;
245
246 cx_write(AUDIO_INT_INT_STAT, status);
247
248
249 if (status & AUD_INT_OPC_ERR) {
250 printk(KERN_WARNING "%s/1: Audio risc op code error\n",
251 dev->name);
252 cx_clear(AUD_INT_DMA_CTL, 0x11);
253 cx23885_sram_channel_dump(dev,
254 &dev->sram_channels[AUDIO_SRAM_CHANNEL]);
255 }
256 if (status & AUD_INT_DN_SYNC) {
257 dprintk(1, "Downstream sync error\n");
258 cx_write(AUD_INT_A_GPCNT_CTL, GP_COUNT_CONTROL_RESET);
259 return 1;
260 }
261
262 if (status & AUD_INT_DN_RISCI1) {
263 atomic_set(&chip->count, cx_read(AUD_INT_A_GPCNT));
264 snd_pcm_period_elapsed(chip->substream);
265 }
266
267
268 return 1;
269}
270
271static int dsp_buffer_free(struct cx23885_audio_dev *chip)
272{
273 struct cx23885_riscmem *risc;
274
275 BUG_ON(!chip->dma_size);
276
277 dprintk(2, "Freeing buffer\n");
278 cx23885_alsa_dma_unmap(chip);
279 cx23885_alsa_dma_free(chip->buf);
280 risc = &chip->buf->risc;
281 pci_free_consistent(chip->pci, risc->size, risc->cpu, risc->dma);
282 kfree(chip->buf);
283
284 chip->buf = NULL;
285 chip->dma_size = 0;
286
287 return 0;
288}
289
290
291
292
293
294
295
296
297#define DEFAULT_FIFO_SIZE 4096
298
299static struct snd_pcm_hardware snd_cx23885_digital_hw = {
300 .info = SNDRV_PCM_INFO_MMAP |
301 SNDRV_PCM_INFO_INTERLEAVED |
302 SNDRV_PCM_INFO_BLOCK_TRANSFER |
303 SNDRV_PCM_INFO_MMAP_VALID,
304 .formats = SNDRV_PCM_FMTBIT_S16_LE,
305
306 .rates = SNDRV_PCM_RATE_48000,
307 .rate_min = 48000,
308 .rate_max = 48000,
309 .channels_min = 2,
310 .channels_max = 2,
311
312
313 .period_bytes_min = DEFAULT_FIFO_SIZE/4,
314 .period_bytes_max = DEFAULT_FIFO_SIZE/4,
315 .periods_min = 1,
316 .periods_max = 1024,
317 .buffer_bytes_max = (1024*1024),
318};
319
320
321
322
323static int snd_cx23885_pcm_open(struct snd_pcm_substream *substream)
324{
325 struct cx23885_audio_dev *chip = snd_pcm_substream_chip(substream);
326 struct snd_pcm_runtime *runtime = substream->runtime;
327 int err;
328
329 if (!chip) {
330 printk(KERN_ERR "BUG: cx23885 can't find device struct."
331 " Can't proceed with open\n");
332 return -ENODEV;
333 }
334
335 err = snd_pcm_hw_constraint_pow2(runtime, 0,
336 SNDRV_PCM_HW_PARAM_PERIODS);
337 if (err < 0)
338 goto _error;
339
340 chip->substream = substream;
341
342 runtime->hw = snd_cx23885_digital_hw;
343
344 if (chip->dev->sram_channels[AUDIO_SRAM_CHANNEL].fifo_size !=
345 DEFAULT_FIFO_SIZE) {
346 unsigned int bpl = chip->dev->
347 sram_channels[AUDIO_SRAM_CHANNEL].fifo_size / 4;
348 bpl &= ~7;
349 runtime->hw.period_bytes_min = bpl;
350 runtime->hw.period_bytes_max = bpl;
351 }
352
353 return 0;
354_error:
355 dprintk(1, "Error opening PCM!\n");
356 return err;
357}
358
359
360
361
362static int snd_cx23885_close(struct snd_pcm_substream *substream)
363{
364 return 0;
365}
366
367
368
369
370
371static int snd_cx23885_hw_params(struct snd_pcm_substream *substream,
372 struct snd_pcm_hw_params *hw_params)
373{
374 struct cx23885_audio_dev *chip = snd_pcm_substream_chip(substream);
375 struct cx23885_audio_buffer *buf;
376 int ret;
377
378 if (substream->runtime->dma_area) {
379 dsp_buffer_free(chip);
380 substream->runtime->dma_area = NULL;
381 }
382
383 chip->period_size = params_period_bytes(hw_params);
384 chip->num_periods = params_periods(hw_params);
385 chip->dma_size = chip->period_size * params_periods(hw_params);
386
387 BUG_ON(!chip->dma_size);
388 BUG_ON(chip->num_periods & (chip->num_periods-1));
389
390 buf = kzalloc(sizeof(*buf), GFP_KERNEL);
391 if (NULL == buf)
392 return -ENOMEM;
393
394 buf->bpl = chip->period_size;
395 chip->buf = buf;
396
397 ret = cx23885_alsa_dma_init(chip,
398 (PAGE_ALIGN(chip->dma_size) >> PAGE_SHIFT));
399 if (ret < 0)
400 goto error;
401
402 ret = cx23885_alsa_dma_map(chip);
403 if (ret < 0)
404 goto error;
405
406 ret = cx23885_risc_databuffer(chip->pci, &buf->risc, buf->sglist,
407 chip->period_size, chip->num_periods, 1);
408 if (ret < 0)
409 goto error;
410
411
412 buf->risc.jmp[0] = cpu_to_le32(RISC_JUMP|RISC_IRQ1|RISC_CNT_INC);
413 buf->risc.jmp[1] = cpu_to_le32(buf->risc.dma);
414 buf->risc.jmp[2] = cpu_to_le32(0);
415
416 substream->runtime->dma_area = chip->buf->vaddr;
417 substream->runtime->dma_bytes = chip->dma_size;
418 substream->runtime->dma_addr = 0;
419
420 return 0;
421
422error:
423 kfree(buf);
424 chip->buf = NULL;
425 return ret;
426}
427
428
429
430
431static int snd_cx23885_hw_free(struct snd_pcm_substream *substream)
432{
433
434 struct cx23885_audio_dev *chip = snd_pcm_substream_chip(substream);
435
436 if (substream->runtime->dma_area) {
437 dsp_buffer_free(chip);
438 substream->runtime->dma_area = NULL;
439 }
440
441 return 0;
442}
443
444
445
446
447static int snd_cx23885_prepare(struct snd_pcm_substream *substream)
448{
449 return 0;
450}
451
452
453
454
455static int snd_cx23885_card_trigger(struct snd_pcm_substream *substream,
456 int cmd)
457{
458 struct cx23885_audio_dev *chip = snd_pcm_substream_chip(substream);
459 int err;
460
461
462 spin_lock(&chip->lock);
463
464 switch (cmd) {
465 case SNDRV_PCM_TRIGGER_START:
466 err = cx23885_start_audio_dma(chip);
467 break;
468 case SNDRV_PCM_TRIGGER_STOP:
469 err = cx23885_stop_audio_dma(chip);
470 break;
471 default:
472 err = -EINVAL;
473 break;
474 }
475
476 spin_unlock(&chip->lock);
477
478 return err;
479}
480
481
482
483
484static snd_pcm_uframes_t snd_cx23885_pointer(
485 struct snd_pcm_substream *substream)
486{
487 struct cx23885_audio_dev *chip = snd_pcm_substream_chip(substream);
488 struct snd_pcm_runtime *runtime = substream->runtime;
489 u16 count;
490
491 count = atomic_read(&chip->count);
492
493 return runtime->period_size * (count & (runtime->periods-1));
494}
495
496
497
498
499static struct page *snd_cx23885_page(struct snd_pcm_substream *substream,
500 unsigned long offset)
501{
502 void *pageptr = substream->runtime->dma_area + offset;
503 return vmalloc_to_page(pageptr);
504}
505
506
507
508
509static const struct snd_pcm_ops snd_cx23885_pcm_ops = {
510 .open = snd_cx23885_pcm_open,
511 .close = snd_cx23885_close,
512 .ioctl = snd_pcm_lib_ioctl,
513 .hw_params = snd_cx23885_hw_params,
514 .hw_free = snd_cx23885_hw_free,
515 .prepare = snd_cx23885_prepare,
516 .trigger = snd_cx23885_card_trigger,
517 .pointer = snd_cx23885_pointer,
518 .page = snd_cx23885_page,
519};
520
521
522
523
524static int snd_cx23885_pcm(struct cx23885_audio_dev *chip, int device,
525 char *name)
526{
527 int err;
528 struct snd_pcm *pcm;
529
530 err = snd_pcm_new(chip->card, name, device, 0, 1, &pcm);
531 if (err < 0)
532 return err;
533 pcm->private_data = chip;
534 strcpy(pcm->name, name);
535 snd_pcm_set_ops(pcm, SNDRV_PCM_STREAM_CAPTURE, &snd_cx23885_pcm_ops);
536
537 return 0;
538}
539
540
541
542
543
544
545
546
547
548struct cx23885_audio_dev *cx23885_audio_register(struct cx23885_dev *dev)
549{
550 struct snd_card *card;
551 struct cx23885_audio_dev *chip;
552 int err;
553
554 if (disable_analog_audio)
555 return NULL;
556
557 if (dev->sram_channels[AUDIO_SRAM_CHANNEL].cmds_start == 0) {
558 printk(KERN_WARNING "%s(): Missing SRAM channel configuration "
559 "for analog TV Audio\n", __func__);
560 return NULL;
561 }
562
563 err = snd_card_new(&dev->pci->dev,
564 SNDRV_DEFAULT_IDX1, SNDRV_DEFAULT_STR1,
565 THIS_MODULE, sizeof(struct cx23885_audio_dev), &card);
566 if (err < 0)
567 goto error;
568
569 chip = (struct cx23885_audio_dev *) card->private_data;
570 chip->dev = dev;
571 chip->pci = dev->pci;
572 chip->card = card;
573 spin_lock_init(&chip->lock);
574
575 err = snd_cx23885_pcm(chip, 0, "CX23885 Digital");
576 if (err < 0)
577 goto error;
578
579 strcpy(card->driver, "CX23885");
580 sprintf(card->shortname, "Conexant CX23885");
581 sprintf(card->longname, "%s at %s", card->shortname, dev->name);
582
583 err = snd_card_register(card);
584 if (err < 0)
585 goto error;
586
587 dprintk(0, "registered ALSA audio device\n");
588
589 return chip;
590
591error:
592 snd_card_free(card);
593 printk(KERN_ERR "%s(): Failed to register analog "
594 "audio adapter\n", __func__);
595
596 return NULL;
597}
598
599
600
601
602void cx23885_audio_unregister(struct cx23885_dev *dev)
603{
604 struct cx23885_audio_dev *chip = dev->audio_dev;
605
606 snd_card_free(chip->card);
607}
608
