]> nv-tegra.nvidia Code Review - linux-2.6.git/blob - sound/pcmcia/vx/vxp_ops.c
Merge branches 'oprofile-v2' and 'timers/hpet' into x86/core-v4
[linux-2.6.git] / sound / pcmcia / vx / vxp_ops.c
1 /*
2  * Driver for Digigram VXpocket soundcards
3  *
4  * lowlevel routines for VXpocket soundcards
5  *
6  * Copyright (c) 2002 by Takashi Iwai <tiwai@suse.de>
7  *
8  *   This program is free software; you can redistribute it and/or modify
9  *   it under the terms of the GNU General Public License as published by
10  *   the Free Software Foundation; either version 2 of the License, or
11  *   (at your option) any later version.
12  *
13  *   This program is distributed in the hope that it will be useful,
14  *   but WITHOUT ANY WARRANTY; without even the implied warranty of
15  *   MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
16  *   GNU General Public License for more details.
17  *
18  *   You should have received a copy of the GNU General Public License
19  *   along with this program; if not, write to the Free Software
20  *   Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA  02111-1307 USA
21  */
22
23 #include <linux/delay.h>
24 #include <linux/device.h>
25 #include <linux/firmware.h>
26 #include <sound/core.h>
27 #include <asm/io.h>
28 #include "vxpocket.h"
29
30
31 static int vxp_reg_offset[VX_REG_MAX] = {
32         [VX_ICR]        = 0x00,         // ICR
33         [VX_CVR]        = 0x01,         // CVR
34         [VX_ISR]        = 0x02,         // ISR
35         [VX_IVR]        = 0x03,         // IVR
36         [VX_RXH]        = 0x05,         // RXH
37         [VX_RXM]        = 0x06,         // RXM
38         [VX_RXL]        = 0x07,         // RXL
39         [VX_DMA]        = 0x04,         // DMA
40         [VX_CDSP]       = 0x08,         // CDSP
41         [VX_LOFREQ]     = 0x09,         // LFREQ
42         [VX_HIFREQ]     = 0x0a,         // HFREQ
43         [VX_DATA]       = 0x0b,         // DATA
44         [VX_MICRO]      = 0x0c,         // MICRO
45         [VX_DIALOG]     = 0x0d,         // DIALOG
46         [VX_CSUER]      = 0x0e,         // CSUER
47         [VX_RUER]       = 0x0f,         // RUER
48 };
49
50
51 static inline unsigned long vxp_reg_addr(struct vx_core *_chip, int reg)
52 {
53         struct snd_vxpocket *chip = (struct snd_vxpocket *)_chip;
54         return chip->port + vxp_reg_offset[reg];
55 }
56
57 /*
58  * snd_vx_inb - read a byte from the register
59  * @offset: register offset
60  */
61 static unsigned char vxp_inb(struct vx_core *chip, int offset)
62 {
63         return inb(vxp_reg_addr(chip, offset));
64 }
65
66 /*
67  * snd_vx_outb - write a byte on the register
68  * @offset: the register offset
69  * @val: the value to write
70  */
71 static void vxp_outb(struct vx_core *chip, int offset, unsigned char val)
72 {
73         outb(val, vxp_reg_addr(chip, offset));
74 }
75
76 /*
77  * redefine macros to call directly
78  */
79 #undef vx_inb
80 #define vx_inb(chip,reg)        vxp_inb((struct vx_core *)(chip), VX_##reg)
81 #undef vx_outb
82 #define vx_outb(chip,reg,val)   vxp_outb((struct vx_core *)(chip), VX_##reg,val)
83
84
85 /*
86  * vx_check_magic - check the magic word on xilinx
87  *
88  * returns zero if a magic word is detected, or a negative error code.
89  */
90 static int vx_check_magic(struct vx_core *chip)
91 {
92         unsigned long end_time = jiffies + HZ / 5;
93         int c;
94         do {
95                 c = vx_inb(chip, CDSP);
96                 if (c == CDSP_MAGIC)
97                         return 0;
98                 msleep(10);
99         } while (time_after_eq(end_time, jiffies));
100         snd_printk(KERN_ERR "cannot find xilinx magic word (%x)\n", c);
101         return -EIO;
102 }
103
104
105 /*
106  * vx_reset_dsp - reset the DSP
107  */
108
109 #define XX_DSP_RESET_WAIT_TIME          2       /* ms */
110
111 static void vxp_reset_dsp(struct vx_core *_chip)
112 {
113         struct snd_vxpocket *chip = (struct snd_vxpocket *)_chip;
114
115         /* set the reset dsp bit to 1 */
116         vx_outb(chip, CDSP, chip->regCDSP | VXP_CDSP_DSP_RESET_MASK);
117         vx_inb(chip, CDSP);
118         mdelay(XX_DSP_RESET_WAIT_TIME);
119         /* reset the bit */
120         chip->regCDSP &= ~VXP_CDSP_DSP_RESET_MASK;
121         vx_outb(chip, CDSP, chip->regCDSP);
122         vx_inb(chip, CDSP);
123         mdelay(XX_DSP_RESET_WAIT_TIME);
124 }
125
126 /*
127  * reset codec bit
128  */
129 static void vxp_reset_codec(struct vx_core *_chip)
130 {
131         struct snd_vxpocket *chip = (struct snd_vxpocket *)_chip;
132
133         /* Set the reset CODEC bit to 1. */
134         vx_outb(chip, CDSP, chip->regCDSP | VXP_CDSP_CODEC_RESET_MASK);
135         vx_inb(chip, CDSP);
136         msleep(10);
137         /* Set the reset CODEC bit to 0. */
138         chip->regCDSP &= ~VXP_CDSP_CODEC_RESET_MASK;
139         vx_outb(chip, CDSP, chip->regCDSP);
140         vx_inb(chip, CDSP);
141         msleep(1);
142 }
143
144 /*
145  * vx_load_xilinx_binary - load the xilinx binary image
146  * the binary image is the binary array converted from the bitstream file.
147  */
148 static int vxp_load_xilinx_binary(struct vx_core *_chip, const struct firmware *fw)
149 {
150         struct snd_vxpocket *chip = (struct snd_vxpocket *)_chip;
151         unsigned int i;
152         int c;
153         int regCSUER, regRUER;
154         const unsigned char *image;
155         unsigned char data;
156
157         /* Switch to programmation mode */
158         chip->regDIALOG |= VXP_DLG_XILINX_REPROG_MASK;
159         vx_outb(chip, DIALOG, chip->regDIALOG);
160
161         /* Save register CSUER and RUER */
162         regCSUER = vx_inb(chip, CSUER);
163         regRUER = vx_inb(chip, RUER);
164
165         /* reset HF0 and HF1 */
166         vx_outb(chip, ICR, 0);
167
168         /* Wait for answer HF2 equal to 1 */
169         snd_printdd(KERN_DEBUG "check ISR_HF2\n");
170         if (vx_check_isr(_chip, ISR_HF2, ISR_HF2, 20) < 0)
171                 goto _error;
172
173         /* set HF1 for loading xilinx binary */
174         vx_outb(chip, ICR, ICR_HF1);
175         image = fw->data;
176         for (i = 0; i < fw->size; i++, image++) {
177                 data = *image;
178                 if (vx_wait_isr_bit(_chip, ISR_TX_EMPTY) < 0)
179                         goto _error;
180                 vx_outb(chip, TXL, data);
181                 /* wait for reading */
182                 if (vx_wait_for_rx_full(_chip) < 0)
183                         goto _error;
184                 c = vx_inb(chip, RXL);
185                 if (c != (int)data)
186                         snd_printk(KERN_ERR "vxpocket: load xilinx mismatch at %d: 0x%x != 0x%x\n", i, c, (int)data);
187         }
188
189         /* reset HF1 */
190         vx_outb(chip, ICR, 0);
191
192         /* wait for HF3 */
193         if (vx_check_isr(_chip, ISR_HF3, ISR_HF3, 20) < 0)
194                 goto _error;
195
196         /* read the number of bytes received */
197         if (vx_wait_for_rx_full(_chip) < 0)
198                 goto _error;
199
200         c = (int)vx_inb(chip, RXH) << 16;
201         c |= (int)vx_inb(chip, RXM) << 8;
202         c |= vx_inb(chip, RXL);
203
204         snd_printdd(KERN_DEBUG "xilinx: dsp size received 0x%x, orig 0x%Zx\n", c, fw->size);
205
206         vx_outb(chip, ICR, ICR_HF0);
207
208         /* TEMPO 250ms : wait until Xilinx is downloaded */
209         msleep(300);
210
211         /* test magical word */
212         if (vx_check_magic(_chip) < 0)
213                 goto _error;
214
215         /* Restore register 0x0E and 0x0F (thus replacing COR and FCSR) */
216         vx_outb(chip, CSUER, regCSUER);
217         vx_outb(chip, RUER, regRUER);
218
219         /* Reset the Xilinx's signal enabling IO access */
220         chip->regDIALOG |= VXP_DLG_XILINX_REPROG_MASK;
221         vx_outb(chip, DIALOG, chip->regDIALOG);
222         vx_inb(chip, DIALOG);
223         msleep(10);
224         chip->regDIALOG &= ~VXP_DLG_XILINX_REPROG_MASK;
225         vx_outb(chip, DIALOG, chip->regDIALOG);
226         vx_inb(chip, DIALOG);
227
228         /* Reset of the Codec */
229         vxp_reset_codec(_chip);
230         vx_reset_dsp(_chip);
231
232         return 0;
233
234  _error:
235         vx_outb(chip, CSUER, regCSUER);
236         vx_outb(chip, RUER, regRUER);
237         chip->regDIALOG &= ~VXP_DLG_XILINX_REPROG_MASK;
238         vx_outb(chip, DIALOG, chip->regDIALOG);
239         return -EIO;
240 }
241
242
243 /*
244  * vxp_load_dsp - load_dsp callback
245  */
246 static int vxp_load_dsp(struct vx_core *vx, int index, const struct firmware *fw)
247 {
248         int err;
249
250         switch (index) {
251         case 0:
252                 /* xilinx boot */
253                 if ((err = vx_check_magic(vx)) < 0)
254                         return err;
255                 if ((err = snd_vx_load_boot_image(vx, fw)) < 0)
256                         return err;
257                 return 0;
258         case 1:
259                 /* xilinx image */
260                 return vxp_load_xilinx_binary(vx, fw);
261         case 2:
262                 /* DSP boot */
263                 return snd_vx_dsp_boot(vx, fw);
264         case 3:
265                 /* DSP image */
266                 return snd_vx_dsp_load(vx, fw);
267         default:
268                 snd_BUG();
269                 return -EINVAL;
270         }
271 }
272                 
273
274 /*
275  * vx_test_and_ack - test and acknowledge interrupt
276  *
277  * called from irq hander, too
278  *
279  * spinlock held!
280  */
281 static int vxp_test_and_ack(struct vx_core *_chip)
282 {
283         struct snd_vxpocket *chip = (struct snd_vxpocket *)_chip;
284
285         /* not booted yet? */
286         if (! (_chip->chip_status & VX_STAT_XILINX_LOADED))
287                 return -ENXIO;
288
289         if (! (vx_inb(chip, DIALOG) & VXP_DLG_MEMIRQ_MASK))
290                 return -EIO;
291         
292         /* ok, interrupts generated, now ack it */
293         /* set ACQUIT bit up and down */
294         vx_outb(chip, DIALOG, chip->regDIALOG | VXP_DLG_ACK_MEMIRQ_MASK);
295         /* useless read just to spend some time and maintain
296          * the ACQUIT signal up for a while ( a bus cycle )
297          */
298         vx_inb(chip, DIALOG);
299         vx_outb(chip, DIALOG, chip->regDIALOG & ~VXP_DLG_ACK_MEMIRQ_MASK);
300
301         return 0;
302 }
303
304
305 /*
306  * vx_validate_irq - enable/disable IRQ
307  */
308 static void vxp_validate_irq(struct vx_core *_chip, int enable)
309 {
310         struct snd_vxpocket *chip = (struct snd_vxpocket *)_chip;
311
312         /* Set the interrupt enable bit to 1 in CDSP register */
313         if (enable)
314                 chip->regCDSP |= VXP_CDSP_VALID_IRQ_MASK;
315         else
316                 chip->regCDSP &= ~VXP_CDSP_VALID_IRQ_MASK;
317         vx_outb(chip, CDSP, chip->regCDSP);
318 }
319
320 /*
321  * vx_setup_pseudo_dma - set up the pseudo dma read/write mode.
322  * @do_write: 0 = read, 1 = set up for DMA write
323  */
324 static void vx_setup_pseudo_dma(struct vx_core *_chip, int do_write)
325 {
326         struct snd_vxpocket *chip = (struct snd_vxpocket *)_chip;
327
328         /* Interrupt mode and HREQ pin enabled for host transmit / receive data transfers */
329         vx_outb(chip, ICR, do_write ? ICR_TREQ : ICR_RREQ);
330         /* Reset the pseudo-dma register */
331         vx_inb(chip, ISR);
332         vx_outb(chip, ISR, 0);
333
334         /* Select DMA in read/write transfer mode and in 16-bit accesses */
335         chip->regDIALOG |= VXP_DLG_DMA16_SEL_MASK;
336         chip->regDIALOG |= do_write ? VXP_DLG_DMAWRITE_SEL_MASK : VXP_DLG_DMAREAD_SEL_MASK;
337         vx_outb(chip, DIALOG, chip->regDIALOG);
338
339 }
340
341 /*
342  * vx_release_pseudo_dma - disable the pseudo-DMA mode
343  */
344 static void vx_release_pseudo_dma(struct vx_core *_chip)
345 {
346         struct snd_vxpocket *chip = (struct snd_vxpocket *)_chip;
347
348         /* Disable DMA and 16-bit accesses */
349         chip->regDIALOG &= ~(VXP_DLG_DMAWRITE_SEL_MASK|
350                              VXP_DLG_DMAREAD_SEL_MASK|
351                              VXP_DLG_DMA16_SEL_MASK);
352         vx_outb(chip, DIALOG, chip->regDIALOG);
353         /* HREQ pin disabled. */
354         vx_outb(chip, ICR, 0);
355 }
356
357 /*
358  * vx_pseudo_dma_write - write bulk data on pseudo-DMA mode
359  * @count: data length to transfer in bytes
360  *
361  * data size must be aligned to 6 bytes to ensure the 24bit alignment on DSP.
362  * NB: call with a certain lock!
363  */
364 static void vxp_dma_write(struct vx_core *chip, struct snd_pcm_runtime *runtime,
365                           struct vx_pipe *pipe, int count)
366 {
367         long port = vxp_reg_addr(chip, VX_DMA);
368         int offset = pipe->hw_ptr;
369         unsigned short *addr = (unsigned short *)(runtime->dma_area + offset);
370
371         vx_setup_pseudo_dma(chip, 1);
372         if (offset + count > pipe->buffer_bytes) {
373                 int length = pipe->buffer_bytes - offset;
374                 count -= length;
375                 length >>= 1; /* in 16bit words */
376                 /* Transfer using pseudo-dma. */
377                 while (length-- > 0) {
378                         outw(cpu_to_le16(*addr), port);
379                         addr++;
380                 }
381                 addr = (unsigned short *)runtime->dma_area;
382                 pipe->hw_ptr = 0;
383         }
384         pipe->hw_ptr += count;
385         count >>= 1; /* in 16bit words */
386         /* Transfer using pseudo-dma. */
387         while (count-- > 0) {
388                 outw(cpu_to_le16(*addr), port);
389                 addr++;
390         }
391         vx_release_pseudo_dma(chip);
392 }
393
394
395 /*
396  * vx_pseudo_dma_read - read bulk data on pseudo DMA mode
397  * @offset: buffer offset in bytes
398  * @count: data length to transfer in bytes
399  *
400  * the read length must be aligned to 6 bytes, as well as write.
401  * NB: call with a certain lock!
402  */
403 static void vxp_dma_read(struct vx_core *chip, struct snd_pcm_runtime *runtime,
404                          struct vx_pipe *pipe, int count)
405 {
406         struct snd_vxpocket *pchip = (struct snd_vxpocket *)chip;
407         long port = vxp_reg_addr(chip, VX_DMA);
408         int offset = pipe->hw_ptr;
409         unsigned short *addr = (unsigned short *)(runtime->dma_area + offset);
410
411         if (snd_BUG_ON(count % 2))
412                 return;
413         vx_setup_pseudo_dma(chip, 0);
414         if (offset + count > pipe->buffer_bytes) {
415                 int length = pipe->buffer_bytes - offset;
416                 count -= length;
417                 length >>= 1; /* in 16bit words */
418                 /* Transfer using pseudo-dma. */
419                 while (length-- > 0)
420                         *addr++ = le16_to_cpu(inw(port));
421                 addr = (unsigned short *)runtime->dma_area;
422                 pipe->hw_ptr = 0;
423         }
424         pipe->hw_ptr += count;
425         count >>= 1; /* in 16bit words */
426         /* Transfer using pseudo-dma. */
427         while (count-- > 1)
428                 *addr++ = le16_to_cpu(inw(port));
429         /* Disable DMA */
430         pchip->regDIALOG &= ~VXP_DLG_DMAREAD_SEL_MASK;
431         vx_outb(chip, DIALOG, pchip->regDIALOG);
432         /* Read the last word (16 bits) */
433         *addr = le16_to_cpu(inw(port));
434         /* Disable 16-bit accesses */
435         pchip->regDIALOG &= ~VXP_DLG_DMA16_SEL_MASK;
436         vx_outb(chip, DIALOG, pchip->regDIALOG);
437         /* HREQ pin disabled. */
438         vx_outb(chip, ICR, 0);
439 }
440
441
442 /*
443  * write a codec data (24bit)
444  */
445 static void vxp_write_codec_reg(struct vx_core *chip, int codec, unsigned int data)
446 {
447         int i;
448
449         /* Activate access to the corresponding codec register */
450         if (! codec)
451                 vx_inb(chip, LOFREQ);
452         else
453                 vx_inb(chip, CODEC2);
454                 
455         /* We have to send 24 bits (3 x 8 bits). Start with most signif. Bit */
456         for (i = 0; i < 24; i++, data <<= 1)
457                 vx_outb(chip, DATA, ((data & 0x800000) ? VX_DATA_CODEC_MASK : 0));
458         
459         /* Terminate access to codec registers */
460         vx_inb(chip, HIFREQ);
461 }
462
463
464 /*
465  * vx_set_mic_boost - set mic boost level (on vxp440 only)
466  * @boost: 0 = 20dB, 1 = +38dB
467  */
468 void vx_set_mic_boost(struct vx_core *chip, int boost)
469 {
470         struct snd_vxpocket *pchip = (struct snd_vxpocket *)chip;
471         unsigned long flags;
472
473         if (chip->chip_status & VX_STAT_IS_STALE)
474                 return;
475
476         spin_lock_irqsave(&chip->lock, flags);
477         if (pchip->regCDSP & P24_CDSP_MICS_SEL_MASK) {
478                 if (boost) {
479                         /* boost: 38 dB */
480                         pchip->regCDSP &= ~P24_CDSP_MIC20_SEL_MASK;
481                         pchip->regCDSP |=  P24_CDSP_MIC38_SEL_MASK;
482                 } else {
483                         /* minimum value: 20 dB */
484                         pchip->regCDSP |=  P24_CDSP_MIC20_SEL_MASK;
485                         pchip->regCDSP &= ~P24_CDSP_MIC38_SEL_MASK;
486                 }
487                 vx_outb(chip, CDSP, pchip->regCDSP);
488         }
489         spin_unlock_irqrestore(&chip->lock, flags);
490 }
491
492 /*
493  * remap the linear value (0-8) to the actual value (0-15)
494  */
495 static int vx_compute_mic_level(int level)
496 {
497         switch (level) {
498         case 5: level = 6 ; break;
499         case 6: level = 8 ; break;
500         case 7: level = 11; break;
501         case 8: level = 15; break;
502         default: break ;
503         }
504         return level;
505 }
506
507 /*
508  * vx_set_mic_level - set mic level (on vxpocket only)
509  * @level: the mic level = 0 - 8 (max)
510  */
511 void vx_set_mic_level(struct vx_core *chip, int level)
512 {
513         struct snd_vxpocket *pchip = (struct snd_vxpocket *)chip;
514         unsigned long flags;
515
516         if (chip->chip_status & VX_STAT_IS_STALE)
517                 return;
518
519         spin_lock_irqsave(&chip->lock, flags);
520         if (pchip->regCDSP & VXP_CDSP_MIC_SEL_MASK) {
521                 level = vx_compute_mic_level(level);
522                 vx_outb(chip, MICRO, level);
523         }
524         spin_unlock_irqrestore(&chip->lock, flags);
525 }
526
527
528 /*
529  * change the input audio source
530  */
531 static void vxp_change_audio_source(struct vx_core *_chip, int src)
532 {
533         struct snd_vxpocket *chip = (struct snd_vxpocket *)_chip;
534
535         switch (src) {
536         case VX_AUDIO_SRC_DIGITAL:
537                 chip->regCDSP |= VXP_CDSP_DATAIN_SEL_MASK;
538                 vx_outb(chip, CDSP, chip->regCDSP);
539                 break;
540         case VX_AUDIO_SRC_LINE:
541                 chip->regCDSP &= ~VXP_CDSP_DATAIN_SEL_MASK;
542                 if (_chip->type == VX_TYPE_VXP440)
543                         chip->regCDSP &= ~P24_CDSP_MICS_SEL_MASK;
544                 else
545                         chip->regCDSP &= ~VXP_CDSP_MIC_SEL_MASK;
546                 vx_outb(chip, CDSP, chip->regCDSP);
547                 break;
548         case VX_AUDIO_SRC_MIC:
549                 chip->regCDSP &= ~VXP_CDSP_DATAIN_SEL_MASK;
550                 /* reset mic levels */
551                 if (_chip->type == VX_TYPE_VXP440) {
552                         chip->regCDSP &= ~P24_CDSP_MICS_SEL_MASK;
553                         if (chip->mic_level)
554                                 chip->regCDSP |=  P24_CDSP_MIC38_SEL_MASK;
555                         else
556                                 chip->regCDSP |= P24_CDSP_MIC20_SEL_MASK;
557                         vx_outb(chip, CDSP, chip->regCDSP);
558                 } else {
559                         chip->regCDSP |= VXP_CDSP_MIC_SEL_MASK;
560                         vx_outb(chip, CDSP, chip->regCDSP);
561                         vx_outb(chip, MICRO, vx_compute_mic_level(chip->mic_level));
562                 }
563                 break;
564         }
565 }
566
567 /*
568  * change the clock source
569  * source = INTERNAL_QUARTZ or UER_SYNC
570  */
571 static void vxp_set_clock_source(struct vx_core *_chip, int source)
572 {
573         struct snd_vxpocket *chip = (struct snd_vxpocket *)_chip;
574
575         if (source == INTERNAL_QUARTZ)
576                 chip->regCDSP &= ~VXP_CDSP_CLOCKIN_SEL_MASK;
577         else
578                 chip->regCDSP |= VXP_CDSP_CLOCKIN_SEL_MASK;
579         vx_outb(chip, CDSP, chip->regCDSP);
580 }
581
582
583 /*
584  * reset the board
585  */
586 static void vxp_reset_board(struct vx_core *_chip, int cold_reset)
587 {
588         struct snd_vxpocket *chip = (struct snd_vxpocket *)_chip;
589
590         chip->regCDSP = 0;
591         chip->regDIALOG = 0;
592 }
593
594
595 /*
596  * callbacks
597  */
598 /* exported */
599 struct snd_vx_ops snd_vxpocket_ops = {
600         .in8 = vxp_inb,
601         .out8 = vxp_outb,
602         .test_and_ack = vxp_test_and_ack,
603         .validate_irq = vxp_validate_irq,
604         .write_codec = vxp_write_codec_reg,
605         .reset_codec = vxp_reset_codec,
606         .change_audio_source = vxp_change_audio_source,
607         .set_clock_source = vxp_set_clock_source,
608         .load_dsp = vxp_load_dsp,
609         .add_controls = vxp_add_mic_controls,
610         .reset_dsp = vxp_reset_dsp,
611         .reset_board = vxp_reset_board,
612         .dma_write = vxp_dma_write,
613         .dma_read = vxp_dma_read,
614 };