1
2
3
4
5
6
7
8
9
10#include <linux/delay.h>
11#include <linux/device.h>
12#include <linux/firmware.h>
13#include <linux/io.h>
14#include <sound/core.h>
15#include "vxpocket.h"
16
17
18static const int vxp_reg_offset[VX_REG_MAX] = {
19 [VX_ICR] = 0x00,
20 [VX_CVR] = 0x01,
21 [VX_ISR] = 0x02,
22 [VX_IVR] = 0x03,
23 [VX_RXH] = 0x05,
24 [VX_RXM] = 0x06,
25 [VX_RXL] = 0x07,
26 [VX_DMA] = 0x04,
27 [VX_CDSP] = 0x08,
28 [VX_LOFREQ] = 0x09,
29 [VX_HIFREQ] = 0x0a,
30 [VX_DATA] = 0x0b,
31 [VX_MICRO] = 0x0c,
32 [VX_DIALOG] = 0x0d,
33 [VX_CSUER] = 0x0e,
34 [VX_RUER] = 0x0f,
35};
36
37
38static inline unsigned long vxp_reg_addr(struct vx_core *_chip, int reg)
39{
40 struct snd_vxpocket *chip = to_vxpocket(_chip);
41 return chip->port + vxp_reg_offset[reg];
42}
43
44
45
46
47
48static unsigned char vxp_inb(struct vx_core *chip, int offset)
49{
50 return inb(vxp_reg_addr(chip, offset));
51}
52
53
54
55
56
57
58static void vxp_outb(struct vx_core *chip, int offset, unsigned char val)
59{
60 outb(val, vxp_reg_addr(chip, offset));
61}
62
63
64
65
66#undef vx_inb
67#define vx_inb(chip,reg) vxp_inb((struct vx_core *)(chip), VX_##reg)
68#undef vx_outb
69#define vx_outb(chip,reg,val) vxp_outb((struct vx_core *)(chip), VX_##reg,val)
70
71
72
73
74
75
76
77static int vx_check_magic(struct vx_core *chip)
78{
79 unsigned long end_time = jiffies + HZ / 5;
80 int c;
81 do {
82 c = vx_inb(chip, CDSP);
83 if (c == CDSP_MAGIC)
84 return 0;
85 msleep(10);
86 } while (time_after_eq(end_time, jiffies));
87 snd_printk(KERN_ERR "cannot find xilinx magic word (%x)\n", c);
88 return -EIO;
89}
90
91
92
93
94
95
96#define XX_DSP_RESET_WAIT_TIME 2
97
98static void vxp_reset_dsp(struct vx_core *_chip)
99{
100 struct snd_vxpocket *chip = to_vxpocket(_chip);
101
102
103 vx_outb(chip, CDSP, chip->regCDSP | VXP_CDSP_DSP_RESET_MASK);
104 vx_inb(chip, CDSP);
105 mdelay(XX_DSP_RESET_WAIT_TIME);
106
107 chip->regCDSP &= ~VXP_CDSP_DSP_RESET_MASK;
108 vx_outb(chip, CDSP, chip->regCDSP);
109 vx_inb(chip, CDSP);
110 mdelay(XX_DSP_RESET_WAIT_TIME);
111}
112
113
114
115
116static void vxp_reset_codec(struct vx_core *_chip)
117{
118 struct snd_vxpocket *chip = to_vxpocket(_chip);
119
120
121 vx_outb(chip, CDSP, chip->regCDSP | VXP_CDSP_CODEC_RESET_MASK);
122 vx_inb(chip, CDSP);
123 msleep(10);
124
125 chip->regCDSP &= ~VXP_CDSP_CODEC_RESET_MASK;
126 vx_outb(chip, CDSP, chip->regCDSP);
127 vx_inb(chip, CDSP);
128 msleep(1);
129}
130
131
132
133
134
135static int vxp_load_xilinx_binary(struct vx_core *_chip, const struct firmware *fw)
136{
137 struct snd_vxpocket *chip = to_vxpocket(_chip);
138 unsigned int i;
139 int c;
140 int regCSUER, regRUER;
141 const unsigned char *image;
142 unsigned char data;
143
144
145 chip->regDIALOG |= VXP_DLG_XILINX_REPROG_MASK;
146 vx_outb(chip, DIALOG, chip->regDIALOG);
147
148
149 regCSUER = vx_inb(chip, CSUER);
150 regRUER = vx_inb(chip, RUER);
151
152
153 vx_outb(chip, ICR, 0);
154
155
156 snd_printdd(KERN_DEBUG "check ISR_HF2\n");
157 if (vx_check_isr(_chip, ISR_HF2, ISR_HF2, 20) < 0)
158 goto _error;
159
160
161 vx_outb(chip, ICR, ICR_HF1);
162 image = fw->data;
163 for (i = 0; i < fw->size; i++, image++) {
164 data = *image;
165 if (vx_wait_isr_bit(_chip, ISR_TX_EMPTY) < 0)
166 goto _error;
167 vx_outb(chip, TXL, data);
168
169 if (vx_wait_for_rx_full(_chip) < 0)
170 goto _error;
171 c = vx_inb(chip, RXL);
172 if (c != (int)data)
173 snd_printk(KERN_ERR "vxpocket: load xilinx mismatch at %d: 0x%x != 0x%x\n", i, c, (int)data);
174 }
175
176
177 vx_outb(chip, ICR, 0);
178
179
180 if (vx_check_isr(_chip, ISR_HF3, ISR_HF3, 20) < 0)
181 goto _error;
182
183
184 if (vx_wait_for_rx_full(_chip) < 0)
185 goto _error;
186
187 c = (int)vx_inb(chip, RXH) << 16;
188 c |= (int)vx_inb(chip, RXM) << 8;
189 c |= vx_inb(chip, RXL);
190
191 snd_printdd(KERN_DEBUG "xilinx: dsp size received 0x%x, orig 0x%zx\n", c, fw->size);
192
193 vx_outb(chip, ICR, ICR_HF0);
194
195
196 msleep(300);
197
198
199 if (vx_check_magic(_chip) < 0)
200 goto _error;
201
202
203 vx_outb(chip, CSUER, regCSUER);
204 vx_outb(chip, RUER, regRUER);
205
206
207 chip->regDIALOG |= VXP_DLG_XILINX_REPROG_MASK;
208 vx_outb(chip, DIALOG, chip->regDIALOG);
209 vx_inb(chip, DIALOG);
210 msleep(10);
211 chip->regDIALOG &= ~VXP_DLG_XILINX_REPROG_MASK;
212 vx_outb(chip, DIALOG, chip->regDIALOG);
213 vx_inb(chip, DIALOG);
214
215
216 vxp_reset_codec(_chip);
217 vx_reset_dsp(_chip);
218
219 return 0;
220
221 _error:
222 vx_outb(chip, CSUER, regCSUER);
223 vx_outb(chip, RUER, regRUER);
224 chip->regDIALOG &= ~VXP_DLG_XILINX_REPROG_MASK;
225 vx_outb(chip, DIALOG, chip->regDIALOG);
226 return -EIO;
227}
228
229
230
231
232
233static int vxp_load_dsp(struct vx_core *vx, int index, const struct firmware *fw)
234{
235 int err;
236
237 switch (index) {
238 case 0:
239
240 if ((err = vx_check_magic(vx)) < 0)
241 return err;
242 if ((err = snd_vx_load_boot_image(vx, fw)) < 0)
243 return err;
244 return 0;
245 case 1:
246
247 return vxp_load_xilinx_binary(vx, fw);
248 case 2:
249
250 return snd_vx_dsp_boot(vx, fw);
251 case 3:
252
253 return snd_vx_dsp_load(vx, fw);
254 default:
255 snd_BUG();
256 return -EINVAL;
257 }
258}
259
260
261
262
263
264
265
266
267
268static int vxp_test_and_ack(struct vx_core *_chip)
269{
270 struct snd_vxpocket *chip = to_vxpocket(_chip);
271
272
273 if (! (_chip->chip_status & VX_STAT_XILINX_LOADED))
274 return -ENXIO;
275
276 if (! (vx_inb(chip, DIALOG) & VXP_DLG_MEMIRQ_MASK))
277 return -EIO;
278
279
280
281 vx_outb(chip, DIALOG, chip->regDIALOG | VXP_DLG_ACK_MEMIRQ_MASK);
282
283
284
285 vx_inb(chip, DIALOG);
286 vx_outb(chip, DIALOG, chip->regDIALOG & ~VXP_DLG_ACK_MEMIRQ_MASK);
287
288 return 0;
289}
290
291
292
293
294
295static void vxp_validate_irq(struct vx_core *_chip, int enable)
296{
297 struct snd_vxpocket *chip = to_vxpocket(_chip);
298
299
300 if (enable)
301 chip->regCDSP |= VXP_CDSP_VALID_IRQ_MASK;
302 else
303 chip->regCDSP &= ~VXP_CDSP_VALID_IRQ_MASK;
304 vx_outb(chip, CDSP, chip->regCDSP);
305}
306
307
308
309
310
311static void vx_setup_pseudo_dma(struct vx_core *_chip, int do_write)
312{
313 struct snd_vxpocket *chip = to_vxpocket(_chip);
314
315
316 vx_outb(chip, ICR, do_write ? ICR_TREQ : ICR_RREQ);
317
318 vx_inb(chip, ISR);
319 vx_outb(chip, ISR, 0);
320
321
322 chip->regDIALOG |= VXP_DLG_DMA16_SEL_MASK;
323 chip->regDIALOG |= do_write ? VXP_DLG_DMAWRITE_SEL_MASK : VXP_DLG_DMAREAD_SEL_MASK;
324 vx_outb(chip, DIALOG, chip->regDIALOG);
325
326}
327
328
329
330
331static void vx_release_pseudo_dma(struct vx_core *_chip)
332{
333 struct snd_vxpocket *chip = to_vxpocket(_chip);
334
335
336 chip->regDIALOG &= ~(VXP_DLG_DMAWRITE_SEL_MASK|
337 VXP_DLG_DMAREAD_SEL_MASK|
338 VXP_DLG_DMA16_SEL_MASK);
339 vx_outb(chip, DIALOG, chip->regDIALOG);
340
341 vx_outb(chip, ICR, 0);
342}
343
344
345
346
347
348
349
350
351static void vxp_dma_write(struct vx_core *chip, struct snd_pcm_runtime *runtime,
352 struct vx_pipe *pipe, int count)
353{
354 long port = vxp_reg_addr(chip, VX_DMA);
355 int offset = pipe->hw_ptr;
356 unsigned short *addr = (unsigned short *)(runtime->dma_area + offset);
357
358 vx_setup_pseudo_dma(chip, 1);
359 if (offset + count >= pipe->buffer_bytes) {
360 int length = pipe->buffer_bytes - offset;
361 count -= length;
362 length >>= 1;
363
364 for (; length > 0; length--) {
365 outw(*addr, port);
366 addr++;
367 }
368 addr = (unsigned short *)runtime->dma_area;
369 pipe->hw_ptr = 0;
370 }
371 pipe->hw_ptr += count;
372 count >>= 1;
373
374 for (; count > 0; count--) {
375 outw(*addr, port);
376 addr++;
377 }
378 vx_release_pseudo_dma(chip);
379}
380
381
382
383
384
385
386
387
388
389
390static void vxp_dma_read(struct vx_core *chip, struct snd_pcm_runtime *runtime,
391 struct vx_pipe *pipe, int count)
392{
393 struct snd_vxpocket *pchip = to_vxpocket(chip);
394 long port = vxp_reg_addr(chip, VX_DMA);
395 int offset = pipe->hw_ptr;
396 unsigned short *addr = (unsigned short *)(runtime->dma_area + offset);
397
398 if (snd_BUG_ON(count % 2))
399 return;
400 vx_setup_pseudo_dma(chip, 0);
401 if (offset + count >= pipe->buffer_bytes) {
402 int length = pipe->buffer_bytes - offset;
403 count -= length;
404 length >>= 1;
405
406 for (; length > 0; length--)
407 *addr++ = inw(port);
408 addr = (unsigned short *)runtime->dma_area;
409 pipe->hw_ptr = 0;
410 }
411 pipe->hw_ptr += count;
412 count >>= 1;
413
414 for (; count > 1; count--)
415 *addr++ = inw(port);
416
417 pchip->regDIALOG &= ~VXP_DLG_DMAREAD_SEL_MASK;
418 vx_outb(chip, DIALOG, pchip->regDIALOG);
419
420 *addr = inw(port);
421
422 pchip->regDIALOG &= ~VXP_DLG_DMA16_SEL_MASK;
423 vx_outb(chip, DIALOG, pchip->regDIALOG);
424
425 vx_outb(chip, ICR, 0);
426}
427
428
429
430
431
432static void vxp_write_codec_reg(struct vx_core *chip, int codec, unsigned int data)
433{
434 int i;
435
436
437 if (! codec)
438 vx_inb(chip, LOFREQ);
439 else
440 vx_inb(chip, CODEC2);
441
442
443 for (i = 0; i < 24; i++, data <<= 1)
444 vx_outb(chip, DATA, ((data & 0x800000) ? VX_DATA_CODEC_MASK : 0));
445
446
447 vx_inb(chip, HIFREQ);
448}
449
450
451
452
453
454
455void vx_set_mic_boost(struct vx_core *chip, int boost)
456{
457 struct snd_vxpocket *pchip = to_vxpocket(chip);
458
459 if (chip->chip_status & VX_STAT_IS_STALE)
460 return;
461
462 mutex_lock(&chip->lock);
463 if (pchip->regCDSP & P24_CDSP_MICS_SEL_MASK) {
464 if (boost) {
465
466 pchip->regCDSP &= ~P24_CDSP_MIC20_SEL_MASK;
467 pchip->regCDSP |= P24_CDSP_MIC38_SEL_MASK;
468 } else {
469
470 pchip->regCDSP |= P24_CDSP_MIC20_SEL_MASK;
471 pchip->regCDSP &= ~P24_CDSP_MIC38_SEL_MASK;
472 }
473 vx_outb(chip, CDSP, pchip->regCDSP);
474 }
475 mutex_unlock(&chip->lock);
476}
477
478
479
480
481static int vx_compute_mic_level(int level)
482{
483 switch (level) {
484 case 5: level = 6 ; break;
485 case 6: level = 8 ; break;
486 case 7: level = 11; break;
487 case 8: level = 15; break;
488 default: break ;
489 }
490 return level;
491}
492
493
494
495
496
497void vx_set_mic_level(struct vx_core *chip, int level)
498{
499 struct snd_vxpocket *pchip = to_vxpocket(chip);
500
501 if (chip->chip_status & VX_STAT_IS_STALE)
502 return;
503
504 mutex_lock(&chip->lock);
505 if (pchip->regCDSP & VXP_CDSP_MIC_SEL_MASK) {
506 level = vx_compute_mic_level(level);
507 vx_outb(chip, MICRO, level);
508 }
509 mutex_unlock(&chip->lock);
510}
511
512
513
514
515
516static void vxp_change_audio_source(struct vx_core *_chip, int src)
517{
518 struct snd_vxpocket *chip = to_vxpocket(_chip);
519
520 switch (src) {
521 case VX_AUDIO_SRC_DIGITAL:
522 chip->regCDSP |= VXP_CDSP_DATAIN_SEL_MASK;
523 vx_outb(chip, CDSP, chip->regCDSP);
524 break;
525 case VX_AUDIO_SRC_LINE:
526 chip->regCDSP &= ~VXP_CDSP_DATAIN_SEL_MASK;
527 if (_chip->type == VX_TYPE_VXP440)
528 chip->regCDSP &= ~P24_CDSP_MICS_SEL_MASK;
529 else
530 chip->regCDSP &= ~VXP_CDSP_MIC_SEL_MASK;
531 vx_outb(chip, CDSP, chip->regCDSP);
532 break;
533 case VX_AUDIO_SRC_MIC:
534 chip->regCDSP &= ~VXP_CDSP_DATAIN_SEL_MASK;
535
536 if (_chip->type == VX_TYPE_VXP440) {
537 chip->regCDSP &= ~P24_CDSP_MICS_SEL_MASK;
538 if (chip->mic_level)
539 chip->regCDSP |= P24_CDSP_MIC38_SEL_MASK;
540 else
541 chip->regCDSP |= P24_CDSP_MIC20_SEL_MASK;
542 vx_outb(chip, CDSP, chip->regCDSP);
543 } else {
544 chip->regCDSP |= VXP_CDSP_MIC_SEL_MASK;
545 vx_outb(chip, CDSP, chip->regCDSP);
546 vx_outb(chip, MICRO, vx_compute_mic_level(chip->mic_level));
547 }
548 break;
549 }
550}
551
552
553
554
555
556static void vxp_set_clock_source(struct vx_core *_chip, int source)
557{
558 struct snd_vxpocket *chip = to_vxpocket(_chip);
559
560 if (source == INTERNAL_QUARTZ)
561 chip->regCDSP &= ~VXP_CDSP_CLOCKIN_SEL_MASK;
562 else
563 chip->regCDSP |= VXP_CDSP_CLOCKIN_SEL_MASK;
564 vx_outb(chip, CDSP, chip->regCDSP);
565}
566
567
568
569
570
571static void vxp_reset_board(struct vx_core *_chip, int cold_reset)
572{
573 struct snd_vxpocket *chip = to_vxpocket(_chip);
574
575 chip->regCDSP = 0;
576 chip->regDIALOG = 0;
577}
578
579
580
581
582
583
584const struct snd_vx_ops snd_vxpocket_ops = {
585 .in8 = vxp_inb,
586 .out8 = vxp_outb,
587 .test_and_ack = vxp_test_and_ack,
588 .validate_irq = vxp_validate_irq,
589 .write_codec = vxp_write_codec_reg,
590 .reset_codec = vxp_reset_codec,
591 .change_audio_source = vxp_change_audio_source,
592 .set_clock_source = vxp_set_clock_source,
593 .load_dsp = vxp_load_dsp,
594 .add_controls = vxp_add_mic_controls,
595 .reset_dsp = vxp_reset_dsp,
596 .reset_board = vxp_reset_board,
597 .dma_write = vxp_dma_write,
598 .dma_read = vxp_dma_read,
599};
600