?  search:
summary | log | graphiclog1 | graphiclog2 | commit | commitdiff | tree | refs | edit | fork
blame | history | raw | HEAD
be2net: account for skb allocation failures
[linux-2.6.git] / sound / pci / fm801.c
bloba7ec7030cf87e9773a1ce1f58ee318ace075498a
1 /*
2 * The driver for the ForteMedia FM801 based soundcards
3 * Copyright (c) by Jaroslav Kysela <perex@perex.cz>
4 *
5 * Support FM only card by Andy Shevchenko <andy@smile.org.ua>
6 *
7 * This program is free software; you can redistribute it and/or modify
8 * it under the terms of the GNU General Public License as published by
9 * the Free Software Foundation; either version 2 of the License, or
10 * (at your option) any later version.
11 *
12 * This program is distributed in the hope that it will be useful,
13 * but WITHOUT ANY WARRANTY; without even the implied warranty of
14 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
15 * GNU General Public License for more details.
16 *
17 * You should have received a copy of the GNU General Public License
18 * along with this program; if not, write to the Free Software
19 * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA
20 *
21 */
22
23 #include <linux/delay.h>
24 #include <linux/init.h>
25 #include <linux/interrupt.h>
26 #include <linux/pci.h>
27 #include <linux/slab.h>
28 #include <linux/moduleparam.h>
29 #include <sound/core.h>
30 #include <sound/pcm.h>
31 #include <sound/tlv.h>
32 #include <sound/ac97_codec.h>
33 #include <sound/mpu401.h>
34 #include <sound/opl3.h>
35 #include <sound/initval.h>
36
37 #include <asm/io.h>
38
39 #ifdef CONFIG_SND_FM801_TEA575X_BOOL
40 #include <sound/tea575x-tuner.h>
41 #endif
42
43 MODULE_AUTHOR("Jaroslav Kysela <perex@perex.cz>");
44 MODULE_DESCRIPTION("ForteMedia FM801");
45 MODULE_LICENSE("GPL");
46 MODULE_SUPPORTED_DEVICE("{{ForteMedia,FM801},"
47 "{Genius,SoundMaker Live 5.1}}");
48
49 static int index[SNDRV_CARDS] = SNDRV_DEFAULT_IDX; /* Index 0-MAX */
50 static char *id[SNDRV_CARDS] = SNDRV_DEFAULT_STR; /* ID for this card */
51 static int enable[SNDRV_CARDS] = SNDRV_DEFAULT_ENABLE_PNP; /* Enable this card */
52 /*
53 * Enable TEA575x tuner
54 * 1 = MediaForte 256-PCS
55 * 2 = MediaForte 256-PCP
56 * 3 = MediaForte 64-PCR
57 * 16 = setup tuner only (this is additional bit), i.e. SF64-PCR FM card
58 * High 16-bits are video (radio) device number + 1
59 */
60 static int tea575x_tuner[SNDRV_CARDS];
61
62 module_param_array(index, int, NULL, 0444);
63 MODULE_PARM_DESC(index, "Index value for the FM801 soundcard.");
64 module_param_array(id, charp, NULL, 0444);
65 MODULE_PARM_DESC(id, "ID string for the FM801 soundcard.");
66 module_param_array(enable, bool, NULL, 0444);
67 MODULE_PARM_DESC(enable, "Enable FM801 soundcard.");
68 module_param_array(tea575x_tuner, int, NULL, 0444);
69 MODULE_PARM_DESC(tea575x_tuner, "TEA575x tuner access method (0 = auto, 1 = SF256-PCS, 2=SF256-PCP, 3=SF64-PCR, 8=disable, +16=tuner-only).");
70
71 #define TUNER_ONLY (1<<4)
72 #define TUNER_TYPE_MASK (~TUNER_ONLY & 0xFFFF)
73
74 /*
75 * Direct registers
76 */
77
78 #define FM801_REG(chip, reg) (chip->port + FM801_##reg)
79
80 #define FM801_PCM_VOL 0x00 /* PCM Output Volume */
81 #define FM801_FM_VOL 0x02 /* FM Output Volume */
82 #define FM801_I2S_VOL 0x04 /* I2S Volume */
83 #define FM801_REC_SRC 0x06 /* Record Source */
84 #define FM801_PLY_CTRL 0x08 /* Playback Control */
85 #define FM801_PLY_COUNT 0x0a /* Playback Count */
86 #define FM801_PLY_BUF1 0x0c /* Playback Bufer I */
87 #define FM801_PLY_BUF2 0x10 /* Playback Buffer II */
88 #define FM801_CAP_CTRL 0x14 /* Capture Control */
89 #define FM801_CAP_COUNT 0x16 /* Capture Count */
90 #define FM801_CAP_BUF1 0x18 /* Capture Buffer I */
91 #define FM801_CAP_BUF2 0x1c /* Capture Buffer II */
92 #define FM801_CODEC_CTRL 0x22 /* Codec Control */
93 #define FM801_I2S_MODE 0x24 /* I2S Mode Control */
94 #define FM801_VOLUME 0x26 /* Volume Up/Down/Mute Status */
95 #define FM801_I2C_CTRL 0x29 /* I2C Control */
96 #define FM801_AC97_CMD 0x2a /* AC'97 Command */
97 #define FM801_AC97_DATA 0x2c /* AC'97 Data */
98 #define FM801_MPU401_DATA 0x30 /* MPU401 Data */
99 #define FM801_MPU401_CMD 0x31 /* MPU401 Command */
100 #define FM801_GPIO_CTRL 0x52 /* General Purpose I/O Control */
101 #define FM801_GEN_CTRL 0x54 /* General Control */
102 #define FM801_IRQ_MASK 0x56 /* Interrupt Mask */
103 #define FM801_IRQ_STATUS 0x5a /* Interrupt Status */
104 #define FM801_OPL3_BANK0 0x68 /* OPL3 Status Read / Bank 0 Write */
105 #define FM801_OPL3_DATA0 0x69 /* OPL3 Data 0 Write */
106 #define FM801_OPL3_BANK1 0x6a /* OPL3 Bank 1 Write */
107 #define FM801_OPL3_DATA1 0x6b /* OPL3 Bank 1 Write */
108 #define FM801_POWERDOWN 0x70 /* Blocks Power Down Control */
109
110 /* codec access */
111 #define FM801_AC97_READ (1<<7) /* read=1, write=0 */
112 #define FM801_AC97_VALID (1<<8) /* port valid=1 */
113 #define FM801_AC97_BUSY (1<<9) /* busy=1 */
114 #define FM801_AC97_ADDR_SHIFT 10 /* codec id (2bit) */
115
116 /* playback and record control register bits */
117 #define FM801_BUF1_LAST (1<<1)
118 #define FM801_BUF2_LAST (1<<2)
119 #define FM801_START (1<<5)
120 #define FM801_PAUSE (1<<6)
121 #define FM801_IMMED_STOP (1<<7)
122 #define FM801_RATE_SHIFT 8
123 #define FM801_RATE_MASK (15 << FM801_RATE_SHIFT)
124 #define FM801_CHANNELS_4 (1<<12) /* playback only */
125 #define FM801_CHANNELS_6 (2<<12) /* playback only */
126 #define FM801_CHANNELS_6MS (3<<12) /* playback only */
127 #define FM801_CHANNELS_MASK (3<<12)
128 #define FM801_16BIT (1<<14)
129 #define FM801_STEREO (1<<15)
130
131 /* IRQ status bits */
132 #define FM801_IRQ_PLAYBACK (1<<8)
133 #define FM801_IRQ_CAPTURE (1<<9)
134 #define FM801_IRQ_VOLUME (1<<14)
135 #define FM801_IRQ_MPU (1<<15)
136
137 /* GPIO control register */
138 #define FM801_GPIO_GP0 (1<<0) /* read/write */
139 #define FM801_GPIO_GP1 (1<<1)
140 #define FM801_GPIO_GP2 (1<<2)
141 #define FM801_GPIO_GP3 (1<<3)
142 #define FM801_GPIO_GP(x) (1<<(0+(x)))
143 #define FM801_GPIO_GD0 (1<<8) /* directions: 1 = input, 0 = output*/
144 #define FM801_GPIO_GD1 (1<<9)
145 #define FM801_GPIO_GD2 (1<<10)
146 #define FM801_GPIO_GD3 (1<<11)
147 #define FM801_GPIO_GD(x) (1<<(8+(x)))
148 #define FM801_GPIO_GS0 (1<<12) /* function select: */
149 #define FM801_GPIO_GS1 (1<<13) /* 1 = GPIO */
150 #define FM801_GPIO_GS2 (1<<14) /* 0 = other (S/PDIF, VOL) */
151 #define FM801_GPIO_GS3 (1<<15)
152 #define FM801_GPIO_GS(x) (1<<(12+(x)))
153
154 /*
155
156 */
157
158 struct fm801 {
159 int irq;
160
161 unsigned long port; /* I/O port number */
162 unsigned int multichannel: 1, /* multichannel support */
163 secondary: 1; /* secondary codec */
164 unsigned char secondary_addr; /* address of the secondary codec */
165 unsigned int tea575x_tuner; /* tuner access method & flags */
166
167 unsigned short ply_ctrl; /* playback control */
168 unsigned short cap_ctrl; /* capture control */
169
170 unsigned long ply_buffer;
171 unsigned int ply_buf;
172 unsigned int ply_count;
173 unsigned int ply_size;
174 unsigned int ply_pos;
175
176 unsigned long cap_buffer;
177 unsigned int cap_buf;
178 unsigned int cap_count;
179 unsigned int cap_size;
180 unsigned int cap_pos;
181
182 struct snd_ac97_bus *ac97_bus;
183 struct snd_ac97 *ac97;
184 struct snd_ac97 *ac97_sec;
185
186 struct pci_dev *pci;
187 struct snd_card *card;
188 struct snd_pcm *pcm;
189 struct snd_rawmidi *rmidi;
190 struct snd_pcm_substream *playback_substream;
191 struct snd_pcm_substream *capture_substream;
192 unsigned int p_dma_size;
193 unsigned int c_dma_size;
194
195 spinlock_t reg_lock;
196 struct snd_info_entry *proc_entry;
197
198 #ifdef CONFIG_SND_FM801_TEA575X_BOOL
199 struct snd_tea575x tea;
200 #endif
201
202 #ifdef CONFIG_PM
203 u16 saved_regs[0x20];
204 #endif
205 };
206
207 static DEFINE_PCI_DEVICE_TABLE(snd_fm801_ids) = {
208 { 0x1319, 0x0801, PCI_ANY_ID, PCI_ANY_ID, PCI_CLASS_MULTIMEDIA_AUDIO << 8, 0xffff00, 0, }, /* FM801 */
209 { 0x5213, 0x0510, PCI_ANY_ID, PCI_ANY_ID, PCI_CLASS_MULTIMEDIA_AUDIO << 8, 0xffff00, 0, }, /* Gallant Odyssey Sound 4 */
210 { 0, }
211 };
212
213 MODULE_DEVICE_TABLE(pci, snd_fm801_ids);
214
215 /*
216 * common I/O routines
217 */
218
219 static int snd_fm801_update_bits(struct fm801 *chip, unsigned short reg,
220 unsigned short mask, unsigned short value)
221 {
222 int change;
223 unsigned long flags;
224 unsigned short old, new;
225
226 spin_lock_irqsave(&chip->reg_lock, flags);
227 old = inw(chip->port + reg);
228 new = (old & ~mask) | value;
229 change = old != new;
230 if (change)
231 outw(new, chip->port + reg);
232 spin_unlock_irqrestore(&chip->reg_lock, flags);
233 return change;
234 }
235
236 static void snd_fm801_codec_write(struct snd_ac97 *ac97,
237 unsigned short reg,
238 unsigned short val)
239 {
240 struct fm801 *chip = ac97->private_data;
241 int idx;
242
243 /*
244 * Wait until the codec interface is not ready..
245 */
246 for (idx = 0; idx < 100; idx++) {
247 if (!(inw(FM801_REG(chip, AC97_CMD)) & FM801_AC97_BUSY))
248 goto ok1;
249 udelay(10);
250 }
251 snd_printk(KERN_ERR "AC'97 interface is busy (1)\n");
252 return;
253
254 ok1:
255 /* write data and address */
256 outw(val, FM801_REG(chip, AC97_DATA));
257 outw(reg | (ac97->addr << FM801_AC97_ADDR_SHIFT), FM801_REG(chip, AC97_CMD));
258 /*
259 * Wait until the write command is not completed..
260 */
261 for (idx = 0; idx < 1000; idx++) {
262 if (!(inw(FM801_REG(chip, AC97_CMD)) & FM801_AC97_BUSY))
263 return;
264 udelay(10);
265 }
266 snd_printk(KERN_ERR "AC'97 interface #%d is busy (2)\n", ac97->num);
267 }
268
269 static unsigned short snd_fm801_codec_read(struct snd_ac97 *ac97, unsigned short reg)
270 {
271 struct fm801 *chip = ac97->private_data;
272 int idx;
273
274 /*
275 * Wait until the codec interface is not ready..
276 */
277 for (idx = 0; idx < 100; idx++) {
278 if (!(inw(FM801_REG(chip, AC97_CMD)) & FM801_AC97_BUSY))
279 goto ok1;
280 udelay(10);
281 }
282 snd_printk(KERN_ERR "AC'97 interface is busy (1)\n");
283 return 0;
284
285 ok1:
286 /* read command */
287 outw(reg | (ac97->addr << FM801_AC97_ADDR_SHIFT) | FM801_AC97_READ,
288 FM801_REG(chip, AC97_CMD));
289 for (idx = 0; idx < 100; idx++) {
290 if (!(inw(FM801_REG(chip, AC97_CMD)) & FM801_AC97_BUSY))
291 goto ok2;
292 udelay(10);
293 }
294 snd_printk(KERN_ERR "AC'97 interface #%d is busy (2)\n", ac97->num);
295 return 0;
296
297 ok2:
298 for (idx = 0; idx < 1000; idx++) {
299 if (inw(FM801_REG(chip, AC97_CMD)) & FM801_AC97_VALID)
300 goto ok3;
301 udelay(10);
302 }
303 snd_printk(KERN_ERR "AC'97 interface #%d is not valid (2)\n", ac97->num);
304 return 0;
305
306 ok3:
307 return inw(FM801_REG(chip, AC97_DATA));
308 }
309
310 static unsigned int rates[] = {
311 5500, 8000, 9600, 11025,
312 16000, 19200, 22050, 32000,
313 38400, 44100, 48000
314 };
315
316 static struct snd_pcm_hw_constraint_list hw_constraints_rates = {
317 .count = ARRAY_SIZE(rates),
318 .list = rates,
319 .mask = 0,
320 };
321
322 static unsigned int channels[] = {
323 2, 4, 6
324 };
325
326 static struct snd_pcm_hw_constraint_list hw_constraints_channels = {
327 .count = ARRAY_SIZE(channels),
328 .list = channels,
329 .mask = 0,
330 };
331
332 /*
333 * Sample rate routines
334 */
335
336 static unsigned short snd_fm801_rate_bits(unsigned int rate)
337 {
338 unsigned int idx;
339
340 for (idx = 0; idx < ARRAY_SIZE(rates); idx++)
341 if (rates[idx] == rate)
342 return idx;
343 snd_BUG();
344 return ARRAY_SIZE(rates) - 1;
345 }
346
347 /*
348 * PCM part
349 */
350
351 static int snd_fm801_playback_trigger(struct snd_pcm_substream *substream,
352 int cmd)
353 {
354 struct fm801 *chip = snd_pcm_substream_chip(substream);
355
356 spin_lock(&chip->reg_lock);
357 switch (cmd) {
358 case SNDRV_PCM_TRIGGER_START:
359 chip->ply_ctrl &= ~(FM801_BUF1_LAST |
360 FM801_BUF2_LAST |
361 FM801_PAUSE);
362 chip->ply_ctrl |= FM801_START |
363 FM801_IMMED_STOP;
364 break;
365 case SNDRV_PCM_TRIGGER_STOP:
366 chip->ply_ctrl &= ~(FM801_START | FM801_PAUSE);
367 break;
368 case SNDRV_PCM_TRIGGER_PAUSE_PUSH:
369 case SNDRV_PCM_TRIGGER_SUSPEND:
370 chip->ply_ctrl |= FM801_PAUSE;
371 break;
372 case SNDRV_PCM_TRIGGER_PAUSE_RELEASE:
373 case SNDRV_PCM_TRIGGER_RESUME:
374 chip->ply_ctrl &= ~FM801_PAUSE;
375 break;
376 default:
377 spin_unlock(&chip->reg_lock);
378 snd_BUG();
379 return -EINVAL;
380 }
381 outw(chip->ply_ctrl, FM801_REG(chip, PLY_CTRL));
382 spin_unlock(&chip->reg_lock);
383 return 0;
384 }
385
386 static int snd_fm801_capture_trigger(struct snd_pcm_substream *substream,
387 int cmd)
388 {
389 struct fm801 *chip = snd_pcm_substream_chip(substream);
390
391 spin_lock(&chip->reg_lock);
392 switch (cmd) {
393 case SNDRV_PCM_TRIGGER_START:
394 chip->cap_ctrl &= ~(FM801_BUF1_LAST |
395 FM801_BUF2_LAST |
396 FM801_PAUSE);
397 chip->cap_ctrl |= FM801_START |
398 FM801_IMMED_STOP;
399 break;
400 case SNDRV_PCM_TRIGGER_STOP:
401 chip->cap_ctrl &= ~(FM801_START | FM801_PAUSE);
402 break;
403 case SNDRV_PCM_TRIGGER_PAUSE_PUSH:
404 case SNDRV_PCM_TRIGGER_SUSPEND:
405 chip->cap_ctrl |= FM801_PAUSE;
406 break;
407 case SNDRV_PCM_TRIGGER_PAUSE_RELEASE:
408 case SNDRV_PCM_TRIGGER_RESUME:
409 chip->cap_ctrl &= ~FM801_PAUSE;
410 break;
411 default:
412 spin_unlock(&chip->reg_lock);
413 snd_BUG();
414 return -EINVAL;
415 }
416 outw(chip->cap_ctrl, FM801_REG(chip, CAP_CTRL));
417 spin_unlock(&chip->reg_lock);
418 return 0;
419 }
420
421 static int snd_fm801_hw_params(struct snd_pcm_substream *substream,
422 struct snd_pcm_hw_params *hw_params)
423 {
424 return snd_pcm_lib_malloc_pages(substream, params_buffer_bytes(hw_params));
425 }
426
427 static int snd_fm801_hw_free(struct snd_pcm_substream *substream)
428 {
429 return snd_pcm_lib_free_pages(substream);
430 }
431
432 static int snd_fm801_playback_prepare(struct snd_pcm_substream *substream)
433 {
434 struct fm801 *chip = snd_pcm_substream_chip(substream);
435 struct snd_pcm_runtime *runtime = substream->runtime;
436
437 chip->ply_size = snd_pcm_lib_buffer_bytes(substream);
438 chip->ply_count = snd_pcm_lib_period_bytes(substream);
439 spin_lock_irq(&chip->reg_lock);
440 chip->ply_ctrl &= ~(FM801_START | FM801_16BIT |
441 FM801_STEREO | FM801_RATE_MASK |
442 FM801_CHANNELS_MASK);
443 if (snd_pcm_format_width(runtime->format) == 16)
444 chip->ply_ctrl |= FM801_16BIT;
445 if (runtime->channels > 1) {
446 chip->ply_ctrl |= FM801_STEREO;
447 if (runtime->channels == 4)
448 chip->ply_ctrl |= FM801_CHANNELS_4;
449 else if (runtime->channels == 6)
450 chip->ply_ctrl |= FM801_CHANNELS_6;
451 }
452 chip->ply_ctrl |= snd_fm801_rate_bits(runtime->rate) << FM801_RATE_SHIFT;
453 chip->ply_buf = 0;
454 outw(chip->ply_ctrl, FM801_REG(chip, PLY_CTRL));
455 outw(chip->ply_count - 1, FM801_REG(chip, PLY_COUNT));
456 chip->ply_buffer = runtime->dma_addr;
457 chip->ply_pos = 0;
458 outl(chip->ply_buffer, FM801_REG(chip, PLY_BUF1));
459 outl(chip->ply_buffer + (chip->ply_count % chip->ply_size), FM801_REG(chip, PLY_BUF2));
460 spin_unlock_irq(&chip->reg_lock);
461 return 0;
462 }
463
464 static int snd_fm801_capture_prepare(struct snd_pcm_substream *substream)
465 {
466 struct fm801 *chip = snd_pcm_substream_chip(substream);
467 struct snd_pcm_runtime *runtime = substream->runtime;
468
469 chip->cap_size = snd_pcm_lib_buffer_bytes(substream);
470 chip->cap_count = snd_pcm_lib_period_bytes(substream);
471 spin_lock_irq(&chip->reg_lock);
472 chip->cap_ctrl &= ~(FM801_START | FM801_16BIT |
473 FM801_STEREO | FM801_RATE_MASK);
474 if (snd_pcm_format_width(runtime->format) == 16)
475 chip->cap_ctrl |= FM801_16BIT;
476 if (runtime->channels > 1)
477 chip->cap_ctrl |= FM801_STEREO;
478 chip->cap_ctrl |= snd_fm801_rate_bits(runtime->rate) << FM801_RATE_SHIFT;
479 chip->cap_buf = 0;
480 outw(chip->cap_ctrl, FM801_REG(chip, CAP_CTRL));
481 outw(chip->cap_count - 1, FM801_REG(chip, CAP_COUNT));
482 chip->cap_buffer = runtime->dma_addr;
483 chip->cap_pos = 0;
484 outl(chip->cap_buffer, FM801_REG(chip, CAP_BUF1));
485 outl(chip->cap_buffer + (chip->cap_count % chip->cap_size), FM801_REG(chip, CAP_BUF2));
486 spin_unlock_irq(&chip->reg_lock);
487 return 0;
488 }
489
490 static snd_pcm_uframes_t snd_fm801_playback_pointer(struct snd_pcm_substream *substream)
491 {
492 struct fm801 *chip = snd_pcm_substream_chip(substream);
493 size_t ptr;
494
495 if (!(chip->ply_ctrl & FM801_START))
496 return 0;
497 spin_lock(&chip->reg_lock);
498 ptr = chip->ply_pos + (chip->ply_count - 1) - inw(FM801_REG(chip, PLY_COUNT));
499 if (inw(FM801_REG(chip, IRQ_STATUS)) & FM801_IRQ_PLAYBACK) {
500 ptr += chip->ply_count;
501 ptr %= chip->ply_size;
502 }
503 spin_unlock(&chip->reg_lock);
504 return bytes_to_frames(substream->runtime, ptr);
505 }
506
507 static snd_pcm_uframes_t snd_fm801_capture_pointer(struct snd_pcm_substream *substream)
508 {
509 struct fm801 *chip = snd_pcm_substream_chip(substream);
510 size_t ptr;
511
512 if (!(chip->cap_ctrl & FM801_START))
513 return 0;
514 spin_lock(&chip->reg_lock);
515 ptr = chip->cap_pos + (chip->cap_count - 1) - inw(FM801_REG(chip, CAP_COUNT));
516 if (inw(FM801_REG(chip, IRQ_STATUS)) & FM801_IRQ_CAPTURE) {
517 ptr += chip->cap_count;
518 ptr %= chip->cap_size;
519 }
520 spin_unlock(&chip->reg_lock);
521 return bytes_to_frames(substream->runtime, ptr);
522 }
523
524 static irqreturn_t snd_fm801_interrupt(int irq, void *dev_id)
525 {
526 struct fm801 *chip = dev_id;
527 unsigned short status;
528 unsigned int tmp;
529
530 status = inw(FM801_REG(chip, IRQ_STATUS));
531 status &= FM801_IRQ_PLAYBACK|FM801_IRQ_CAPTURE|FM801_IRQ_MPU|FM801_IRQ_VOLUME;
532 if (! status)
533 return IRQ_NONE;
534 /* ack first */
535 outw(status, FM801_REG(chip, IRQ_STATUS));
536 if (chip->pcm && (status & FM801_IRQ_PLAYBACK) && chip->playback_substream) {
537 spin_lock(&chip->reg_lock);
538 chip->ply_buf++;
539 chip->ply_pos += chip->ply_count;
540 chip->ply_pos %= chip->ply_size;
541 tmp = chip->ply_pos + chip->ply_count;
542 tmp %= chip->ply_size;
543 outl(chip->ply_buffer + tmp,
544 (chip->ply_buf & 1) ?
545 FM801_REG(chip, PLY_BUF1) :
546 FM801_REG(chip, PLY_BUF2));
547 spin_unlock(&chip->reg_lock);
548 snd_pcm_period_elapsed(chip->playback_substream);
549 }
550 if (chip->pcm && (status & FM801_IRQ_CAPTURE) && chip->capture_substream) {
551 spin_lock(&chip->reg_lock);
552 chip->cap_buf++;
553 chip->cap_pos += chip->cap_count;
554 chip->cap_pos %= chip->cap_size;
555 tmp = chip->cap_pos + chip->cap_count;
556 tmp %= chip->cap_size;
557 outl(chip->cap_buffer + tmp,
558 (chip->cap_buf & 1) ?
559 FM801_REG(chip, CAP_BUF1) :
560 FM801_REG(chip, CAP_BUF2));
561 spin_unlock(&chip->reg_lock);
562 snd_pcm_period_elapsed(chip->capture_substream);
563 }
564 if (chip->rmidi && (status & FM801_IRQ_MPU))
565 snd_mpu401_uart_interrupt(irq, chip->rmidi->private_data);
566 if (status & FM801_IRQ_VOLUME)
567 ;/* TODO */
568
569 return IRQ_HANDLED;
570 }
571
572 static struct snd_pcm_hardware snd_fm801_playback =
573 {
574 .info = (SNDRV_PCM_INFO_MMAP | SNDRV_PCM_INFO_INTERLEAVED |
575 SNDRV_PCM_INFO_BLOCK_TRANSFER |
576 SNDRV_PCM_INFO_PAUSE | SNDRV_PCM_INFO_RESUME |
577 SNDRV_PCM_INFO_MMAP_VALID),
578 .formats = SNDRV_PCM_FMTBIT_U8 | SNDRV_PCM_FMTBIT_S16_LE,
579 .rates = SNDRV_PCM_RATE_KNOT | SNDRV_PCM_RATE_8000_48000,
580 .rate_min = 5500,
581 .rate_max = 48000,
582 .channels_min = 1,
583 .channels_max = 2,
584 .buffer_bytes_max = (128*1024),
585 .period_bytes_min = 64,
586 .period_bytes_max = (128*1024),
587 .periods_min = 1,
588 .periods_max = 1024,
589 .fifo_size = 0,
590 };
591
592 static struct snd_pcm_hardware snd_fm801_capture =
593 {
594 .info = (SNDRV_PCM_INFO_MMAP | SNDRV_PCM_INFO_INTERLEAVED |
595 SNDRV_PCM_INFO_BLOCK_TRANSFER |
596 SNDRV_PCM_INFO_PAUSE | SNDRV_PCM_INFO_RESUME |
597 SNDRV_PCM_INFO_MMAP_VALID),
598 .formats = SNDRV_PCM_FMTBIT_U8 | SNDRV_PCM_FMTBIT_S16_LE,
599 .rates = SNDRV_PCM_RATE_KNOT | SNDRV_PCM_RATE_8000_48000,
600 .rate_min = 5500,
601 .rate_max = 48000,
602 .channels_min = 1,
603 .channels_max = 2,
604 .buffer_bytes_max = (128*1024),
605 .period_bytes_min = 64,
606 .period_bytes_max = (128*1024),
607 .periods_min = 1,
608 .periods_max = 1024,
609 .fifo_size = 0,
610 };
611
612 static int snd_fm801_playback_open(struct snd_pcm_substream *substream)
613 {
614 struct fm801 *chip = snd_pcm_substream_chip(substream);
615 struct snd_pcm_runtime *runtime = substream->runtime;
616 int err;
617
618 chip->playback_substream = substream;
619 runtime->hw = snd_fm801_playback;
620 snd_pcm_hw_constraint_list(runtime, 0, SNDRV_PCM_HW_PARAM_RATE,
621 &hw_constraints_rates);
622 if (chip->multichannel) {
623 runtime->hw.channels_max = 6;
624 snd_pcm_hw_constraint_list(runtime, 0,
625 SNDRV_PCM_HW_PARAM_CHANNELS,
626 &hw_constraints_channels);
627 }
628 if ((err = snd_pcm_hw_constraint_integer(runtime, SNDRV_PCM_HW_PARAM_PERIODS)) < 0)
629 return err;
630 return 0;
631 }
632
633 static int snd_fm801_capture_open(struct snd_pcm_substream *substream)
634 {
635 struct fm801 *chip = snd_pcm_substream_chip(substream);
636 struct snd_pcm_runtime *runtime = substream->runtime;
637 int err;
638
639 chip->capture_substream = substream;
640 runtime->hw = snd_fm801_capture;
641 snd_pcm_hw_constraint_list(runtime, 0, SNDRV_PCM_HW_PARAM_RATE,
642 &hw_constraints_rates);
643 if ((err = snd_pcm_hw_constraint_integer(runtime, SNDRV_PCM_HW_PARAM_PERIODS)) < 0)
644 return err;
645 return 0;
646 }
647
648 static int snd_fm801_playback_close(struct snd_pcm_substream *substream)
649 {
650 struct fm801 *chip = snd_pcm_substream_chip(substream);
651
652 chip->playback_substream = NULL;
653 return 0;
654 }
655
656 static int snd_fm801_capture_close(struct snd_pcm_substream *substream)
657 {
658 struct fm801 *chip = snd_pcm_substream_chip(substream);
659
660 chip->capture_substream = NULL;
661 return 0;
662 }
663
664 static struct snd_pcm_ops snd_fm801_playback_ops = {
665 .open = snd_fm801_playback_open,
666 .close = snd_fm801_playback_close,
667 .ioctl = snd_pcm_lib_ioctl,
668 .hw_params = snd_fm801_hw_params,
669 .hw_free = snd_fm801_hw_free,
670 .prepare = snd_fm801_playback_prepare,
671 .trigger = snd_fm801_playback_trigger,
672 .pointer = snd_fm801_playback_pointer,
673 };
674
675 static struct snd_pcm_ops snd_fm801_capture_ops = {
676 .open = snd_fm801_capture_open,
677 .close = snd_fm801_capture_close,
678 .ioctl = snd_pcm_lib_ioctl,
679 .hw_params = snd_fm801_hw_params,
680 .hw_free = snd_fm801_hw_free,
681 .prepare = snd_fm801_capture_prepare,
682 .trigger = snd_fm801_capture_trigger,
683 .pointer = snd_fm801_capture_pointer,
684 };
685
686 static int __devinit snd_fm801_pcm(struct fm801 *chip, int device, struct snd_pcm ** rpcm)
687 {
688 struct snd_pcm *pcm;
689 int err;
690
691 if (rpcm)
692 *rpcm = NULL;
693 if ((err = snd_pcm_new(chip->card, "FM801", device, 1, 1, &pcm)) < 0)
694 return err;
695
696 snd_pcm_set_ops(pcm, SNDRV_PCM_STREAM_PLAYBACK, &snd_fm801_playback_ops);
697 snd_pcm_set_ops(pcm, SNDRV_PCM_STREAM_CAPTURE, &snd_fm801_capture_ops);
698
699 pcm->private_data = chip;
700 pcm->info_flags = 0;
701 strcpy(pcm->name, "FM801");
702 chip->pcm = pcm;
703
704 snd_pcm_lib_preallocate_pages_for_all(pcm, SNDRV_DMA_TYPE_DEV,
705 snd_dma_pci_data(chip->pci),
706 chip->multichannel ? 128*1024 : 64*1024, 128*1024);
707
708 if (rpcm)
709 *rpcm = pcm;
710 return 0;
711 }
712
713 /*
714 * TEA5757 radio
715 */
716
717 #ifdef CONFIG_SND_FM801_TEA575X_BOOL
718
719 /* GPIO to TEA575x maps */
720 struct snd_fm801_tea575x_gpio {
721 u8 data, clk, wren, most;
722 char *name;
723 };
724
725 static struct snd_fm801_tea575x_gpio snd_fm801_tea575x_gpios[] = {
726 { .data = 1, .clk = 3, .wren = 2, .most = 0, .name = "SF256-PCS" },
727 { .data = 1, .clk = 0, .wren = 2, .most = 3, .name = "SF256-PCP" },
728 { .data = 2, .clk = 0, .wren = 1, .most = 3, .name = "SF64-PCR" },
729 };
730
731 static void snd_fm801_tea575x_set_pins(struct snd_tea575x *tea, u8 pins)
732 {
733 struct fm801 *chip = tea->private_data;
734 unsigned short reg = inw(FM801_REG(chip, GPIO_CTRL));
735 struct snd_fm801_tea575x_gpio gpio = snd_fm801_tea575x_gpios[(chip->tea575x_tuner & TUNER_TYPE_MASK) - 1];
736
737 reg &= ~(FM801_GPIO_GP(gpio.data) |
738 FM801_GPIO_GP(gpio.clk) |
739 FM801_GPIO_GP(gpio.wren));
740
741 reg |= (pins & TEA575X_DATA) ? FM801_GPIO_GP(gpio.data) : 0;
742 reg |= (pins & TEA575X_CLK) ? FM801_GPIO_GP(gpio.clk) : 0;
743 /* WRITE_ENABLE is inverted */
744 reg |= (pins & TEA575X_WREN) ? 0 : FM801_GPIO_GP(gpio.wren);
745
746 outw(reg, FM801_REG(chip, GPIO_CTRL));
747 }
748
749 static u8 snd_fm801_tea575x_get_pins(struct snd_tea575x *tea)
750 {
751 struct fm801 *chip = tea->private_data;
752 unsigned short reg = inw(FM801_REG(chip, GPIO_CTRL));
753 struct snd_fm801_tea575x_gpio gpio = snd_fm801_tea575x_gpios[(chip->tea575x_tuner & TUNER_TYPE_MASK) - 1];
754
755 return (reg & FM801_GPIO_GP(gpio.data)) ? TEA575X_DATA : 0 |
756 (reg & FM801_GPIO_GP(gpio.most)) ? TEA575X_MOST : 0;
757 }
758
759 static void snd_fm801_tea575x_set_direction(struct snd_tea575x *tea, bool output)
760 {
761 struct fm801 *chip = tea->private_data;
762 unsigned short reg = inw(FM801_REG(chip, GPIO_CTRL));
763 struct snd_fm801_tea575x_gpio gpio = snd_fm801_tea575x_gpios[(chip->tea575x_tuner & TUNER_TYPE_MASK) - 1];
764
765 /* use GPIO lines and set write enable bit */
766 reg |= FM801_GPIO_GS(gpio.data) |
767 FM801_GPIO_GS(gpio.wren) |
768 FM801_GPIO_GS(gpio.clk) |
769 FM801_GPIO_GS(gpio.most);
770 if (output) {
771 /* all of lines are in the write direction */
772 /* clear data and clock lines */
773 reg &= ~(FM801_GPIO_GD(gpio.data) |
774 FM801_GPIO_GD(gpio.wren) |
775 FM801_GPIO_GD(gpio.clk) |
776 FM801_GPIO_GP(gpio.data) |
777 FM801_GPIO_GP(gpio.clk) |
778 FM801_GPIO_GP(gpio.wren));
779 } else {
780 /* use GPIO lines, set data direction to input */
781 reg |= FM801_GPIO_GD(gpio.data) |
782 FM801_GPIO_GD(gpio.most) |
783 FM801_GPIO_GP(gpio.data) |
784 FM801_GPIO_GP(gpio.most) |
785 FM801_GPIO_GP(gpio.wren);
786 /* all of lines are in the write direction, except data */
787 /* clear data, write enable and clock lines */
788 reg &= ~(FM801_GPIO_GD(gpio.wren) |
789 FM801_GPIO_GD(gpio.clk) |
790 FM801_GPIO_GP(gpio.clk));
791 }
792
793 outw(reg, FM801_REG(chip, GPIO_CTRL));
794 }
795
796 static struct snd_tea575x_ops snd_fm801_tea_ops = {
797 .set_pins = snd_fm801_tea575x_set_pins,
798 .get_pins = snd_fm801_tea575x_get_pins,
799 .set_direction = snd_fm801_tea575x_set_direction,
800 };
801 #endif
802
803 /*
804 * Mixer routines
805 */
806
807 #define FM801_SINGLE(xname, reg, shift, mask, invert) \
808 { .iface = SNDRV_CTL_ELEM_IFACE_MIXER, .name = xname, .info = snd_fm801_info_single, \
809 .get = snd_fm801_get_single, .put = snd_fm801_put_single, \
810 .private_value = reg | (shift << 8) | (mask << 16) | (invert << 24) }
811
812 static int snd_fm801_info_single(struct snd_kcontrol *kcontrol,
813 struct snd_ctl_elem_info *uinfo)
814 {
815 int mask = (kcontrol->private_value >> 16) & 0xff;
816
817 uinfo->type = mask == 1 ? SNDRV_CTL_ELEM_TYPE_BOOLEAN : SNDRV_CTL_ELEM_TYPE_INTEGER;
818 uinfo->count = 1;
819 uinfo->value.integer.min = 0;
820 uinfo->value.integer.max = mask;
821 return 0;
822 }
823
824 static int snd_fm801_get_single(struct snd_kcontrol *kcontrol,
825 struct snd_ctl_elem_value *ucontrol)
826 {
827 struct fm801 *chip = snd_kcontrol_chip(kcontrol);
828 int reg = kcontrol->private_value & 0xff;
829 int shift = (kcontrol->private_value >> 8) & 0xff;
830 int mask = (kcontrol->private_value >> 16) & 0xff;
831 int invert = (kcontrol->private_value >> 24) & 0xff;
832
833 ucontrol->value.integer.value[0] = (inw(chip->port + reg) >> shift) & mask;
834 if (invert)
835 ucontrol->value.integer.value[0] = mask - ucontrol->value.integer.value[0];
836 return 0;
837 }
838
839 static int snd_fm801_put_single(struct snd_kcontrol *kcontrol,
840 struct snd_ctl_elem_value *ucontrol)
841 {
842 struct fm801 *chip = snd_kcontrol_chip(kcontrol);
843 int reg = kcontrol->private_value & 0xff;
844 int shift = (kcontrol->private_value >> 8) & 0xff;
845 int mask = (kcontrol->private_value >> 16) & 0xff;
846 int invert = (kcontrol->private_value >> 24) & 0xff;
847 unsigned short val;
848
849 val = (ucontrol->value.integer.value[0] & mask);
850 if (invert)
851 val = mask - val;
852 return snd_fm801_update_bits(chip, reg, mask << shift, val << shift);
853 }
854
855 #define FM801_DOUBLE(xname, reg, shift_left, shift_right, mask, invert) \
856 { .iface = SNDRV_CTL_ELEM_IFACE_MIXER, .name = xname, .info = snd_fm801_info_double, \
857 .get = snd_fm801_get_double, .put = snd_fm801_put_double, \
858 .private_value = reg | (shift_left << 8) | (shift_right << 12) | (mask << 16) | (invert << 24) }
859 #define FM801_DOUBLE_TLV(xname, reg, shift_left, shift_right, mask, invert, xtlv) \
860 { .iface = SNDRV_CTL_ELEM_IFACE_MIXER, \
861 .access = SNDRV_CTL_ELEM_ACCESS_READWRITE | SNDRV_CTL_ELEM_ACCESS_TLV_READ, \
862 .name = xname, .info = snd_fm801_info_double, \
863 .get = snd_fm801_get_double, .put = snd_fm801_put_double, \
864 .private_value = reg | (shift_left << 8) | (shift_right << 12) | (mask << 16) | (invert << 24), \
865 .tlv = { .p = (xtlv) } }
866
867 static int snd_fm801_info_double(struct snd_kcontrol *kcontrol,
868 struct snd_ctl_elem_info *uinfo)
869 {
870 int mask = (kcontrol->private_value >> 16) & 0xff;
871
872 uinfo->type = mask == 1 ? SNDRV_CTL_ELEM_TYPE_BOOLEAN : SNDRV_CTL_ELEM_TYPE_INTEGER;
873 uinfo->count = 2;
874 uinfo->value.integer.min = 0;
875 uinfo->value.integer.max = mask;
876 return 0;
877 }
878
879 static int snd_fm801_get_double(struct snd_kcontrol *kcontrol,
880 struct snd_ctl_elem_value *ucontrol)
881 {
882 struct fm801 *chip = snd_kcontrol_chip(kcontrol);
883 int reg = kcontrol->private_value & 0xff;
884 int shift_left = (kcontrol->private_value >> 8) & 0x0f;
885 int shift_right = (kcontrol->private_value >> 12) & 0x0f;
886 int mask = (kcontrol->private_value >> 16) & 0xff;
887 int invert = (kcontrol->private_value >> 24) & 0xff;
888
889 spin_lock_irq(&chip->reg_lock);
890 ucontrol->value.integer.value[0] = (inw(chip->port + reg) >> shift_left) & mask;
891 ucontrol->value.integer.value[1] = (inw(chip->port + reg) >> shift_right) & mask;
892 spin_unlock_irq(&chip->reg_lock);
893 if (invert) {
894 ucontrol->value.integer.value[0] = mask - ucontrol->value.integer.value[0];
895 ucontrol->value.integer.value[1] = mask - ucontrol->value.integer.value[1];
896 }
897 return 0;
898 }
899
900 static int snd_fm801_put_double(struct snd_kcontrol *kcontrol,
901 struct snd_ctl_elem_value *ucontrol)
902 {
903 struct fm801 *chip = snd_kcontrol_chip(kcontrol);
904 int reg = kcontrol->private_value & 0xff;
905 int shift_left = (kcontrol->private_value >> 8) & 0x0f;
906 int shift_right = (kcontrol->private_value >> 12) & 0x0f;
907 int mask = (kcontrol->private_value >> 16) & 0xff;
908 int invert = (kcontrol->private_value >> 24) & 0xff;
909 unsigned short val1, val2;
910
911 val1 = ucontrol->value.integer.value[0] & mask;
912 val2 = ucontrol->value.integer.value[1] & mask;
913 if (invert) {
914 val1 = mask - val1;
915 val2 = mask - val2;
916 }
917 return snd_fm801_update_bits(chip, reg,
918 (mask << shift_left) | (mask << shift_right),
919 (val1 << shift_left ) | (val2 << shift_right));
920 }
921
922 static int snd_fm801_info_mux(struct snd_kcontrol *kcontrol,
923 struct snd_ctl_elem_info *uinfo)
924 {
925 static char *texts[5] = {
926 "AC97 Primary", "FM", "I2S", "PCM", "AC97 Secondary"
927 };
928
929 uinfo->type = SNDRV_CTL_ELEM_TYPE_ENUMERATED;
930 uinfo->count = 1;
931 uinfo->value.enumerated.items = 5;
932 if (uinfo->value.enumerated.item > 4)
933 uinfo->value.enumerated.item = 4;
934 strcpy(uinfo->value.enumerated.name, texts[uinfo->value.enumerated.item]);
935 return 0;
936 }
937
938 static int snd_fm801_get_mux(struct snd_kcontrol *kcontrol,
939 struct snd_ctl_elem_value *ucontrol)
940 {
941 struct fm801 *chip = snd_kcontrol_chip(kcontrol);
942 unsigned short val;
943
944 val = inw(FM801_REG(chip, REC_SRC)) & 7;
945 if (val > 4)
946 val = 4;
947 ucontrol->value.enumerated.item[0] = val;
948 return 0;
949 }
950
951 static int snd_fm801_put_mux(struct snd_kcontrol *kcontrol,
952 struct snd_ctl_elem_value *ucontrol)
953 {
954 struct fm801 *chip = snd_kcontrol_chip(kcontrol);
955 unsigned short val;
956
957 if ((val = ucontrol->value.enumerated.item[0]) > 4)
958 return -EINVAL;
959 return snd_fm801_update_bits(chip, FM801_REC_SRC, 7, val);
960 }
961
962 static const DECLARE_TLV_DB_SCALE(db_scale_dsp, -3450, 150, 0);
963
964 #define FM801_CONTROLS ARRAY_SIZE(snd_fm801_controls)
965
966 static struct snd_kcontrol_new snd_fm801_controls[] __devinitdata = {
967 FM801_DOUBLE_TLV("Wave Playback Volume", FM801_PCM_VOL, 0, 8, 31, 1,
968 db_scale_dsp),
969 FM801_SINGLE("Wave Playback Switch", FM801_PCM_VOL, 15, 1, 1),
970 FM801_DOUBLE_TLV("I2S Playback Volume", FM801_I2S_VOL, 0, 8, 31, 1,
971 db_scale_dsp),
972 FM801_SINGLE("I2S Playback Switch", FM801_I2S_VOL, 15, 1, 1),
973 FM801_DOUBLE_TLV("FM Playback Volume", FM801_FM_VOL, 0, 8, 31, 1,
974 db_scale_dsp),
975 FM801_SINGLE("FM Playback Switch", FM801_FM_VOL, 15, 1, 1),
976 {
977 .iface = SNDRV_CTL_ELEM_IFACE_MIXER,
978 .name = "Digital Capture Source",
979 .info = snd_fm801_info_mux,
980 .get = snd_fm801_get_mux,
981 .put = snd_fm801_put_mux,
982 }
983 };
984
985 #define FM801_CONTROLS_MULTI ARRAY_SIZE(snd_fm801_controls_multi)
986
987 static struct snd_kcontrol_new snd_fm801_controls_multi[] __devinitdata = {
988 FM801_SINGLE("AC97 2ch->4ch Copy Switch", FM801_CODEC_CTRL, 7, 1, 0),
989 FM801_SINGLE("AC97 18-bit Switch", FM801_CODEC_CTRL, 10, 1, 0),
990 FM801_SINGLE(SNDRV_CTL_NAME_IEC958("",CAPTURE,SWITCH), FM801_I2S_MODE, 8, 1, 0),
991 FM801_SINGLE(SNDRV_CTL_NAME_IEC958("Raw Data ",PLAYBACK,SWITCH), FM801_I2S_MODE, 9, 1, 0),
992 FM801_SINGLE(SNDRV_CTL_NAME_IEC958("Raw Data ",CAPTURE,SWITCH), FM801_I2S_MODE, 10, 1, 0),
993 FM801_SINGLE(SNDRV_CTL_NAME_IEC958("",PLAYBACK,SWITCH), FM801_GEN_CTRL, 2, 1, 0),
994 };
995
996 static void snd_fm801_mixer_free_ac97_bus(struct snd_ac97_bus *bus)
997 {
998 struct fm801 *chip = bus->private_data;
999 chip->ac97_bus = NULL;
1000 }
1001
1002 static void snd_fm801_mixer_free_ac97(struct snd_ac97 *ac97)
1003 {
1004 struct fm801 *chip = ac97->private_data;
1005 if (ac97->num == 0) {
1006 chip->ac97 = NULL;
1007 } else {
1008 chip->ac97_sec = NULL;
1009 }
1010 }
1011
1012 static int __devinit snd_fm801_mixer(struct fm801 *chip)
1013 {
1014 struct snd_ac97_template ac97;
1015 unsigned int i;
1016 int err;
1017 static struct snd_ac97_bus_ops ops = {
1018 .write = snd_fm801_codec_write,
1019 .read = snd_fm801_codec_read,
1020 };
1021
1022 if ((err = snd_ac97_bus(chip->card, 0, &ops, chip, &chip->ac97_bus)) < 0)
1023 return err;
1024 chip->ac97_bus->private_free = snd_fm801_mixer_free_ac97_bus;
1025
1026 memset(&ac97, 0, sizeof(ac97));
1027 ac97.private_data = chip;
1028 ac97.private_free = snd_fm801_mixer_free_ac97;
1029 if ((err = snd_ac97_mixer(chip->ac97_bus, &ac97, &chip->ac97)) < 0)
1030 return err;
1031 if (chip->secondary) {
1032 ac97.num = 1;
1033 ac97.addr = chip->secondary_addr;
1034 if ((err = snd_ac97_mixer(chip->ac97_bus, &ac97, &chip->ac97_sec)) < 0)
1035 return err;
1036 }
1037 for (i = 0; i < FM801_CONTROLS; i++)
1038 snd_ctl_add(chip->card, snd_ctl_new1(&snd_fm801_controls[i], chip));
1039 if (chip->multichannel) {
1040 for (i = 0; i < FM801_CONTROLS_MULTI; i++)
1041 snd_ctl_add(chip->card, snd_ctl_new1(&snd_fm801_controls_multi[i], chip));
1042 }
1043 return 0;
1044 }
1045
1046 /*
1047 * initialization routines
1048 */
1049
1050 static int wait_for_codec(struct fm801 *chip, unsigned int codec_id,
1051 unsigned short reg, unsigned long waits)
1052 {
1053 unsigned long timeout = jiffies + waits;
1054
1055 outw(FM801_AC97_READ | (codec_id << FM801_AC97_ADDR_SHIFT) | reg,
1056 FM801_REG(chip, AC97_CMD));
1057 udelay(5);
1058 do {
1059 if ((inw(FM801_REG(chip, AC97_CMD)) & (FM801_AC97_VALID|FM801_AC97_BUSY))
1060 == FM801_AC97_VALID)
1061 return 0;
1062 schedule_timeout_uninterruptible(1);
1063 } while (time_after(timeout, jiffies));
1064 return -EIO;
1065 }
1066
1067 static int snd_fm801_chip_init(struct fm801 *chip, int resume)
1068 {
1069 unsigned short cmdw;
1070
1071 if (chip->tea575x_tuner & TUNER_ONLY)
1072 goto __ac97_ok;
1073
1074 /* codec cold reset + AC'97 warm reset */
1075 outw((1<<5) | (1<<6), FM801_REG(chip, CODEC_CTRL));
1076 inw(FM801_REG(chip, CODEC_CTRL)); /* flush posting data */
1077 udelay(100);
1078 outw(0, FM801_REG(chip, CODEC_CTRL));
1079
1080 if (wait_for_codec(chip, 0, AC97_RESET, msecs_to_jiffies(750)) < 0)
1081 if (!resume) {
1082 snd_printk(KERN_INFO "Primary AC'97 codec not found, "
1083 "assume SF64-PCR (tuner-only)\n");
1084 chip->tea575x_tuner = 3 | TUNER_ONLY;
1085 goto __ac97_ok;
1086 }
1087
1088 if (chip->multichannel) {
1089 if (chip->secondary_addr) {
1090 wait_for_codec(chip, chip->secondary_addr,
1091 AC97_VENDOR_ID1, msecs_to_jiffies(50));
1092 } else {
1093 /* my card has the secondary codec */
1094 /* at address #3, so the loop is inverted */
1095 int i;
1096 for (i = 3; i > 0; i--) {
1097 if (!wait_for_codec(chip, i, AC97_VENDOR_ID1,
1098 msecs_to_jiffies(50))) {
1099 cmdw = inw(FM801_REG(chip, AC97_DATA));
1100 if (cmdw != 0xffff && cmdw != 0) {
1101 chip->secondary = 1;
1102 chip->secondary_addr = i;
1103 break;
1104 }
1105 }
1106 }
1107 }
1108
1109 /* the recovery phase, it seems that probing for non-existing codec might */
1110 /* cause timeout problems */
1111 wait_for_codec(chip, 0, AC97_VENDOR_ID1, msecs_to_jiffies(750));
1112 }
1113
1114 __ac97_ok:
1115
1116 /* init volume */
1117 outw(0x0808, FM801_REG(chip, PCM_VOL));
1118 outw(0x9f1f, FM801_REG(chip, FM_VOL));
1119 outw(0x8808, FM801_REG(chip, I2S_VOL));
1120
1121 /* I2S control - I2S mode */
1122 outw(0x0003, FM801_REG(chip, I2S_MODE));
1123
1124 /* interrupt setup */
1125 cmdw = inw(FM801_REG(chip, IRQ_MASK));
1126 if (chip->irq < 0)
1127 cmdw |= 0x00c3; /* mask everything, no PCM nor MPU */
1128 else
1129 cmdw &= ~0x0083; /* unmask MPU, PLAYBACK & CAPTURE */
1130 outw(cmdw, FM801_REG(chip, IRQ_MASK));
1131
1132 /* interrupt clear */
1133 outw(FM801_IRQ_PLAYBACK|FM801_IRQ_CAPTURE|FM801_IRQ_MPU, FM801_REG(chip, IRQ_STATUS));
1134
1135 return 0;
1136 }
1137
1138
1139 static int snd_fm801_free(struct fm801 *chip)
1140 {
1141 unsigned short cmdw;
1142
1143 if (chip->irq < 0)
1144 goto __end_hw;
1145
1146 /* interrupt setup - mask everything */
1147 cmdw = inw(FM801_REG(chip, IRQ_MASK));
1148 cmdw |= 0x00c3;
1149 outw(cmdw, FM801_REG(chip, IRQ_MASK));
1150
1151 __end_hw:
1152 #ifdef CONFIG_SND_FM801_TEA575X_BOOL
1153 snd_tea575x_exit(&chip->tea);
1154 #endif
1155 if (chip->irq >= 0)
1156 free_irq(chip->irq, chip);
1157 pci_release_regions(chip->pci);
1158 pci_disable_device(chip->pci);
1159
1160 kfree(chip);
1161 return 0;
1162 }
1163
1164 static int snd_fm801_dev_free(struct snd_device *device)
1165 {
1166 struct fm801 *chip = device->device_data;
1167 return snd_fm801_free(chip);
1168 }
1169
1170 static int __devinit snd_fm801_create(struct snd_card *card,
1171 struct pci_dev * pci,
1172 int tea575x_tuner,
1173 struct fm801 ** rchip)
1174 {
1175 struct fm801 *chip;
1176 int err;
1177 static struct snd_device_ops ops = {
1178 .dev_free = snd_fm801_dev_free,
1179 };
1180
1181 *rchip = NULL;
1182 if ((err = pci_enable_device(pci)) < 0)
1183 return err;
1184 chip = kzalloc(sizeof(*chip), GFP_KERNEL);
1185 if (chip == NULL) {
1186 pci_disable_device(pci);
1187 return -ENOMEM;
1188 }
1189 spin_lock_init(&chip->reg_lock);
1190 chip->card = card;
1191 chip->pci = pci;
1192 chip->irq = -1;
1193 chip->tea575x_tuner = tea575x_tuner;
1194 if ((err = pci_request_regions(pci, "FM801")) < 0) {
1195 kfree(chip);
1196 pci_disable_device(pci);
1197 return err;
1198 }
1199 chip->port = pci_resource_start(pci, 0);
1200 if ((tea575x_tuner & TUNER_ONLY) == 0) {
1201 if (request_irq(pci->irq, snd_fm801_interrupt, IRQF_SHARED,
1202 "FM801", chip)) {
1203 snd_printk(KERN_ERR "unable to grab IRQ %d\n", chip->irq);
1204 snd_fm801_free(chip);
1205 return -EBUSY;
1206 }
1207 chip->irq = pci->irq;
1208 pci_set_master(pci);
1209 }
1210
1211 if (pci->revision >= 0xb1) /* FM801-AU */
1212 chip->multichannel = 1;
1213
1214 snd_fm801_chip_init(chip, 0);
1215 /* init might set tuner access method */
1216 tea575x_tuner = chip->tea575x_tuner;
1217
1218 if (chip->irq >= 0 && (tea575x_tuner & TUNER_ONLY)) {
1219 pci_clear_master(pci);
1220 free_irq(chip->irq, chip);
1221 chip->irq = -1;
1222 }
1223
1224 if ((err = snd_device_new(card, SNDRV_DEV_LOWLEVEL, chip, &ops)) < 0) {
1225 snd_fm801_free(chip);
1226 return err;
1227 }
1228
1229 snd_card_set_dev(card, &pci->dev);
1230
1231 #ifdef CONFIG_SND_FM801_TEA575X_BOOL
1232 chip->tea.private_data = chip;
1233 chip->tea.ops = &snd_fm801_tea_ops;
1234 sprintf(chip->tea.bus_info, "PCI:%s", pci_name(pci));
1235 if ((tea575x_tuner & TUNER_TYPE_MASK) > 0 &&
1236 (tea575x_tuner & TUNER_TYPE_MASK) < 4) {
1237 if (snd_tea575x_init(&chip->tea)) {
1238 snd_printk(KERN_ERR "TEA575x radio not found\n");
1239 snd_fm801_free(chip);
1240 return -ENODEV;
1241 }
1242 } else if ((tea575x_tuner & TUNER_TYPE_MASK) == 0) {
1243 /* autodetect tuner connection */
1244 for (tea575x_tuner = 1; tea575x_tuner <= 3; tea575x_tuner++) {
1245 chip->tea575x_tuner = tea575x_tuner;
1246 if (!snd_tea575x_init(&chip->tea)) {
1247 snd_printk(KERN_INFO "detected TEA575x radio type %s\n",
1248 snd_fm801_tea575x_gpios[tea575x_tuner - 1].name);
1249 break;
1250 }
1251 }
1252 if (tea575x_tuner == 4) {
1253 snd_printk(KERN_ERR "TEA575x radio not found\n");
1254 snd_fm801_free(chip);
1255 return -ENODEV;
1256 }
1257 }
1258 strlcpy(chip->tea.card, snd_fm801_tea575x_gpios[(tea575x_tuner & TUNER_TYPE_MASK) - 1].name, sizeof(chip->tea.card));
1259 #endif
1260
1261 *rchip = chip;
1262 return 0;
1263 }
1264
1265 static int __devinit snd_card_fm801_probe(struct pci_dev *pci,
1266 const struct pci_device_id *pci_id)
1267 {
1268 static int dev;
1269 struct snd_card *card;
1270 struct fm801 *chip;
1271 struct snd_opl3 *opl3;
1272 int err;
1273
1274 if (dev >= SNDRV_CARDS)
1275 return -ENODEV;
1276 if (!enable[dev]) {
1277 dev++;
1278 return -ENOENT;
1279 }
1280
1281 err = snd_card_create(index[dev], id[dev], THIS_MODULE, 0, &card);
1282 if (err < 0)
1283 return err;
1284 if ((err = snd_fm801_create(card, pci, tea575x_tuner[dev], &chip)) < 0) {
1285 snd_card_free(card);
1286 return err;
1287 }
1288 card->private_data = chip;
1289
1290 strcpy(card->driver, "FM801");
1291 strcpy(card->shortname, "ForteMedia FM801-");
1292 strcat(card->shortname, chip->multichannel ? "AU" : "AS");
1293 sprintf(card->longname, "%s at 0x%lx, irq %i",
1294 card->shortname, chip->port, chip->irq);
1295
1296 if (chip->tea575x_tuner & TUNER_ONLY)
1297 goto __fm801_tuner_only;
1298
1299 if ((err = snd_fm801_pcm(chip, 0, NULL)) < 0) {
1300 snd_card_free(card);
1301 return err;
1302 }
1303 if ((err = snd_fm801_mixer(chip)) < 0) {
1304 snd_card_free(card);
1305 return err;
1306 }
1307 if ((err = snd_mpu401_uart_new(card, 0, MPU401_HW_FM801,
1308 FM801_REG(chip, MPU401_DATA),
1309 MPU401_INFO_INTEGRATED,
1310 chip->irq, 0, &chip->rmidi)) < 0) {
1311 snd_card_free(card);
1312 return err;
1313 }
1314 if ((err = snd_opl3_create(card, FM801_REG(chip, OPL3_BANK0),
1315 FM801_REG(chip, OPL3_BANK1),
1316 OPL3_HW_OPL3_FM801, 1, &opl3)) < 0) {
1317 snd_card_free(card);
1318 return err;
1319 }
1320 if ((err = snd_opl3_hwdep_new(opl3, 0, 1, NULL)) < 0) {
1321 snd_card_free(card);
1322 return err;
1323 }
1324
1325 __fm801_tuner_only:
1326 if ((err = snd_card_register(card)) < 0) {
1327 snd_card_free(card);
1328 return err;
1329 }
1330 pci_set_drvdata(pci, card);
1331 dev++;
1332 return 0;
1333 }
1334
1335 static void __devexit snd_card_fm801_remove(struct pci_dev *pci)
1336 {
1337 snd_card_free(pci_get_drvdata(pci));
1338 pci_set_drvdata(pci, NULL);
1339 }
1340
1341 #ifdef CONFIG_PM
1342 static unsigned char saved_regs[] = {
1343 FM801_PCM_VOL, FM801_I2S_VOL, FM801_FM_VOL, FM801_REC_SRC,
1344 FM801_PLY_CTRL, FM801_PLY_COUNT, FM801_PLY_BUF1, FM801_PLY_BUF2,
1345 FM801_CAP_CTRL, FM801_CAP_COUNT, FM801_CAP_BUF1, FM801_CAP_BUF2,
1346 FM801_CODEC_CTRL, FM801_I2S_MODE, FM801_VOLUME, FM801_GEN_CTRL,
1347 };
1348
1349 static int snd_fm801_suspend(struct pci_dev *pci, pm_message_t state)
1350 {
1351 struct snd_card *card = pci_get_drvdata(pci);
1352 struct fm801 *chip = card->private_data;
1353 int i;
1354
1355 snd_power_change_state(card, SNDRV_CTL_POWER_D3hot);
1356 snd_pcm_suspend_all(chip->pcm);
1357 snd_ac97_suspend(chip->ac97);
1358 snd_ac97_suspend(chip->ac97_sec);
1359 for (i = 0; i < ARRAY_SIZE(saved_regs); i++)
1360 chip->saved_regs[i] = inw(chip->port + saved_regs[i]);
1361 /* FIXME: tea575x suspend */
1362
1363 pci_disable_device(pci);
1364 pci_save_state(pci);
1365 pci_set_power_state(pci, pci_choose_state(pci, state));
1366 return 0;
1367 }
1368
1369 static int snd_fm801_resume(struct pci_dev *pci)
1370 {
1371 struct snd_card *card = pci_get_drvdata(pci);
1372 struct fm801 *chip = card->private_data;
1373 int i;
1374
1375 pci_set_power_state(pci, PCI_D0);
1376 pci_restore_state(pci);
1377 if (pci_enable_device(pci) < 0) {
1378 printk(KERN_ERR "fm801: pci_enable_device failed, "
1379 "disabling device\n");
1380 snd_card_disconnect(card);
1381 return -EIO;
1382 }
1383 pci_set_master(pci);
1384
1385 snd_fm801_chip_init(chip, 1);
1386 snd_ac97_resume(chip->ac97);
1387 snd_ac97_resume(chip->ac97_sec);
1388 for (i = 0; i < ARRAY_SIZE(saved_regs); i++)
1389 outw(chip->saved_regs[i], chip->port + saved_regs[i]);
1390
1391 snd_power_change_state(card, SNDRV_CTL_POWER_D0);
1392 return 0;
1393 }
1394 #endif
1395
1396 static struct pci_driver driver = {
1397 .name = "FM801",
1398 .id_table = snd_fm801_ids,
1399 .probe = snd_card_fm801_probe,
1400 .remove = __devexit_p(snd_card_fm801_remove),
1401 #ifdef CONFIG_PM
1402 .suspend = snd_fm801_suspend,
1403 .resume = snd_fm801_resume,
1404 #endif
1405 };
1406
1407 static int __init alsa_card_fm801_init(void)
1408 {
1409 return pci_register_driver(&driver);
1410 }
1411
1412 static void __exit alsa_card_fm801_exit(void)
1413 {
1414 pci_unregister_driver(&driver);
1415 }
1416
1417 module_init(alsa_card_fm801_init)
1418 module_exit(alsa_card_fm801_exit)
Linus' kernel tree