1 /* 2 * Copyright (c) by Jaroslav Kysela <perex@suse.cz> 3 * Routines for control of YMF724/740/744/754 chips 4 * 5 * BUGS: 6 * -- 7 * 8 * TODO: 9 * -- 10 * 11 * This program is free software; you can redistribute it and/or modify 12 * it under the terms of the GNU General Public License as published by 13 * the Free Software Foundation; either version 2 of the License, or 14 * (at your option) any later version. 15 * 16 * This program is distributed in the hope that it will be useful, 17 * but WITHOUT ANY WARRANTY; without even the implied warranty of 18 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the 19 * GNU General Public License for more details. 20 * 21 * You should have received a copy of the GNU General Public License 22 * along with this program; if not, write to the Free Software 23 * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA 24 * 25 */ 26 27 #include <sound/driver.h> 28 #include <linux/delay.h> 29 #include <linux/init.h> 30 #include <linux/interrupt.h> 31 #include <linux/pci.h> 32 #include <linux/sched.h> 33 #include <linux/slab.h> 34 #include <linux/vmalloc.h> 35 36 #include <sound/core.h> 37 #include <sound/control.h> 38 #include <sound/info.h> 39 #include <sound/ymfpci.h> 40 #include <sound/asoundef.h> 41 #include <sound/mpu401.h> 42 43 #include <asm/io.h> 44 45 /* 46 * constants 47 */ 48 49 /* 50 * common I/O routines 51 */ 52 53 static void snd_ymfpci_irq_wait(struct snd_ymfpci *chip); 54 55 static inline u8 snd_ymfpci_readb(struct snd_ymfpci *chip, u32 offset) 56 { 57 return readb(chip->reg_area_virt + offset); 58 } 59 60 static inline void snd_ymfpci_writeb(struct snd_ymfpci *chip, u32 offset, u8 val) 61 { 62 writeb(val, chip->reg_area_virt + offset); 63 } 64 65 static inline u16 snd_ymfpci_readw(struct snd_ymfpci *chip, u32 offset) 66 { 67 return readw(chip->reg_area_virt + offset); 68 } 69 70 static inline void snd_ymfpci_writew(struct snd_ymfpci *chip, u32 offset, u16 val) 71 { 72 writew(val, chip->reg_area_virt + offset); 73 } 74 75 static inline u32 snd_ymfpci_readl(struct snd_ymfpci *chip, u32 offset) 76 { 77 return readl(chip->reg_area_virt + offset); 78 } 79 80 static inline void snd_ymfpci_writel(struct snd_ymfpci *chip, u32 offset, u32 val) 81 { 82 writel(val, chip->reg_area_virt + offset); 83 } 84 85 static int snd_ymfpci_codec_ready(struct snd_ymfpci *chip, int secondary) 86 { 87 unsigned long end_time; 88 u32 reg = secondary ? YDSXGR_SECSTATUSADR : YDSXGR_PRISTATUSADR; 89 90 end_time = jiffies + msecs_to_jiffies(750); 91 do { 92 if ((snd_ymfpci_readw(chip, reg) & 0x8000) == 0) 93 return 0; 94 set_current_state(TASK_UNINTERRUPTIBLE); 95 schedule_timeout_uninterruptible(1); 96 } while (time_before(jiffies, end_time)); 97 snd_printk(KERN_ERR "codec_ready: codec %i is not ready [0x%x]\n", secondary, snd_ymfpci_readw(chip, reg)); 98 return -EBUSY; 99 } 100 101 static void snd_ymfpci_codec_write(struct snd_ac97 *ac97, u16 reg, u16 val) 102 { 103 struct snd_ymfpci *chip = ac97->private_data; 104 u32 cmd; 105 106 snd_ymfpci_codec_ready(chip, 0); 107 cmd = ((YDSXG_AC97WRITECMD | reg) << 16) | val; 108 snd_ymfpci_writel(chip, YDSXGR_AC97CMDDATA, cmd); 109 } 110 111 static u16 snd_ymfpci_codec_read(struct snd_ac97 *ac97, u16 reg) 112 { 113 struct snd_ymfpci *chip = ac97->private_data; 114 115 if (snd_ymfpci_codec_ready(chip, 0)) 116 return ~0; 117 snd_ymfpci_writew(chip, YDSXGR_AC97CMDADR, YDSXG_AC97READCMD | reg); 118 if (snd_ymfpci_codec_ready(chip, 0)) 119 return ~0; 120 if (chip->device_id == PCI_DEVICE_ID_YAMAHA_744 && chip->rev < 2) { 121 int i; 122 for (i = 0; i < 600; i++) 123 snd_ymfpci_readw(chip, YDSXGR_PRISTATUSDATA); 124 } 125 return snd_ymfpci_readw(chip, YDSXGR_PRISTATUSDATA); 126 } 127 128 /* 129 * Misc routines 130 */ 131 132 static u32 snd_ymfpci_calc_delta(u32 rate) 133 { 134 switch (rate) { 135 case 8000: return 0x02aaab00; 136 case 11025: return 0x03accd00; 137 case 16000: return 0x05555500; 138 case 22050: return 0x07599a00; 139 case 32000: return 0x0aaaab00; 140 case 44100: return 0x0eb33300; 141 default: return ((rate << 16) / 375) << 5; 142 } 143 } 144 145 static u32 def_rate[8] = { 146 100, 2000, 8000, 11025, 16000, 22050, 32000, 48000 147 }; 148 149 static u32 snd_ymfpci_calc_lpfK(u32 rate) 150 { 151 u32 i; 152 static u32 val[8] = { 153 0x00570000, 0x06AA0000, 0x18B20000, 0x20930000, 154 0x2B9A0000, 0x35A10000, 0x3EAA0000, 0x40000000 155 }; 156 157 if (rate == 44100) 158 return 0x40000000; /* FIXME: What's the right value? */ 159 for (i = 0; i < 8; i++) 160 if (rate <= def_rate[i]) 161 return val[i]; 162 return val[0]; 163 } 164 165 static u32 snd_ymfpci_calc_lpfQ(u32 rate) 166 { 167 u32 i; 168 static u32 val[8] = { 169 0x35280000, 0x34A70000, 0x32020000, 0x31770000, 170 0x31390000, 0x31C90000, 0x33D00000, 0x40000000 171 }; 172 173 if (rate == 44100) 174 return 0x370A0000; 175 for (i = 0; i < 8; i++) 176 if (rate <= def_rate[i]) 177 return val[i]; 178 return val[0]; 179 } 180 181 /* 182 * Hardware start management 183 */ 184 185 static void snd_ymfpci_hw_start(struct snd_ymfpci *chip) 186 { 187 unsigned long flags; 188 189 spin_lock_irqsave(&chip->reg_lock, flags); 190 if (chip->start_count++ > 0) 191 goto __end; 192 snd_ymfpci_writel(chip, YDSXGR_MODE, 193 snd_ymfpci_readl(chip, YDSXGR_MODE) | 3); 194 chip->active_bank = snd_ymfpci_readl(chip, YDSXGR_CTRLSELECT) & 1; 195 __end: 196 spin_unlock_irqrestore(&chip->reg_lock, flags); 197 } 198 199 static void snd_ymfpci_hw_stop(struct snd_ymfpci *chip) 200 { 201 unsigned long flags; 202 long timeout = 1000; 203 204 spin_lock_irqsave(&chip->reg_lock, flags); 205 if (--chip->start_count > 0) 206 goto __end; 207 snd_ymfpci_writel(chip, YDSXGR_MODE, 208 snd_ymfpci_readl(chip, YDSXGR_MODE) & ~3); 209 while (timeout-- > 0) { 210 if ((snd_ymfpci_readl(chip, YDSXGR_STATUS) & 2) == 0) 211 break; 212 } 213 if (atomic_read(&chip->interrupt_sleep_count)) { 214 atomic_set(&chip->interrupt_sleep_count, 0); 215 wake_up(&chip->interrupt_sleep); 216 } 217 __end: 218 spin_unlock_irqrestore(&chip->reg_lock, flags); 219 } 220 221 /* 222 * Playback voice management 223 */ 224 225 static int voice_alloc(struct snd_ymfpci *chip, 226 enum snd_ymfpci_voice_type type, int pair, 227 struct snd_ymfpci_voice **rvoice) 228 { 229 struct snd_ymfpci_voice *voice, *voice2; 230 int idx; 231 232 *rvoice = NULL; 233 for (idx = 0; idx < YDSXG_PLAYBACK_VOICES; idx += pair ? 2 : 1) { 234 voice = &chip->voices[idx]; 235 voice2 = pair ? &chip->voices[idx+1] : NULL; 236 if (voice->use || (voice2 && voice2->use)) 237 continue; 238 voice->use = 1; 239 if (voice2) 240 voice2->use = 1; 241 switch (type) { 242 case YMFPCI_PCM: 243 voice->pcm = 1; 244 if (voice2) 245 voice2->pcm = 1; 246 break; 247 case YMFPCI_SYNTH: 248 voice->synth = 1; 249 break; 250 case YMFPCI_MIDI: 251 voice->midi = 1; 252 break; 253 } 254 snd_ymfpci_hw_start(chip); 255 if (voice2) 256 snd_ymfpci_hw_start(chip); 257 *rvoice = voice; 258 return 0; 259 } 260 return -ENOMEM; 261 } 262 263 static int snd_ymfpci_voice_alloc(struct snd_ymfpci *chip, 264 enum snd_ymfpci_voice_type type, int pair, 265 struct snd_ymfpci_voice **rvoice) 266 { 267 unsigned long flags; 268 int result; 269 270 snd_assert(rvoice != NULL, return -EINVAL); 271 snd_assert(!pair || type == YMFPCI_PCM, return -EINVAL); 272 273 spin_lock_irqsave(&chip->voice_lock, flags); 274 for (;;) { 275 result = voice_alloc(chip, type, pair, rvoice); 276 if (result == 0 || type != YMFPCI_PCM) 277 break; 278 /* TODO: synth/midi voice deallocation */ 279 break; 280 } 281 spin_unlock_irqrestore(&chip->voice_lock, flags); 282 return result; 283 } 284 285 static int snd_ymfpci_voice_free(struct snd_ymfpci *chip, struct snd_ymfpci_voice *pvoice) 286 { 287 unsigned long flags; 288 289 snd_assert(pvoice != NULL, return -EINVAL); 290 snd_ymfpci_hw_stop(chip); 291 spin_lock_irqsave(&chip->voice_lock, flags); 292 pvoice->use = pvoice->pcm = pvoice->synth = pvoice->midi = 0; 293 pvoice->ypcm = NULL; 294 pvoice->interrupt = NULL; 295 spin_unlock_irqrestore(&chip->voice_lock, flags); 296 return 0; 297 } 298 299 /* 300 * PCM part 301 */ 302 303 static void snd_ymfpci_pcm_interrupt(struct snd_ymfpci *chip, struct snd_ymfpci_voice *voice) 304 { 305 struct snd_ymfpci_pcm *ypcm; 306 u32 pos, delta; 307 308 if ((ypcm = voice->ypcm) == NULL) 309 return; 310 if (ypcm->substream == NULL) 311 return; 312 spin_lock(&chip->reg_lock); 313 if (ypcm->running) { 314 pos = le32_to_cpu(voice->bank[chip->active_bank].start); 315 if (pos < ypcm->last_pos) 316 delta = pos + (ypcm->buffer_size - ypcm->last_pos); 317 else 318 delta = pos - ypcm->last_pos; 319 ypcm->period_pos += delta; 320 ypcm->last_pos = pos; 321 if (ypcm->period_pos >= ypcm->period_size) { 322 // printk("done - active_bank = 0x%x, start = 0x%x\n", chip->active_bank, voice->bank[chip->active_bank].start); 323 ypcm->period_pos %= ypcm->period_size; 324 spin_unlock(&chip->reg_lock); 325 snd_pcm_period_elapsed(ypcm->substream); 326 spin_lock(&chip->reg_lock); 327 } 328 329 if (unlikely(ypcm->update_pcm_vol)) { 330 unsigned int subs = ypcm->substream->number; 331 unsigned int next_bank = 1 - chip->active_bank; 332 struct snd_ymfpci_playback_bank *bank; 333 u32 volume; 334 335 bank = &voice->bank[next_bank]; 336 volume = cpu_to_le32(chip->pcm_mixer[subs].left << 15); 337 bank->left_gain_end = volume; 338 if (ypcm->output_rear) 339 bank->eff2_gain_end = volume; 340 if (ypcm->voices[1]) 341 bank = &ypcm->voices[1]->bank[next_bank]; 342 volume = cpu_to_le32(chip->pcm_mixer[subs].right << 15); 343 bank->right_gain_end = volume; 344 if (ypcm->output_rear) 345 bank->eff3_gain_end = volume; 346 ypcm->update_pcm_vol--; 347 } 348 } 349 spin_unlock(&chip->reg_lock); 350 } 351 352 static void snd_ymfpci_pcm_capture_interrupt(struct snd_pcm_substream *substream) 353 { 354 struct snd_pcm_runtime *runtime = substream->runtime; 355 struct snd_ymfpci_pcm *ypcm = runtime->private_data; 356 struct snd_ymfpci *chip = ypcm->chip; 357 u32 pos, delta; 358 359 spin_lock(&chip->reg_lock); 360 if (ypcm->running) { 361 pos = le32_to_cpu(chip->bank_capture[ypcm->capture_bank_number][chip->active_bank]->start) >> ypcm->shift; 362 if (pos < ypcm->last_pos) 363 delta = pos + (ypcm->buffer_size - ypcm->last_pos); 364 else 365 delta = pos - ypcm->last_pos; 366 ypcm->period_pos += delta; 367 ypcm->last_pos = pos; 368 if (ypcm->period_pos >= ypcm->period_size) { 369 ypcm->period_pos %= ypcm->period_size; 370 // printk("done - active_bank = 0x%x, start = 0x%x\n", chip->active_bank, voice->bank[chip->active_bank].start); 371 spin_unlock(&chip->reg_lock); 372 snd_pcm_period_elapsed(substream); 373 spin_lock(&chip->reg_lock); 374 } 375 } 376 spin_unlock(&chip->reg_lock); 377 } 378 379 static int snd_ymfpci_playback_trigger(struct snd_pcm_substream *substream, 380 int cmd) 381 { 382 struct snd_ymfpci *chip = snd_pcm_substream_chip(substream); 383 struct snd_ymfpci_pcm *ypcm = substream->runtime->private_data; 384 int result = 0; 385 386 spin_lock(&chip->reg_lock); 387 if (ypcm->voices[0] == NULL) { 388 result = -EINVAL; 389 goto __unlock; 390 } 391 switch (cmd) { 392 case SNDRV_PCM_TRIGGER_START: 393 case SNDRV_PCM_TRIGGER_PAUSE_RELEASE: 394 case SNDRV_PCM_TRIGGER_RESUME: 395 chip->ctrl_playback[ypcm->voices[0]->number + 1] = cpu_to_le32(ypcm->voices[0]->bank_addr); 396 if (ypcm->voices[1] != NULL) 397 chip->ctrl_playback[ypcm->voices[1]->number + 1] = cpu_to_le32(ypcm->voices[1]->bank_addr); 398 ypcm->running = 1; 399 break; 400 case SNDRV_PCM_TRIGGER_STOP: 401 case SNDRV_PCM_TRIGGER_PAUSE_PUSH: 402 case SNDRV_PCM_TRIGGER_SUSPEND: 403 chip->ctrl_playback[ypcm->voices[0]->number + 1] = 0; 404 if (ypcm->voices[1] != NULL) 405 chip->ctrl_playback[ypcm->voices[1]->number + 1] = 0; 406 ypcm->running = 0; 407 break; 408 default: 409 result = -EINVAL; 410 break; 411 } 412 __unlock: 413 spin_unlock(&chip->reg_lock); 414 return result; 415 } 416 static int snd_ymfpci_capture_trigger(struct snd_pcm_substream *substream, 417 int cmd) 418 { 419 struct snd_ymfpci *chip = snd_pcm_substream_chip(substream); 420 struct snd_ymfpci_pcm *ypcm = substream->runtime->private_data; 421 int result = 0; 422 u32 tmp; 423 424 spin_lock(&chip->reg_lock); 425 switch (cmd) { 426 case SNDRV_PCM_TRIGGER_START: 427 case SNDRV_PCM_TRIGGER_PAUSE_RELEASE: 428 case SNDRV_PCM_TRIGGER_RESUME: 429 tmp = snd_ymfpci_readl(chip, YDSXGR_MAPOFREC) | (1 << ypcm->capture_bank_number); 430 snd_ymfpci_writel(chip, YDSXGR_MAPOFREC, tmp); 431 ypcm->running = 1; 432 break; 433 case SNDRV_PCM_TRIGGER_STOP: 434 case SNDRV_PCM_TRIGGER_PAUSE_PUSH: 435 case SNDRV_PCM_TRIGGER_SUSPEND: 436 tmp = snd_ymfpci_readl(chip, YDSXGR_MAPOFREC) & ~(1 << ypcm->capture_bank_number); 437 snd_ymfpci_writel(chip, YDSXGR_MAPOFREC, tmp); 438 ypcm->running = 0; 439 break; 440 default: 441 result = -EINVAL; 442 break; 443 } 444 spin_unlock(&chip->reg_lock); 445 return result; 446 } 447 448 static int snd_ymfpci_pcm_voice_alloc(struct snd_ymfpci_pcm *ypcm, int voices) 449 { 450 int err; 451 452 if (ypcm->voices[1] != NULL && voices < 2) { 453 snd_ymfpci_voice_free(ypcm->chip, ypcm->voices[1]); 454 ypcm->voices[1] = NULL; 455 } 456 if (voices == 1 && ypcm->voices[0] != NULL) 457 return 0; /* already allocated */ 458 if (voices == 2 && ypcm->voices[0] != NULL && ypcm->voices[1] != NULL) 459 return 0; /* already allocated */ 460 if (voices > 1) { 461 if (ypcm->voices[0] != NULL && ypcm->voices[1] == NULL) { 462 snd_ymfpci_voice_free(ypcm->chip, ypcm->voices[0]); 463 ypcm->voices[0] = NULL; 464 } 465 } 466 err = snd_ymfpci_voice_alloc(ypcm->chip, YMFPCI_PCM, voices > 1, &ypcm->voices[0]); 467 if (err < 0) 468 return err; 469 ypcm->voices[0]->ypcm = ypcm; 470 ypcm->voices[0]->interrupt = snd_ymfpci_pcm_interrupt; 471 if (voices > 1) { 472 ypcm->voices[1] = &ypcm->chip->voices[ypcm->voices[0]->number + 1]; 473 ypcm->voices[1]->ypcm = ypcm; 474 } 475 return 0; 476 } 477 478 static void snd_ymfpci_pcm_init_voice(struct snd_ymfpci_pcm *ypcm, unsigned int voiceidx, 479 struct snd_pcm_runtime *runtime, 480 int has_pcm_volume) 481 { 482 struct snd_ymfpci_voice *voice = ypcm->voices[voiceidx]; 483 u32 format; 484 u32 delta = snd_ymfpci_calc_delta(runtime->rate); 485 u32 lpfQ = snd_ymfpci_calc_lpfQ(runtime->rate); 486 u32 lpfK = snd_ymfpci_calc_lpfK(runtime->rate); 487 struct snd_ymfpci_playback_bank *bank; 488 unsigned int nbank; 489 u32 vol_left, vol_right; 490 u8 use_left, use_right; 491 492 snd_assert(voice != NULL, return); 493 if (runtime->channels == 1) { 494 use_left = 1; 495 use_right = 1; 496 } else { 497 use_left = (voiceidx & 1) == 0; 498 use_right = !use_left; 499 } 500 if (has_pcm_volume) { 501 vol_left = cpu_to_le32(ypcm->chip->pcm_mixer 502 [ypcm->substream->number].left << 15); 503 vol_right = cpu_to_le32(ypcm->chip->pcm_mixer 504 [ypcm->substream->number].right << 15); 505 } else { 506 vol_left = cpu_to_le32(0x40000000); 507 vol_right = cpu_to_le32(0x40000000); 508 } 509 format = runtime->channels == 2 ? 0x00010000 : 0; 510 if (snd_pcm_format_width(runtime->format) == 8) 511 format |= 0x80000000; 512 if (runtime->channels == 2 && (voiceidx & 1) != 0) 513 format |= 1; 514 for (nbank = 0; nbank < 2; nbank++) { 515 bank = &voice->bank[nbank]; 516 memset(bank, 0, sizeof(*bank)); 517 bank->format = cpu_to_le32(format); 518 bank->base = cpu_to_le32(runtime->dma_addr); 519 bank->loop_end = cpu_to_le32(ypcm->buffer_size); 520 bank->lpfQ = cpu_to_le32(lpfQ); 521 bank->delta = 522 bank->delta_end = cpu_to_le32(delta); 523 bank->lpfK = 524 bank->lpfK_end = cpu_to_le32(lpfK); 525 bank->eg_gain = 526 bank->eg_gain_end = cpu_to_le32(0x40000000); 527 528 if (ypcm->output_front) { 529 if (use_left) { 530 bank->left_gain = 531 bank->left_gain_end = vol_left; 532 } 533 if (use_right) { 534 bank->right_gain = 535 bank->right_gain_end = vol_right; 536 } 537 } 538 if (ypcm->output_rear) { 539 if (!ypcm->swap_rear) { 540 if (use_left) { 541 bank->eff2_gain = 542 bank->eff2_gain_end = vol_left; 543 } 544 if (use_right) { 545 bank->eff3_gain = 546 bank->eff3_gain_end = vol_right; 547 } 548 } else { 549 /* The SPDIF out channels seem to be swapped, so we have 550 * to swap them here, too. The rear analog out channels 551 * will be wrong, but otherwise AC3 would not work. 552 */ 553 if (use_left) { 554 bank->eff3_gain = 555 bank->eff3_gain_end = vol_left; 556 } 557 if (use_right) { 558 bank->eff2_gain = 559 bank->eff2_gain_end = vol_right; 560 } 561 } 562 } 563 } 564 } 565 566 static int __devinit snd_ymfpci_ac3_init(struct snd_ymfpci *chip) 567 { 568 if (snd_dma_alloc_pages(SNDRV_DMA_TYPE_DEV, snd_dma_pci_data(chip->pci), 569 4096, &chip->ac3_tmp_base) < 0) 570 return -ENOMEM; 571 572 chip->bank_effect[3][0]->base = 573 chip->bank_effect[3][1]->base = cpu_to_le32(chip->ac3_tmp_base.addr); 574 chip->bank_effect[3][0]->loop_end = 575 chip->bank_effect[3][1]->loop_end = cpu_to_le32(1024); 576 chip->bank_effect[4][0]->base = 577 chip->bank_effect[4][1]->base = cpu_to_le32(chip->ac3_tmp_base.addr + 2048); 578 chip->bank_effect[4][0]->loop_end = 579 chip->bank_effect[4][1]->loop_end = cpu_to_le32(1024); 580 581 spin_lock_irq(&chip->reg_lock); 582 snd_ymfpci_writel(chip, YDSXGR_MAPOFEFFECT, 583 snd_ymfpci_readl(chip, YDSXGR_MAPOFEFFECT) | 3 << 3); 584 spin_unlock_irq(&chip->reg_lock); 585 return 0; 586 } 587 588 static int snd_ymfpci_ac3_done(struct snd_ymfpci *chip) 589 { 590 spin_lock_irq(&chip->reg_lock); 591 snd_ymfpci_writel(chip, YDSXGR_MAPOFEFFECT, 592 snd_ymfpci_readl(chip, YDSXGR_MAPOFEFFECT) & ~(3 << 3)); 593 spin_unlock_irq(&chip->reg_lock); 594 // snd_ymfpci_irq_wait(chip); 595 if (chip->ac3_tmp_base.area) { 596 snd_dma_free_pages(&chip->ac3_tmp_base); 597 chip->ac3_tmp_base.area = NULL; 598 } 599 return 0; 600 } 601 602 static int snd_ymfpci_playback_hw_params(struct snd_pcm_substream *substream, 603 struct snd_pcm_hw_params *hw_params) 604 { 605 struct snd_pcm_runtime *runtime = substream->runtime; 606 struct snd_ymfpci_pcm *ypcm = runtime->private_data; 607 int err; 608 609 if ((err = snd_pcm_lib_malloc_pages(substream, params_buffer_bytes(hw_params))) < 0) 610 return err; 611 if ((err = snd_ymfpci_pcm_voice_alloc(ypcm, params_channels(hw_params))) < 0) 612 return err; 613 return 0; 614 } 615 616 static int snd_ymfpci_playback_hw_free(struct snd_pcm_substream *substream) 617 { 618 struct snd_ymfpci *chip = snd_pcm_substream_chip(substream); 619 struct snd_pcm_runtime *runtime = substream->runtime; 620 struct snd_ymfpci_pcm *ypcm; 621 622 if (runtime->private_data == NULL) 623 return 0; 624 ypcm = runtime->private_data; 625 626 /* wait, until the PCI operations are not finished */ 627 snd_ymfpci_irq_wait(chip); 628 snd_pcm_lib_free_pages(substream); 629 if (ypcm->voices[1]) { 630 snd_ymfpci_voice_free(chip, ypcm->voices[1]); 631 ypcm->voices[1] = NULL; 632 } 633 if (ypcm->voices[0]) { 634 snd_ymfpci_voice_free(chip, ypcm->voices[0]); 635 ypcm->voices[0] = NULL; 636 } 637 return 0; 638 } 639 640 static int snd_ymfpci_playback_prepare(struct snd_pcm_substream *substream) 641 { 642 struct snd_ymfpci *chip = snd_pcm_substream_chip(substream); 643 struct snd_pcm_runtime *runtime = substream->runtime; 644 struct snd_ymfpci_pcm *ypcm = runtime->private_data; 645 unsigned int nvoice; 646 647 ypcm->period_size = runtime->period_size; 648 ypcm->buffer_size = runtime->buffer_size; 649 ypcm->period_pos = 0; 650 ypcm->last_pos = 0; 651 for (nvoice = 0; nvoice < runtime->channels; nvoice++) 652 snd_ymfpci_pcm_init_voice(ypcm, nvoice, runtime, 653 substream->pcm == chip->pcm); 654 return 0; 655 } 656 657 static int snd_ymfpci_capture_hw_params(struct snd_pcm_substream *substream, 658 struct snd_pcm_hw_params *hw_params) 659 { 660 return snd_pcm_lib_malloc_pages(substream, params_buffer_bytes(hw_params)); 661 } 662 663 static int snd_ymfpci_capture_hw_free(struct snd_pcm_substream *substream) 664 { 665 struct snd_ymfpci *chip = snd_pcm_substream_chip(substream); 666 667 /* wait, until the PCI operations are not finished */ 668 snd_ymfpci_irq_wait(chip); 669 return snd_pcm_lib_free_pages(substream); 670 } 671 672 static int snd_ymfpci_capture_prepare(struct snd_pcm_substream *substream) 673 { 674 struct snd_ymfpci *chip = snd_pcm_substream_chip(substream); 675 struct snd_pcm_runtime *runtime = substream->runtime; 676 struct snd_ymfpci_pcm *ypcm = runtime->private_data; 677 struct snd_ymfpci_capture_bank * bank; 678 int nbank; 679 u32 rate, format; 680 681 ypcm->period_size = runtime->period_size; 682 ypcm->buffer_size = runtime->buffer_size; 683 ypcm->period_pos = 0; 684 ypcm->last_pos = 0; 685 ypcm->shift = 0; 686 rate = ((48000 * 4096) / runtime->rate) - 1; 687 format = 0; 688 if (runtime->channels == 2) { 689 format |= 2; 690 ypcm->shift++; 691 } 692 if (snd_pcm_format_width(runtime->format) == 8) 693 format |= 1; 694 else 695 ypcm->shift++; 696 switch (ypcm->capture_bank_number) { 697 case 0: 698 snd_ymfpci_writel(chip, YDSXGR_RECFORMAT, format); 699 snd_ymfpci_writel(chip, YDSXGR_RECSLOTSR, rate); 700 break; 701 case 1: 702 snd_ymfpci_writel(chip, YDSXGR_ADCFORMAT, format); 703 snd_ymfpci_writel(chip, YDSXGR_ADCSLOTSR, rate); 704 break; 705 } 706 for (nbank = 0; nbank < 2; nbank++) { 707 bank = chip->bank_capture[ypcm->capture_bank_number][nbank]; 708 bank->base = cpu_to_le32(runtime->dma_addr); 709 bank->loop_end = cpu_to_le32(ypcm->buffer_size << ypcm->shift); 710 bank->start = 0; 711 bank->num_of_loops = 0; 712 } 713 return 0; 714 } 715 716 static snd_pcm_uframes_t snd_ymfpci_playback_pointer(struct snd_pcm_substream *substream) 717 { 718 struct snd_ymfpci *chip = snd_pcm_substream_chip(substream); 719 struct snd_pcm_runtime *runtime = substream->runtime; 720 struct snd_ymfpci_pcm *ypcm = runtime->private_data; 721 struct snd_ymfpci_voice *voice = ypcm->voices[0]; 722 723 if (!(ypcm->running && voice)) 724 return 0; 725 return le32_to_cpu(voice->bank[chip->active_bank].start); 726 } 727 728 static snd_pcm_uframes_t snd_ymfpci_capture_pointer(struct snd_pcm_substream *substream) 729 { 730 struct snd_ymfpci *chip = snd_pcm_substream_chip(substream); 731 struct snd_pcm_runtime *runtime = substream->runtime; 732 struct snd_ymfpci_pcm *ypcm = runtime->private_data; 733 734 if (!ypcm->running) 735 return 0; 736 return le32_to_cpu(chip->bank_capture[ypcm->capture_bank_number][chip->active_bank]->start) >> ypcm->shift; 737 } 738 739 static void snd_ymfpci_irq_wait(struct snd_ymfpci *chip) 740 { 741 wait_queue_t wait; 742 int loops = 4; 743 744 while (loops-- > 0) { 745 if ((snd_ymfpci_readl(chip, YDSXGR_MODE) & 3) == 0) 746 continue; 747 init_waitqueue_entry(&wait, current); 748 add_wait_queue(&chip->interrupt_sleep, &wait); 749 atomic_inc(&chip->interrupt_sleep_count); 750 schedule_timeout_uninterruptible(msecs_to_jiffies(50)); 751 remove_wait_queue(&chip->interrupt_sleep, &wait); 752 } 753 } 754 755 static irqreturn_t snd_ymfpci_interrupt(int irq, void *dev_id, struct pt_regs *regs) 756 { 757 struct snd_ymfpci *chip = dev_id; 758 u32 status, nvoice, mode; 759 struct snd_ymfpci_voice *voice; 760 761 status = snd_ymfpci_readl(chip, YDSXGR_STATUS); 762 if (status & 0x80000000) { 763 chip->active_bank = snd_ymfpci_readl(chip, YDSXGR_CTRLSELECT) & 1; 764 spin_lock(&chip->voice_lock); 765 for (nvoice = 0; nvoice < YDSXG_PLAYBACK_VOICES; nvoice++) { 766 voice = &chip->voices[nvoice]; 767 if (voice->interrupt) 768 voice->interrupt(chip, voice); 769 } 770 for (nvoice = 0; nvoice < YDSXG_CAPTURE_VOICES; nvoice++) { 771 if (chip->capture_substream[nvoice]) 772 snd_ymfpci_pcm_capture_interrupt(chip->capture_substream[nvoice]); 773 } 774 #if 0 775 for (nvoice = 0; nvoice < YDSXG_EFFECT_VOICES; nvoice++) { 776 if (chip->effect_substream[nvoice]) 777 snd_ymfpci_pcm_effect_interrupt(chip->effect_substream[nvoice]); 778 } 779 #endif 780 spin_unlock(&chip->voice_lock); 781 spin_lock(&chip->reg_lock); 782 snd_ymfpci_writel(chip, YDSXGR_STATUS, 0x80000000); 783 mode = snd_ymfpci_readl(chip, YDSXGR_MODE) | 2; 784 snd_ymfpci_writel(chip, YDSXGR_MODE, mode); 785 spin_unlock(&chip->reg_lock); 786 787 if (atomic_read(&chip->interrupt_sleep_count)) { 788 atomic_set(&chip->interrupt_sleep_count, 0); 789 wake_up(&chip->interrupt_sleep); 790 } 791 } 792 793 status = snd_ymfpci_readw(chip, YDSXGR_INTFLAG); 794 if (status & 1) { 795 if (chip->timer) 796 snd_timer_interrupt(chip->timer, chip->timer->sticks); 797 } 798 snd_ymfpci_writew(chip, YDSXGR_INTFLAG, status); 799 800 if (chip->rawmidi) 801 snd_mpu401_uart_interrupt(irq, chip->rawmidi->private_data, regs); 802 return IRQ_HANDLED; 803 } 804 805 static struct snd_pcm_hardware snd_ymfpci_playback = 806 { 807 .info = (SNDRV_PCM_INFO_MMAP | 808 SNDRV_PCM_INFO_MMAP_VALID | 809 SNDRV_PCM_INFO_INTERLEAVED | 810 SNDRV_PCM_INFO_BLOCK_TRANSFER | 811 SNDRV_PCM_INFO_PAUSE | 812 SNDRV_PCM_INFO_RESUME), 813 .formats = SNDRV_PCM_FMTBIT_U8 | SNDRV_PCM_FMTBIT_S16_LE, 814 .rates = SNDRV_PCM_RATE_CONTINUOUS | SNDRV_PCM_RATE_8000_48000, 815 .rate_min = 8000, 816 .rate_max = 48000, 817 .channels_min = 1, 818 .channels_max = 2, 819 .buffer_bytes_max = 256 * 1024, /* FIXME: enough? */ 820 .period_bytes_min = 64, 821 .period_bytes_max = 256 * 1024, /* FIXME: enough? */ 822 .periods_min = 3, 823 .periods_max = 1024, 824 .fifo_size = 0, 825 }; 826 827 static struct snd_pcm_hardware snd_ymfpci_capture = 828 { 829 .info = (SNDRV_PCM_INFO_MMAP | 830 SNDRV_PCM_INFO_MMAP_VALID | 831 SNDRV_PCM_INFO_INTERLEAVED | 832 SNDRV_PCM_INFO_BLOCK_TRANSFER | 833 SNDRV_PCM_INFO_PAUSE | 834 SNDRV_PCM_INFO_RESUME), 835 .formats = SNDRV_PCM_FMTBIT_U8 | SNDRV_PCM_FMTBIT_S16_LE, 836 .rates = SNDRV_PCM_RATE_CONTINUOUS | SNDRV_PCM_RATE_8000_48000, 837 .rate_min = 8000, 838 .rate_max = 48000, 839 .channels_min = 1, 840 .channels_max = 2, 841 .buffer_bytes_max = 256 * 1024, /* FIXME: enough? */ 842 .period_bytes_min = 64, 843 .period_bytes_max = 256 * 1024, /* FIXME: enough? */ 844 .periods_min = 3, 845 .periods_max = 1024, 846 .fifo_size = 0, 847 }; 848 849 static void snd_ymfpci_pcm_free_substream(struct snd_pcm_runtime *runtime) 850 { 851 kfree(runtime->private_data); 852 } 853 854 static int snd_ymfpci_playback_open_1(struct snd_pcm_substream *substream) 855 { 856 struct snd_ymfpci *chip = snd_pcm_substream_chip(substream); 857 struct snd_pcm_runtime *runtime = substream->runtime; 858 struct snd_ymfpci_pcm *ypcm; 859 860 ypcm = kzalloc(sizeof(*ypcm), GFP_KERNEL); 861 if (ypcm == NULL) 862 return -ENOMEM; 863 ypcm->chip = chip; 864 ypcm->type = PLAYBACK_VOICE; 865 ypcm->substream = substream; 866 runtime->hw = snd_ymfpci_playback; 867 runtime->private_data = ypcm; 868 runtime->private_free = snd_ymfpci_pcm_free_substream; 869 /* FIXME? True value is 256/48 = 5.33333 ms */ 870 snd_pcm_hw_constraint_minmax(runtime, SNDRV_PCM_HW_PARAM_PERIOD_TIME, 5333, UINT_MAX); 871 return 0; 872 } 873 874 /* call with spinlock held */ 875 static void ymfpci_open_extension(struct snd_ymfpci *chip) 876 { 877 if (! chip->rear_opened) { 878 if (! chip->spdif_opened) /* set AC3 */ 879 snd_ymfpci_writel(chip, YDSXGR_MODE, 880 snd_ymfpci_readl(chip, YDSXGR_MODE) | (1 << 30)); 881 /* enable second codec (4CHEN) */ 882 snd_ymfpci_writew(chip, YDSXGR_SECCONFIG, 883 (snd_ymfpci_readw(chip, YDSXGR_SECCONFIG) & ~0x0330) | 0x0010); 884 } 885 } 886 887 /* call with spinlock held */ 888 static void ymfpci_close_extension(struct snd_ymfpci *chip) 889 { 890 if (! chip->rear_opened) { 891 if (! chip->spdif_opened) 892 snd_ymfpci_writel(chip, YDSXGR_MODE, 893 snd_ymfpci_readl(chip, YDSXGR_MODE) & ~(1 << 30)); 894 snd_ymfpci_writew(chip, YDSXGR_SECCONFIG, 895 (snd_ymfpci_readw(chip, YDSXGR_SECCONFIG) & ~0x0330) & ~0x0010); 896 } 897 } 898 899 static int snd_ymfpci_playback_open(struct snd_pcm_substream *substream) 900 { 901 struct snd_ymfpci *chip = snd_pcm_substream_chip(substream); 902 struct snd_pcm_runtime *runtime = substream->runtime; 903 struct snd_ymfpci_pcm *ypcm; 904 struct snd_kcontrol *kctl; 905 int err; 906 907 if ((err = snd_ymfpci_playback_open_1(substream)) < 0) 908 return err; 909 ypcm = runtime->private_data; 910 ypcm->output_front = 1; 911 ypcm->output_rear = chip->mode_dup4ch ? 1 : 0; 912 ypcm->swap_rear = chip->rear_swap; 913 spin_lock_irq(&chip->reg_lock); 914 if (ypcm->output_rear) { 915 ymfpci_open_extension(chip); 916 chip->rear_opened++; 917 } 918 spin_unlock_irq(&chip->reg_lock); 919 920 kctl = chip->pcm_mixer[substream->number].ctl; 921 kctl->vd[0].access &= ~SNDRV_CTL_ELEM_ACCESS_INACTIVE; 922 snd_ctl_notify(chip->card, SNDRV_CTL_EVENT_MASK_INFO, &kctl->id); 923 return 0; 924 } 925 926 static int snd_ymfpci_playback_spdif_open(struct snd_pcm_substream *substream) 927 { 928 struct snd_ymfpci *chip = snd_pcm_substream_chip(substream); 929 struct snd_pcm_runtime *runtime = substream->runtime; 930 struct snd_ymfpci_pcm *ypcm; 931 int err; 932 933 if ((err = snd_ymfpci_playback_open_1(substream)) < 0) 934 return err; 935 ypcm = runtime->private_data; 936 ypcm->output_front = 0; 937 ypcm->output_rear = 1; 938 spin_lock_irq(&chip->reg_lock); 939 snd_ymfpci_writew(chip, YDSXGR_SPDIFOUTCTRL, 940 snd_ymfpci_readw(chip, YDSXGR_SPDIFOUTCTRL) | 2); 941 ymfpci_open_extension(chip); 942 chip->spdif_pcm_bits = chip->spdif_bits; 943 snd_ymfpci_writew(chip, YDSXGR_SPDIFOUTSTATUS, chip->spdif_pcm_bits); 944 chip->spdif_opened++; 945 spin_unlock_irq(&chip->reg_lock); 946 947 chip->spdif_pcm_ctl->vd[0].access &= ~SNDRV_CTL_ELEM_ACCESS_INACTIVE; 948 snd_ctl_notify(chip->card, SNDRV_CTL_EVENT_MASK_VALUE | 949 SNDRV_CTL_EVENT_MASK_INFO, &chip->spdif_pcm_ctl->id); 950 return 0; 951 } 952 953 static int snd_ymfpci_playback_4ch_open(struct snd_pcm_substream *substream) 954 { 955 struct snd_ymfpci *chip = snd_pcm_substream_chip(substream); 956 struct snd_pcm_runtime *runtime = substream->runtime; 957 struct snd_ymfpci_pcm *ypcm; 958 int err; 959 960 if ((err = snd_ymfpci_playback_open_1(substream)) < 0) 961 return err; 962 ypcm = runtime->private_data; 963 ypcm->output_front = 0; 964 ypcm->output_rear = 1; 965 spin_lock_irq(&chip->reg_lock); 966 ymfpci_open_extension(chip); 967 chip->rear_opened++; 968 spin_unlock_irq(&chip->reg_lock); 969 return 0; 970 } 971 972 static int snd_ymfpci_capture_open(struct snd_pcm_substream *substream, 973 u32 capture_bank_number) 974 { 975 struct snd_ymfpci *chip = snd_pcm_substream_chip(substream); 976 struct snd_pcm_runtime *runtime = substream->runtime; 977 struct snd_ymfpci_pcm *ypcm; 978 979 ypcm = kzalloc(sizeof(*ypcm), GFP_KERNEL); 980 if (ypcm == NULL) 981 return -ENOMEM; 982 ypcm->chip = chip; 983 ypcm->type = capture_bank_number + CAPTURE_REC; 984 ypcm->substream = substream; 985 ypcm->capture_bank_number = capture_bank_number; 986 chip->capture_substream[capture_bank_number] = substream; 987 runtime->hw = snd_ymfpci_capture; 988 /* FIXME? True value is 256/48 = 5.33333 ms */ 989 snd_pcm_hw_constraint_minmax(runtime, SNDRV_PCM_HW_PARAM_PERIOD_TIME, 5333, UINT_MAX); 990 runtime->private_data = ypcm; 991 runtime->private_free = snd_ymfpci_pcm_free_substream; 992 snd_ymfpci_hw_start(chip); 993 return 0; 994 } 995 996 static int snd_ymfpci_capture_rec_open(struct snd_pcm_substream *substream) 997 { 998 return snd_ymfpci_capture_open(substream, 0); 999 } 1000 1001 static int snd_ymfpci_capture_ac97_open(struct snd_pcm_substream *substream) 1002 { 1003 return snd_ymfpci_capture_open(substream, 1); 1004 } 1005 1006 static int snd_ymfpci_playback_close_1(struct snd_pcm_substream *substream) 1007 { 1008 return 0; 1009 } 1010 1011 static int snd_ymfpci_playback_close(struct snd_pcm_substream *substream) 1012 { 1013 struct snd_ymfpci *chip = snd_pcm_substream_chip(substream); 1014 struct snd_ymfpci_pcm *ypcm = substream->runtime->private_data; 1015 struct snd_kcontrol *kctl; 1016 1017 spin_lock_irq(&chip->reg_lock); 1018 if (ypcm->output_rear && chip->rear_opened > 0) { 1019 chip->rear_opened--; 1020 ymfpci_close_extension(chip); 1021 } 1022 spin_unlock_irq(&chip->reg_lock); 1023 kctl = chip->pcm_mixer[substream->number].ctl; 1024 kctl->vd[0].access |= SNDRV_CTL_ELEM_ACCESS_INACTIVE; 1025 snd_ctl_notify(chip->card, SNDRV_CTL_EVENT_MASK_INFO, &kctl->id); 1026 return snd_ymfpci_playback_close_1(substream); 1027 } 1028 1029 static int snd_ymfpci_playback_spdif_close(struct snd_pcm_substream *substream) 1030 { 1031 struct snd_ymfpci *chip = snd_pcm_substream_chip(substream); 1032 1033 spin_lock_irq(&chip->reg_lock); 1034 chip->spdif_opened = 0; 1035 ymfpci_close_extension(chip); 1036 snd_ymfpci_writew(chip, YDSXGR_SPDIFOUTCTRL, 1037 snd_ymfpci_readw(chip, YDSXGR_SPDIFOUTCTRL) & ~2); 1038 snd_ymfpci_writew(chip, YDSXGR_SPDIFOUTSTATUS, chip->spdif_bits); 1039 spin_unlock_irq(&chip->reg_lock); 1040 chip->spdif_pcm_ctl->vd[0].access |= SNDRV_CTL_ELEM_ACCESS_INACTIVE; 1041 snd_ctl_notify(chip->card, SNDRV_CTL_EVENT_MASK_VALUE | 1042 SNDRV_CTL_EVENT_MASK_INFO, &chip->spdif_pcm_ctl->id); 1043 return snd_ymfpci_playback_close_1(substream); 1044 } 1045 1046 static int snd_ymfpci_playback_4ch_close(struct snd_pcm_substream *substream) 1047 { 1048 struct snd_ymfpci *chip = snd_pcm_substream_chip(substream); 1049 1050 spin_lock_irq(&chip->reg_lock); 1051 if (chip->rear_opened > 0) { 1052 chip->rear_opened--; 1053 ymfpci_close_extension(chip); 1054 } 1055 spin_unlock_irq(&chip->reg_lock); 1056 return snd_ymfpci_playback_close_1(substream); 1057 } 1058 1059 static int snd_ymfpci_capture_close(struct snd_pcm_substream *substream) 1060 { 1061 struct snd_ymfpci *chip = snd_pcm_substream_chip(substream); 1062 struct snd_pcm_runtime *runtime = substream->runtime; 1063 struct snd_ymfpci_pcm *ypcm = runtime->private_data; 1064 1065 if (ypcm != NULL) { 1066 chip->capture_substream[ypcm->capture_bank_number] = NULL; 1067 snd_ymfpci_hw_stop(chip); 1068 } 1069 return 0; 1070 } 1071 1072 static struct snd_pcm_ops snd_ymfpci_playback_ops = { 1073 .open = snd_ymfpci_playback_open, 1074 .close = snd_ymfpci_playback_close, 1075 .ioctl = snd_pcm_lib_ioctl, 1076 .hw_params = snd_ymfpci_playback_hw_params, 1077 .hw_free = snd_ymfpci_playback_hw_free, 1078 .prepare = snd_ymfpci_playback_prepare, 1079 .trigger = snd_ymfpci_playback_trigger, 1080 .pointer = snd_ymfpci_playback_pointer, 1081 }; 1082 1083 static struct snd_pcm_ops snd_ymfpci_capture_rec_ops = { 1084 .open = snd_ymfpci_capture_rec_open, 1085 .close = snd_ymfpci_capture_close, 1086 .ioctl = snd_pcm_lib_ioctl, 1087 .hw_params = snd_ymfpci_capture_hw_params, 1088 .hw_free = snd_ymfpci_capture_hw_free, 1089 .prepare = snd_ymfpci_capture_prepare, 1090 .trigger = snd_ymfpci_capture_trigger, 1091 .pointer = snd_ymfpci_capture_pointer, 1092 }; 1093 1094 int __devinit snd_ymfpci_pcm(struct snd_ymfpci *chip, int device, struct snd_pcm ** rpcm) 1095 { 1096 struct snd_pcm *pcm; 1097 int err; 1098 1099 if (rpcm) 1100 *rpcm = NULL; 1101 if ((err = snd_pcm_new(chip->card, "YMFPCI", device, 32, 1, &pcm)) < 0) 1102 return err; 1103 pcm->private_data = chip; 1104 1105 snd_pcm_set_ops(pcm, SNDRV_PCM_STREAM_PLAYBACK, &snd_ymfpci_playback_ops); 1106 snd_pcm_set_ops(pcm, SNDRV_PCM_STREAM_CAPTURE, &snd_ymfpci_capture_rec_ops); 1107 1108 /* global setup */ 1109 pcm->info_flags = 0; 1110 strcpy(pcm->name, "YMFPCI"); 1111 chip->pcm = pcm; 1112 1113 snd_pcm_lib_preallocate_pages_for_all(pcm, SNDRV_DMA_TYPE_DEV, 1114 snd_dma_pci_data(chip->pci), 64*1024, 256*1024); 1115 1116 if (rpcm) 1117 *rpcm = pcm; 1118 return 0; 1119 } 1120 1121 static struct snd_pcm_ops snd_ymfpci_capture_ac97_ops = { 1122 .open = snd_ymfpci_capture_ac97_open, 1123 .close = snd_ymfpci_capture_close, 1124 .ioctl = snd_pcm_lib_ioctl, 1125 .hw_params = snd_ymfpci_capture_hw_params, 1126 .hw_free = snd_ymfpci_capture_hw_free, 1127 .prepare = snd_ymfpci_capture_prepare, 1128 .trigger = snd_ymfpci_capture_trigger, 1129 .pointer = snd_ymfpci_capture_pointer, 1130 }; 1131 1132 int __devinit snd_ymfpci_pcm2(struct snd_ymfpci *chip, int device, struct snd_pcm ** rpcm) 1133 { 1134 struct snd_pcm *pcm; 1135 int err; 1136 1137 if (rpcm) 1138 *rpcm = NULL; 1139 if ((err = snd_pcm_new(chip->card, "YMFPCI - PCM2", device, 0, 1, &pcm)) < 0) 1140 return err; 1141 pcm->private_data = chip; 1142 1143 snd_pcm_set_ops(pcm, SNDRV_PCM_STREAM_CAPTURE, &snd_ymfpci_capture_ac97_ops); 1144 1145 /* global setup */ 1146 pcm->info_flags = 0; 1147 sprintf(pcm->name, "YMFPCI - %s", 1148 chip->device_id == PCI_DEVICE_ID_YAMAHA_754 ? "Direct Recording" : "AC'97"); 1149 chip->pcm2 = pcm; 1150 1151 snd_pcm_lib_preallocate_pages_for_all(pcm, SNDRV_DMA_TYPE_DEV, 1152 snd_dma_pci_data(chip->pci), 64*1024, 256*1024); 1153 1154 if (rpcm) 1155 *rpcm = pcm; 1156 return 0; 1157 } 1158 1159 static struct snd_pcm_ops snd_ymfpci_playback_spdif_ops = { 1160 .open = snd_ymfpci_playback_spdif_open, 1161 .close = snd_ymfpci_playback_spdif_close, 1162 .ioctl = snd_pcm_lib_ioctl, 1163 .hw_params = snd_ymfpci_playback_hw_params, 1164 .hw_free = snd_ymfpci_playback_hw_free, 1165 .prepare = snd_ymfpci_playback_prepare, 1166 .trigger = snd_ymfpci_playback_trigger, 1167 .pointer = snd_ymfpci_playback_pointer, 1168 }; 1169 1170 int __devinit snd_ymfpci_pcm_spdif(struct snd_ymfpci *chip, int device, struct snd_pcm ** rpcm) 1171 { 1172 struct snd_pcm *pcm; 1173 int err; 1174 1175 if (rpcm) 1176 *rpcm = NULL; 1177 if ((err = snd_pcm_new(chip->card, "YMFPCI - IEC958", device, 1, 0, &pcm)) < 0) 1178 return err; 1179 pcm->private_data = chip; 1180 1181 snd_pcm_set_ops(pcm, SNDRV_PCM_STREAM_PLAYBACK, &snd_ymfpci_playback_spdif_ops); 1182 1183 /* global setup */ 1184 pcm->info_flags = 0; 1185 strcpy(pcm->name, "YMFPCI - IEC958"); 1186 chip->pcm_spdif = pcm; 1187 1188 snd_pcm_lib_preallocate_pages_for_all(pcm, SNDRV_DMA_TYPE_DEV, 1189 snd_dma_pci_data(chip->pci), 64*1024, 256*1024); 1190 1191 if (rpcm) 1192 *rpcm = pcm; 1193 return 0; 1194 } 1195 1196 static struct snd_pcm_ops snd_ymfpci_playback_4ch_ops = { 1197 .open = snd_ymfpci_playback_4ch_open, 1198 .close = snd_ymfpci_playback_4ch_close, 1199 .ioctl = snd_pcm_lib_ioctl, 1200 .hw_params = snd_ymfpci_playback_hw_params, 1201 .hw_free = snd_ymfpci_playback_hw_free, 1202 .prepare = snd_ymfpci_playback_prepare, 1203 .trigger = snd_ymfpci_playback_trigger, 1204 .pointer = snd_ymfpci_playback_pointer, 1205 }; 1206 1207 int __devinit snd_ymfpci_pcm_4ch(struct snd_ymfpci *chip, int device, struct snd_pcm ** rpcm) 1208 { 1209 struct snd_pcm *pcm; 1210 int err; 1211 1212 if (rpcm) 1213 *rpcm = NULL; 1214 if ((err = snd_pcm_new(chip->card, "YMFPCI - Rear", device, 1, 0, &pcm)) < 0) 1215 return err; 1216 pcm->private_data = chip; 1217 1218 snd_pcm_set_ops(pcm, SNDRV_PCM_STREAM_PLAYBACK, &snd_ymfpci_playback_4ch_ops); 1219 1220 /* global setup */ 1221 pcm->info_flags = 0; 1222 strcpy(pcm->name, "YMFPCI - Rear PCM"); 1223 chip->pcm_4ch = pcm; 1224 1225 snd_pcm_lib_preallocate_pages_for_all(pcm, SNDRV_DMA_TYPE_DEV, 1226 snd_dma_pci_data(chip->pci), 64*1024, 256*1024); 1227 1228 if (rpcm) 1229 *rpcm = pcm; 1230 return 0; 1231 } 1232 1233 static int snd_ymfpci_spdif_default_info(struct snd_kcontrol *kcontrol, struct snd_ctl_elem_info *uinfo) 1234 { 1235 uinfo->type = SNDRV_CTL_ELEM_TYPE_IEC958; 1236 uinfo->count = 1; 1237 return 0; 1238 } 1239 1240 static int snd_ymfpci_spdif_default_get(struct snd_kcontrol *kcontrol, 1241 struct snd_ctl_elem_value *ucontrol) 1242 { 1243 struct snd_ymfpci *chip = snd_kcontrol_chip(kcontrol); 1244 1245 spin_lock_irq(&chip->reg_lock); 1246 ucontrol->value.iec958.status[0] = (chip->spdif_bits >> 0) & 0xff; 1247 ucontrol->value.iec958.status[1] = (chip->spdif_bits >> 8) & 0xff; 1248 ucontrol->value.iec958.status[3] = IEC958_AES3_CON_FS_48000; 1249 spin_unlock_irq(&chip->reg_lock); 1250 return 0; 1251 } 1252 1253 static int snd_ymfpci_spdif_default_put(struct snd_kcontrol *kcontrol, 1254 struct snd_ctl_elem_value *ucontrol) 1255 { 1256 struct snd_ymfpci *chip = snd_kcontrol_chip(kcontrol); 1257 unsigned int val; 1258 int change; 1259 1260 val = ((ucontrol->value.iec958.status[0] & 0x3e) << 0) | 1261 (ucontrol->value.iec958.status[1] << 8); 1262 spin_lock_irq(&chip->reg_lock); 1263 change = chip->spdif_bits != val; 1264 chip->spdif_bits = val; 1265 if ((snd_ymfpci_readw(chip, YDSXGR_SPDIFOUTCTRL) & 1) && chip->pcm_spdif == NULL) 1266 snd_ymfpci_writew(chip, YDSXGR_SPDIFOUTSTATUS, chip->spdif_bits); 1267 spin_unlock_irq(&chip->reg_lock); 1268 return change; 1269 } 1270 1271 static struct snd_kcontrol_new snd_ymfpci_spdif_default __devinitdata = 1272 { 1273 .iface = SNDRV_CTL_ELEM_IFACE_PCM, 1274 .name = SNDRV_CTL_NAME_IEC958("",PLAYBACK,DEFAULT), 1275 .info = snd_ymfpci_spdif_default_info, 1276 .get = snd_ymfpci_spdif_default_get, 1277 .put = snd_ymfpci_spdif_default_put 1278 }; 1279 1280 static int snd_ymfpci_spdif_mask_info(struct snd_kcontrol *kcontrol, struct snd_ctl_elem_info *uinfo) 1281 { 1282 uinfo->type = SNDRV_CTL_ELEM_TYPE_IEC958; 1283 uinfo->count = 1; 1284 return 0; 1285 } 1286 1287 static int snd_ymfpci_spdif_mask_get(struct snd_kcontrol *kcontrol, 1288 struct snd_ctl_elem_value *ucontrol) 1289 { 1290 struct snd_ymfpci *chip = snd_kcontrol_chip(kcontrol); 1291 1292 spin_lock_irq(&chip->reg_lock); 1293 ucontrol->value.iec958.status[0] = 0x3e; 1294 ucontrol->value.iec958.status[1] = 0xff; 1295 spin_unlock_irq(&chip->reg_lock); 1296 return 0; 1297 } 1298 1299 static struct snd_kcontrol_new snd_ymfpci_spdif_mask __devinitdata = 1300 { 1301 .access = SNDRV_CTL_ELEM_ACCESS_READ, 1302 .iface = SNDRV_CTL_ELEM_IFACE_PCM, 1303 .name = SNDRV_CTL_NAME_IEC958("",PLAYBACK,CON_MASK), 1304 .info = snd_ymfpci_spdif_mask_info, 1305 .get = snd_ymfpci_spdif_mask_get, 1306 }; 1307 1308 static int snd_ymfpci_spdif_stream_info(struct snd_kcontrol *kcontrol, struct snd_ctl_elem_info *uinfo) 1309 { 1310 uinfo->type = SNDRV_CTL_ELEM_TYPE_IEC958; 1311 uinfo->count = 1; 1312 return 0; 1313 } 1314 1315 static int snd_ymfpci_spdif_stream_get(struct snd_kcontrol *kcontrol, 1316 struct snd_ctl_elem_value *ucontrol) 1317 { 1318 struct snd_ymfpci *chip = snd_kcontrol_chip(kcontrol); 1319 1320 spin_lock_irq(&chip->reg_lock); 1321 ucontrol->value.iec958.status[0] = (chip->spdif_pcm_bits >> 0) & 0xff; 1322 ucontrol->value.iec958.status[1] = (chip->spdif_pcm_bits >> 8) & 0xff; 1323 ucontrol->value.iec958.status[3] = IEC958_AES3_CON_FS_48000; 1324 spin_unlock_irq(&chip->reg_lock); 1325 return 0; 1326 } 1327 1328 static int snd_ymfpci_spdif_stream_put(struct snd_kcontrol *kcontrol, 1329 struct snd_ctl_elem_value *ucontrol) 1330 { 1331 struct snd_ymfpci *chip = snd_kcontrol_chip(kcontrol); 1332 unsigned int val; 1333 int change; 1334 1335 val = ((ucontrol->value.iec958.status[0] & 0x3e) << 0) | 1336 (ucontrol->value.iec958.status[1] << 8); 1337 spin_lock_irq(&chip->reg_lock); 1338 change = chip->spdif_pcm_bits != val; 1339 chip->spdif_pcm_bits = val; 1340 if ((snd_ymfpci_readw(chip, YDSXGR_SPDIFOUTCTRL) & 2)) 1341 snd_ymfpci_writew(chip, YDSXGR_SPDIFOUTSTATUS, chip->spdif_pcm_bits); 1342 spin_unlock_irq(&chip->reg_lock); 1343 return change; 1344 } 1345 1346 static struct snd_kcontrol_new snd_ymfpci_spdif_stream __devinitdata = 1347 { 1348 .access = SNDRV_CTL_ELEM_ACCESS_READWRITE | SNDRV_CTL_ELEM_ACCESS_INACTIVE, 1349 .iface = SNDRV_CTL_ELEM_IFACE_PCM, 1350 .name = SNDRV_CTL_NAME_IEC958("",PLAYBACK,PCM_STREAM), 1351 .info = snd_ymfpci_spdif_stream_info, 1352 .get = snd_ymfpci_spdif_stream_get, 1353 .put = snd_ymfpci_spdif_stream_put 1354 }; 1355 1356 static int snd_ymfpci_drec_source_info(struct snd_kcontrol *kcontrol, struct snd_ctl_elem_info *info) 1357 { 1358 static char *texts[3] = {"AC'97", "IEC958", "ZV Port"}; 1359 1360 info->type = SNDRV_CTL_ELEM_TYPE_ENUMERATED; 1361 info->count = 1; 1362 info->value.enumerated.items = 3; 1363 if (info->value.enumerated.item > 2) 1364 info->value.enumerated.item = 2; 1365 strcpy(info->value.enumerated.name, texts[info->value.enumerated.item]); 1366 return 0; 1367 } 1368 1369 static int snd_ymfpci_drec_source_get(struct snd_kcontrol *kcontrol, struct snd_ctl_elem_value *value) 1370 { 1371 struct snd_ymfpci *chip = snd_kcontrol_chip(kcontrol); 1372 u16 reg; 1373 1374 spin_lock_irq(&chip->reg_lock); 1375 reg = snd_ymfpci_readw(chip, YDSXGR_GLOBALCTRL); 1376 spin_unlock_irq(&chip->reg_lock); 1377 if (!(reg & 0x100)) 1378 value->value.enumerated.item[0] = 0; 1379 else 1380 value->value.enumerated.item[0] = 1 + ((reg & 0x200) != 0); 1381 return 0; 1382 } 1383 1384 static int snd_ymfpci_drec_source_put(struct snd_kcontrol *kcontrol, struct snd_ctl_elem_value *value) 1385 { 1386 struct snd_ymfpci *chip = snd_kcontrol_chip(kcontrol); 1387 u16 reg, old_reg; 1388 1389 spin_lock_irq(&chip->reg_lock); 1390 old_reg = snd_ymfpci_readw(chip, YDSXGR_GLOBALCTRL); 1391 if (value->value.enumerated.item[0] == 0) 1392 reg = old_reg & ~0x100; 1393 else 1394 reg = (old_reg & ~0x300) | 0x100 | ((value->value.enumerated.item[0] == 2) << 9); 1395 snd_ymfpci_writew(chip, YDSXGR_GLOBALCTRL, reg); 1396 spin_unlock_irq(&chip->reg_lock); 1397 return reg != old_reg; 1398 } 1399 1400 static struct snd_kcontrol_new snd_ymfpci_drec_source __devinitdata = { 1401 .access = SNDRV_CTL_ELEM_ACCESS_READWRITE, 1402 .iface = SNDRV_CTL_ELEM_IFACE_MIXER, 1403 .name = "Direct Recording Source", 1404 .info = snd_ymfpci_drec_source_info, 1405 .get = snd_ymfpci_drec_source_get, 1406 .put = snd_ymfpci_drec_source_put 1407 }; 1408 1409 /* 1410 * Mixer controls 1411 */ 1412 1413 #define YMFPCI_SINGLE(xname, xindex, reg, shift) \ 1414 { .iface = SNDRV_CTL_ELEM_IFACE_MIXER, .name = xname, .index = xindex, \ 1415 .info = snd_ymfpci_info_single, \ 1416 .get = snd_ymfpci_get_single, .put = snd_ymfpci_put_single, \ 1417 .private_value = ((reg) | ((shift) << 16)) } 1418 1419 static int snd_ymfpci_info_single(struct snd_kcontrol *kcontrol, 1420 struct snd_ctl_elem_info *uinfo) 1421 { 1422 int reg = kcontrol->private_value & 0xffff; 1423 1424 switch (reg) { 1425 case YDSXGR_SPDIFOUTCTRL: break; 1426 case YDSXGR_SPDIFINCTRL: break; 1427 default: return -EINVAL; 1428 } 1429 uinfo->type = SNDRV_CTL_ELEM_TYPE_BOOLEAN; 1430 uinfo->count = 1; 1431 uinfo->value.integer.min = 0; 1432 uinfo->value.integer.max = 1; 1433 return 0; 1434 } 1435 1436 static int snd_ymfpci_get_single(struct snd_kcontrol *kcontrol, 1437 struct snd_ctl_elem_value *ucontrol) 1438 { 1439 struct snd_ymfpci *chip = snd_kcontrol_chip(kcontrol); 1440 int reg = kcontrol->private_value & 0xffff; 1441 unsigned int shift = (kcontrol->private_value >> 16) & 0xff; 1442 unsigned int mask = 1; 1443 1444 switch (reg) { 1445 case YDSXGR_SPDIFOUTCTRL: break; 1446 case YDSXGR_SPDIFINCTRL: break; 1447 default: return -EINVAL; 1448 } 1449 ucontrol->value.integer.value[0] = 1450 (snd_ymfpci_readl(chip, reg) >> shift) & mask; 1451 return 0; 1452 } 1453 1454 static int snd_ymfpci_put_single(struct snd_kcontrol *kcontrol, 1455 struct snd_ctl_elem_value *ucontrol) 1456 { 1457 struct snd_ymfpci *chip = snd_kcontrol_chip(kcontrol); 1458 int reg = kcontrol->private_value & 0xffff; 1459 unsigned int shift = (kcontrol->private_value >> 16) & 0xff; 1460 unsigned int mask = 1; 1461 int change; 1462 unsigned int val, oval; 1463 1464 switch (reg) { 1465 case YDSXGR_SPDIFOUTCTRL: break; 1466 case YDSXGR_SPDIFINCTRL: break; 1467 default: return -EINVAL; 1468 } 1469 val = (ucontrol->value.integer.value[0] & mask); 1470 val <<= shift; 1471 spin_lock_irq(&chip->reg_lock); 1472 oval = snd_ymfpci_readl(chip, reg); 1473 val = (oval & ~(mask << shift)) | val; 1474 change = val != oval; 1475 snd_ymfpci_writel(chip, reg, val); 1476 spin_unlock_irq(&chip->reg_lock); 1477 return change; 1478 } 1479 1480 #define YMFPCI_DOUBLE(xname, xindex, reg) \ 1481 { .iface = SNDRV_CTL_ELEM_IFACE_MIXER, .name = xname, .index = xindex, \ 1482 .info = snd_ymfpci_info_double, \ 1483 .get = snd_ymfpci_get_double, .put = snd_ymfpci_put_double, \ 1484 .private_value = reg } 1485 1486 static int snd_ymfpci_info_double(struct snd_kcontrol *kcontrol, struct snd_ctl_elem_info *uinfo) 1487 { 1488 unsigned int reg = kcontrol->private_value; 1489 1490 if (reg < 0x80 || reg >= 0xc0) 1491 return -EINVAL; 1492 uinfo->type = SNDRV_CTL_ELEM_TYPE_INTEGER; 1493 uinfo->count = 2; 1494 uinfo->value.integer.min = 0; 1495 uinfo->value.integer.max = 16383; 1496 return 0; 1497 } 1498 1499 static int snd_ymfpci_get_double(struct snd_kcontrol *kcontrol, struct snd_ctl_elem_value *ucontrol) 1500 { 1501 struct snd_ymfpci *chip = snd_kcontrol_chip(kcontrol); 1502 unsigned int reg = kcontrol->private_value; 1503 unsigned int shift_left = 0, shift_right = 16, mask = 16383; 1504 unsigned int val; 1505 1506 if (reg < 0x80 || reg >= 0xc0) 1507 return -EINVAL; 1508 spin_lock_irq(&chip->reg_lock); 1509 val = snd_ymfpci_readl(chip, reg); 1510 spin_unlock_irq(&chip->reg_lock); 1511 ucontrol->value.integer.value[0] = (val >> shift_left) & mask; 1512 ucontrol->value.integer.value[1] = (val >> shift_right) & mask; 1513 return 0; 1514 } 1515 1516 static int snd_ymfpci_put_double(struct snd_kcontrol *kcontrol, struct snd_ctl_elem_value *ucontrol) 1517 { 1518 struct snd_ymfpci *chip = snd_kcontrol_chip(kcontrol); 1519 unsigned int reg = kcontrol->private_value; 1520 unsigned int shift_left = 0, shift_right = 16, mask = 16383; 1521 int change; 1522 unsigned int val1, val2, oval; 1523 1524 if (reg < 0x80 || reg >= 0xc0) 1525 return -EINVAL; 1526 val1 = ucontrol->value.integer.value[0] & mask; 1527 val2 = ucontrol->value.integer.value[1] & mask; 1528 val1 <<= shift_left; 1529 val2 <<= shift_right; 1530 spin_lock_irq(&chip->reg_lock); 1531 oval = snd_ymfpci_readl(chip, reg); 1532 val1 = (oval & ~((mask << shift_left) | (mask << shift_right))) | val1 | val2; 1533 change = val1 != oval; 1534 snd_ymfpci_writel(chip, reg, val1); 1535 spin_unlock_irq(&chip->reg_lock); 1536 return change; 1537 } 1538 1539 /* 1540 * 4ch duplication 1541 */ 1542 static int snd_ymfpci_info_dup4ch(struct snd_kcontrol *kcontrol, struct snd_ctl_elem_info *uinfo) 1543 { 1544 uinfo->type = SNDRV_CTL_ELEM_TYPE_BOOLEAN; 1545 uinfo->count = 1; 1546 uinfo->value.integer.min = 0; 1547 uinfo->value.integer.max = 1; 1548 return 0; 1549 } 1550 1551 static int snd_ymfpci_get_dup4ch(struct snd_kcontrol *kcontrol, struct snd_ctl_elem_value *ucontrol) 1552 { 1553 struct snd_ymfpci *chip = snd_kcontrol_chip(kcontrol); 1554 ucontrol->value.integer.value[0] = chip->mode_dup4ch; 1555 return 0; 1556 } 1557 1558 static int snd_ymfpci_put_dup4ch(struct snd_kcontrol *kcontrol, struct snd_ctl_elem_value *ucontrol) 1559 { 1560 struct snd_ymfpci *chip = snd_kcontrol_chip(kcontrol); 1561 int change; 1562 change = (ucontrol->value.integer.value[0] != chip->mode_dup4ch); 1563 if (change) 1564 chip->mode_dup4ch = !!ucontrol->value.integer.value[0]; 1565 return change; 1566 } 1567 1568 1569 static struct snd_kcontrol_new snd_ymfpci_controls[] __devinitdata = { 1570 YMFPCI_DOUBLE("Wave Playback Volume", 0, YDSXGR_NATIVEDACOUTVOL), 1571 YMFPCI_DOUBLE("Wave Capture Volume", 0, YDSXGR_NATIVEDACLOOPVOL), 1572 YMFPCI_DOUBLE("Digital Capture Volume", 0, YDSXGR_NATIVEDACINVOL), 1573 YMFPCI_DOUBLE("Digital Capture Volume", 1, YDSXGR_NATIVEADCINVOL), 1574 YMFPCI_DOUBLE("ADC Playback Volume", 0, YDSXGR_PRIADCOUTVOL), 1575 YMFPCI_DOUBLE("ADC Capture Volume", 0, YDSXGR_PRIADCLOOPVOL), 1576 YMFPCI_DOUBLE("ADC Playback Volume", 1, YDSXGR_SECADCOUTVOL), 1577 YMFPCI_DOUBLE("ADC Capture Volume", 1, YDSXGR_SECADCLOOPVOL), 1578 YMFPCI_DOUBLE("FM Legacy Volume", 0, YDSXGR_LEGACYOUTVOL), 1579 YMFPCI_DOUBLE(SNDRV_CTL_NAME_IEC958("AC97 ", PLAYBACK,VOLUME), 0, YDSXGR_ZVOUTVOL), 1580 YMFPCI_DOUBLE(SNDRV_CTL_NAME_IEC958("", CAPTURE,VOLUME), 0, YDSXGR_ZVLOOPVOL), 1581 YMFPCI_DOUBLE(SNDRV_CTL_NAME_IEC958("AC97 ",PLAYBACK,VOLUME), 1, YDSXGR_SPDIFOUTVOL), 1582 YMFPCI_DOUBLE(SNDRV_CTL_NAME_IEC958("",CAPTURE,VOLUME), 1, YDSXGR_SPDIFLOOPVOL), 1583 YMFPCI_SINGLE(SNDRV_CTL_NAME_IEC958("",PLAYBACK,SWITCH), 0, YDSXGR_SPDIFOUTCTRL, 0), 1584 YMFPCI_SINGLE(SNDRV_CTL_NAME_IEC958("",CAPTURE,SWITCH), 0, YDSXGR_SPDIFINCTRL, 0), 1585 YMFPCI_SINGLE(SNDRV_CTL_NAME_IEC958("Loop",NONE,NONE), 0, YDSXGR_SPDIFINCTRL, 4), 1586 { 1587 .iface = SNDRV_CTL_ELEM_IFACE_MIXER, 1588 .name = "4ch Duplication", 1589 .info = snd_ymfpci_info_dup4ch, 1590 .get = snd_ymfpci_get_dup4ch, 1591 .put = snd_ymfpci_put_dup4ch, 1592 }, 1593 }; 1594 1595 1596 /* 1597 * GPIO 1598 */ 1599 1600 static int snd_ymfpci_get_gpio_out(struct snd_ymfpci *chip, int pin) 1601 { 1602 u16 reg, mode; 1603 unsigned long flags; 1604 1605 spin_lock_irqsave(&chip->reg_lock, flags); 1606 reg = snd_ymfpci_readw(chip, YDSXGR_GPIOFUNCENABLE); 1607 reg &= ~(1 << (pin + 8)); 1608 reg |= (1 << pin); 1609 snd_ymfpci_writew(chip, YDSXGR_GPIOFUNCENABLE, reg); 1610 /* set the level mode for input line */ 1611 mode = snd_ymfpci_readw(chip, YDSXGR_GPIOTYPECONFIG); 1612 mode &= ~(3 << (pin * 2)); 1613 snd_ymfpci_writew(chip, YDSXGR_GPIOTYPECONFIG, mode); 1614 snd_ymfpci_writew(chip, YDSXGR_GPIOFUNCENABLE, reg | (1 << (pin + 8))); 1615 mode = snd_ymfpci_readw(chip, YDSXGR_GPIOINSTATUS); 1616 spin_unlock_irqrestore(&chip->reg_lock, flags); 1617 return (mode >> pin) & 1; 1618 } 1619 1620 static int snd_ymfpci_set_gpio_out(struct snd_ymfpci *chip, int pin, int enable) 1621 { 1622 u16 reg; 1623 unsigned long flags; 1624 1625 spin_lock_irqsave(&chip->reg_lock, flags); 1626 reg = snd_ymfpci_readw(chip, YDSXGR_GPIOFUNCENABLE); 1627 reg &= ~(1 << pin); 1628 reg &= ~(1 << (pin + 8)); 1629 snd_ymfpci_writew(chip, YDSXGR_GPIOFUNCENABLE, reg); 1630 snd_ymfpci_writew(chip, YDSXGR_GPIOOUTCTRL, enable << pin); 1631 snd_ymfpci_writew(chip, YDSXGR_GPIOFUNCENABLE, reg | (1 << (pin + 8))); 1632 spin_unlock_irqrestore(&chip->reg_lock, flags); 1633 1634 return 0; 1635 } 1636 1637 static int snd_ymfpci_gpio_sw_info(struct snd_kcontrol *kcontrol, struct snd_ctl_elem_info *uinfo) 1638 { 1639 uinfo->type = SNDRV_CTL_ELEM_TYPE_BOOLEAN; 1640 uinfo->count = 1; 1641 uinfo->value.integer.min = 0; 1642 uinfo->value.integer.max = 1; 1643 return 0; 1644 } 1645 1646 static int snd_ymfpci_gpio_sw_get(struct snd_kcontrol *kcontrol, struct snd_ctl_elem_value *ucontrol) 1647 { 1648 struct snd_ymfpci *chip = snd_kcontrol_chip(kcontrol); 1649 int pin = (int)kcontrol->private_value; 1650 ucontrol->value.integer.value[0] = snd_ymfpci_get_gpio_out(chip, pin); 1651 return 0; 1652 } 1653 1654 static int snd_ymfpci_gpio_sw_put(struct snd_kcontrol *kcontrol, struct snd_ctl_elem_value *ucontrol) 1655 { 1656 struct snd_ymfpci *chip = snd_kcontrol_chip(kcontrol); 1657 int pin = (int)kcontrol->private_value; 1658 1659 if (snd_ymfpci_get_gpio_out(chip, pin) != ucontrol->value.integer.value[0]) { 1660 snd_ymfpci_set_gpio_out(chip, pin, !!ucontrol->value.integer.value[0]); 1661 ucontrol->value.integer.value[0] = snd_ymfpci_get_gpio_out(chip, pin); 1662 return 1; 1663 } 1664 return 0; 1665 } 1666 1667 static struct snd_kcontrol_new snd_ymfpci_rear_shared __devinitdata = { 1668 .name = "Shared Rear/Line-In Switch", 1669 .iface = SNDRV_CTL_ELEM_IFACE_MIXER, 1670 .info = snd_ymfpci_gpio_sw_info, 1671 .get = snd_ymfpci_gpio_sw_get, 1672 .put = snd_ymfpci_gpio_sw_put, 1673 .private_value = 2, 1674 }; 1675 1676 /* 1677 * PCM voice volume 1678 */ 1679 1680 static int snd_ymfpci_pcm_vol_info(struct snd_kcontrol *kcontrol, 1681 struct snd_ctl_elem_info *uinfo) 1682 { 1683 uinfo->type = SNDRV_CTL_ELEM_TYPE_INTEGER; 1684 uinfo->count = 2; 1685 uinfo->value.integer.min = 0; 1686 uinfo->value.integer.max = 0x8000; 1687 return 0; 1688 } 1689 1690 static int snd_ymfpci_pcm_vol_get(struct snd_kcontrol *kcontrol, 1691 struct snd_ctl_elem_value *ucontrol) 1692 { 1693 struct snd_ymfpci *chip = snd_kcontrol_chip(kcontrol); 1694 unsigned int subs = kcontrol->id.subdevice; 1695 1696 ucontrol->value.integer.value[0] = chip->pcm_mixer[subs].left; 1697 ucontrol->value.integer.value[1] = chip->pcm_mixer[subs].right; 1698 return 0; 1699 } 1700 1701 static int snd_ymfpci_pcm_vol_put(struct snd_kcontrol *kcontrol, 1702 struct snd_ctl_elem_value *ucontrol) 1703 { 1704 struct snd_ymfpci *chip = snd_kcontrol_chip(kcontrol); 1705 unsigned int subs = kcontrol->id.subdevice; 1706 struct snd_pcm_substream *substream; 1707 unsigned long flags; 1708 1709 if (ucontrol->value.integer.value[0] != chip->pcm_mixer[subs].left || 1710 ucontrol->value.integer.value[1] != chip->pcm_mixer[subs].right) { 1711 chip->pcm_mixer[subs].left = ucontrol->value.integer.value[0]; 1712 chip->pcm_mixer[subs].right = ucontrol->value.integer.value[1]; 1713 1714 substream = (struct snd_pcm_substream *)kcontrol->private_value; 1715 spin_lock_irqsave(&chip->voice_lock, flags); 1716 if (substream->runtime && substream->runtime->private_data) { 1717 struct snd_ymfpci_pcm *ypcm = substream->runtime->private_data; 1718 ypcm->update_pcm_vol = 2; 1719 } 1720 spin_unlock_irqrestore(&chip->voice_lock, flags); 1721 return 1; 1722 } 1723 return 0; 1724 } 1725 1726 static struct snd_kcontrol_new snd_ymfpci_pcm_volume __devinitdata = { 1727 .iface = SNDRV_CTL_ELEM_IFACE_PCM, 1728 .name = "PCM Playback Volume", 1729 .access = SNDRV_CTL_ELEM_ACCESS_READWRITE | 1730 SNDRV_CTL_ELEM_ACCESS_INACTIVE, 1731 .info = snd_ymfpci_pcm_vol_info, 1732 .get = snd_ymfpci_pcm_vol_get, 1733 .put = snd_ymfpci_pcm_vol_put, 1734 }; 1735 1736 1737 /* 1738 * Mixer routines 1739 */ 1740 1741 static void snd_ymfpci_mixer_free_ac97_bus(struct snd_ac97_bus *bus) 1742 { 1743 struct snd_ymfpci *chip = bus->private_data; 1744 chip->ac97_bus = NULL; 1745 } 1746 1747 static void snd_ymfpci_mixer_free_ac97(struct snd_ac97 *ac97) 1748 { 1749 struct snd_ymfpci *chip = ac97->private_data; 1750 chip->ac97 = NULL; 1751 } 1752 1753 int __devinit snd_ymfpci_mixer(struct snd_ymfpci *chip, int rear_switch, int rear_swap) 1754 { 1755 struct snd_ac97_template ac97; 1756 struct snd_kcontrol *kctl; 1757 struct snd_pcm_substream *substream; 1758 unsigned int idx; 1759 int err; 1760 static struct snd_ac97_bus_ops ops = { 1761 .write = snd_ymfpci_codec_write, 1762 .read = snd_ymfpci_codec_read, 1763 }; 1764 1765 chip->rear_swap = rear_swap; 1766 if ((err = snd_ac97_bus(chip->card, 0, &ops, chip, &chip->ac97_bus)) < 0) 1767 return err; 1768 chip->ac97_bus->private_free = snd_ymfpci_mixer_free_ac97_bus; 1769 chip->ac97_bus->no_vra = 1; /* YMFPCI doesn't need VRA */ 1770 1771 memset(&ac97, 0, sizeof(ac97)); 1772 ac97.private_data = chip; 1773 ac97.private_free = snd_ymfpci_mixer_free_ac97; 1774 if ((err = snd_ac97_mixer(chip->ac97_bus, &ac97, &chip->ac97)) < 0) 1775 return err; 1776 1777 /* to be sure */ 1778 snd_ac97_update_bits(chip->ac97, AC97_EXTENDED_STATUS, 1779 AC97_EA_VRA|AC97_EA_VRM, 0); 1780 1781 for (idx = 0; idx < ARRAY_SIZE(snd_ymfpci_controls); idx++) { 1782 if ((err = snd_ctl_add(chip->card, snd_ctl_new1(&snd_ymfpci_controls[idx], chip))) < 0) 1783 return err; 1784 } 1785 1786 /* add S/PDIF control */ 1787 snd_assert(chip->pcm_spdif != NULL, return -EIO); 1788 if ((err = snd_ctl_add(chip->card, kctl = snd_ctl_new1(&snd_ymfpci_spdif_default, chip))) < 0) 1789 return err; 1790 kctl->id.device = chip->pcm_spdif->device; 1791 if ((err = snd_ctl_add(chip->card, kctl = snd_ctl_new1(&snd_ymfpci_spdif_mask, chip))) < 0) 1792 return err; 1793 kctl->id.device = chip->pcm_spdif->device; 1794 if ((err = snd_ctl_add(chip->card, kctl = snd_ctl_new1(&snd_ymfpci_spdif_stream, chip))) < 0) 1795 return err; 1796 kctl->id.device = chip->pcm_spdif->device; 1797 chip->spdif_pcm_ctl = kctl; 1798 1799 /* direct recording source */ 1800 if (chip->device_id == PCI_DEVICE_ID_YAMAHA_754 && 1801 (err = snd_ctl_add(chip->card, kctl = snd_ctl_new1(&snd_ymfpci_drec_source, chip))) < 0) 1802 return err; 1803 1804 /* 1805 * shared rear/line-in 1806 */ 1807 if (rear_switch) { 1808 if ((err = snd_ctl_add(chip->card, snd_ctl_new1(&snd_ymfpci_rear_shared, chip))) < 0) 1809 return err; 1810 } 1811 1812 /* per-voice volume */ 1813 substream = chip->pcm->streams[SNDRV_PCM_STREAM_PLAYBACK].substream; 1814 for (idx = 0; idx < 32; ++idx) { 1815 kctl = snd_ctl_new1(&snd_ymfpci_pcm_volume, chip); 1816 if (!kctl) 1817 return -ENOMEM; 1818 kctl->id.device = chip->pcm->device; 1819 kctl->id.subdevice = idx; 1820 kctl->private_value = (unsigned long)substream; 1821 if ((err = snd_ctl_add(chip->card, kctl)) < 0) 1822 return err; 1823 chip->pcm_mixer[idx].left = 0x8000; 1824 chip->pcm_mixer[idx].right = 0x8000; 1825 chip->pcm_mixer[idx].ctl = kctl; 1826 substream = substream->next; 1827 } 1828 1829 return 0; 1830 } 1831 1832 1833 /* 1834 * timer 1835 */ 1836 1837 static int snd_ymfpci_timer_start(struct snd_timer *timer) 1838 { 1839 struct snd_ymfpci *chip; 1840 unsigned long flags; 1841 unsigned int count; 1842 1843 chip = snd_timer_chip(timer); 1844 count = (timer->sticks << 1) - 1; 1845 spin_lock_irqsave(&chip->reg_lock, flags); 1846 snd_ymfpci_writew(chip, YDSXGR_TIMERCOUNT, count); 1847 snd_ymfpci_writeb(chip, YDSXGR_TIMERCTRL, 0x03); 1848 spin_unlock_irqrestore(&chip->reg_lock, flags); 1849 return 0; 1850 } 1851 1852 static int snd_ymfpci_timer_stop(struct snd_timer *timer) 1853 { 1854 struct snd_ymfpci *chip; 1855 unsigned long flags; 1856 1857 chip = snd_timer_chip(timer); 1858 spin_lock_irqsave(&chip->reg_lock, flags); 1859 snd_ymfpci_writeb(chip, YDSXGR_TIMERCTRL, 0x00); 1860 spin_unlock_irqrestore(&chip->reg_lock, flags); 1861 return 0; 1862 } 1863 1864 static int snd_ymfpci_timer_precise_resolution(struct snd_timer *timer, 1865 unsigned long *num, unsigned long *den) 1866 { 1867 *num = 1; 1868 *den = 48000; 1869 return 0; 1870 } 1871 1872 static struct snd_timer_hardware snd_ymfpci_timer_hw = { 1873 .flags = SNDRV_TIMER_HW_AUTO, 1874 .resolution = 20833, /* 1/fs = 20.8333...us */ 1875 .ticks = 0x8000, 1876 .start = snd_ymfpci_timer_start, 1877 .stop = snd_ymfpci_timer_stop, 1878 .precise_resolution = snd_ymfpci_timer_precise_resolution, 1879 }; 1880 1881 int __devinit snd_ymfpci_timer(struct snd_ymfpci *chip, int device) 1882 { 1883 struct snd_timer *timer = NULL; 1884 struct snd_timer_id tid; 1885 int err; 1886 1887 tid.dev_class = SNDRV_TIMER_CLASS_CARD; 1888 tid.dev_sclass = SNDRV_TIMER_SCLASS_NONE; 1889 tid.card = chip->card->number; 1890 tid.device = device; 1891 tid.subdevice = 0; 1892 if ((err = snd_timer_new(chip->card, "YMFPCI", &tid, &timer)) >= 0) { 1893 strcpy(timer->name, "YMFPCI timer"); 1894 timer->private_data = chip; 1895 timer->hw = snd_ymfpci_timer_hw; 1896 } 1897 chip->timer = timer; 1898 return err; 1899 } 1900 1901 1902 /* 1903 * proc interface 1904 */ 1905 1906 static void snd_ymfpci_proc_read(struct snd_info_entry *entry, 1907 struct snd_info_buffer *buffer) 1908 { 1909 struct snd_ymfpci *chip = entry->private_data; 1910 int i; 1911 1912 snd_iprintf(buffer, "YMFPCI\n\n"); 1913 for (i = 0; i <= YDSXGR_WORKBASE; i += 4) 1914 snd_iprintf(buffer, "%04x: %04x\n", i, snd_ymfpci_readl(chip, i)); 1915 } 1916 1917 static int __devinit snd_ymfpci_proc_init(struct snd_card *card, struct snd_ymfpci *chip) 1918 { 1919 struct snd_info_entry *entry; 1920 1921 if (! snd_card_proc_new(card, "ymfpci", &entry)) 1922 snd_info_set_text_ops(entry, chip, snd_ymfpci_proc_read); 1923 return 0; 1924 } 1925 1926 /* 1927 * initialization routines 1928 */ 1929 1930 static void snd_ymfpci_aclink_reset(struct pci_dev * pci) 1931 { 1932 u8 cmd; 1933 1934 pci_read_config_byte(pci, PCIR_DSXG_CTRL, &cmd); 1935 #if 0 // force to reset 1936 if (cmd & 0x03) { 1937 #endif 1938 pci_write_config_byte(pci, PCIR_DSXG_CTRL, cmd & 0xfc); 1939 pci_write_config_byte(pci, PCIR_DSXG_CTRL, cmd | 0x03); 1940 pci_write_config_byte(pci, PCIR_DSXG_CTRL, cmd & 0xfc); 1941 pci_write_config_word(pci, PCIR_DSXG_PWRCTRL1, 0); 1942 pci_write_config_word(pci, PCIR_DSXG_PWRCTRL2, 0); 1943 #if 0 1944 } 1945 #endif 1946 } 1947 1948 static void snd_ymfpci_enable_dsp(struct snd_ymfpci *chip) 1949 { 1950 snd_ymfpci_writel(chip, YDSXGR_CONFIG, 0x00000001); 1951 } 1952 1953 static void snd_ymfpci_disable_dsp(struct snd_ymfpci *chip) 1954 { 1955 u32 val; 1956 int timeout = 1000; 1957 1958 val = snd_ymfpci_readl(chip, YDSXGR_CONFIG); 1959 if (val) 1960 snd_ymfpci_writel(chip, YDSXGR_CONFIG, 0x00000000); 1961 while (timeout-- > 0) { 1962 val = snd_ymfpci_readl(chip, YDSXGR_STATUS); 1963 if ((val & 0x00000002) == 0) 1964 break; 1965 } 1966 } 1967 1968 #include "ymfpci_image.h" 1969 1970 static void snd_ymfpci_download_image(struct snd_ymfpci *chip) 1971 { 1972 int i; 1973 u16 ctrl; 1974 unsigned long *inst; 1975 1976 snd_ymfpci_writel(chip, YDSXGR_NATIVEDACOUTVOL, 0x00000000); 1977 snd_ymfpci_disable_dsp(chip); 1978 snd_ymfpci_writel(chip, YDSXGR_MODE, 0x00010000); 1979 snd_ymfpci_writel(chip, YDSXGR_MODE, 0x00000000); 1980 snd_ymfpci_writel(chip, YDSXGR_MAPOFREC, 0x00000000); 1981 snd_ymfpci_writel(chip, YDSXGR_MAPOFEFFECT, 0x00000000); 1982 snd_ymfpci_writel(chip, YDSXGR_PLAYCTRLBASE, 0x00000000); 1983 snd_ymfpci_writel(chip, YDSXGR_RECCTRLBASE, 0x00000000); 1984 snd_ymfpci_writel(chip, YDSXGR_EFFCTRLBASE, 0x00000000); 1985 ctrl = snd_ymfpci_readw(chip, YDSXGR_GLOBALCTRL); 1986 snd_ymfpci_writew(chip, YDSXGR_GLOBALCTRL, ctrl & ~0x0007); 1987 1988 /* setup DSP instruction code */ 1989 for (i = 0; i < YDSXG_DSPLENGTH / 4; i++) 1990 snd_ymfpci_writel(chip, YDSXGR_DSPINSTRAM + (i << 2), DspInst[i]); 1991 1992 /* setup control instruction code */ 1993 switch (chip->device_id) { 1994 case PCI_DEVICE_ID_YAMAHA_724F: 1995 case PCI_DEVICE_ID_YAMAHA_740C: 1996 case PCI_DEVICE_ID_YAMAHA_744: 1997 case PCI_DEVICE_ID_YAMAHA_754: 1998 inst = CntrlInst1E; 1999 break; 2000 default: 2001 inst = CntrlInst; 2002 break; 2003 } 2004 for (i = 0; i < YDSXG_CTRLLENGTH / 4; i++) 2005 snd_ymfpci_writel(chip, YDSXGR_CTRLINSTRAM + (i << 2), inst[i]); 2006 2007 snd_ymfpci_enable_dsp(chip); 2008 } 2009 2010 static int __devinit snd_ymfpci_memalloc(struct snd_ymfpci *chip) 2011 { 2012 long size, playback_ctrl_size; 2013 int voice, bank, reg; 2014 u8 *ptr; 2015 dma_addr_t ptr_addr; 2016 2017 playback_ctrl_size = 4 + 4 * YDSXG_PLAYBACK_VOICES; 2018 chip->bank_size_playback = snd_ymfpci_readl(chip, YDSXGR_PLAYCTRLSIZE) << 2; 2019 chip->bank_size_capture = snd_ymfpci_readl(chip, YDSXGR_RECCTRLSIZE) << 2; 2020 chip->bank_size_effect = snd_ymfpci_readl(chip, YDSXGR_EFFCTRLSIZE) << 2; 2021 chip->work_size = YDSXG_DEFAULT_WORK_SIZE; 2022 2023 size = ((playback_ctrl_size + 0x00ff) & ~0x00ff) + 2024 ((chip->bank_size_playback * 2 * YDSXG_PLAYBACK_VOICES + 0x00ff) & ~0x00ff) + 2025 ((chip->bank_size_capture * 2 * YDSXG_CAPTURE_VOICES + 0x00ff) & ~0x00ff) + 2026 ((chip->bank_size_effect * 2 * YDSXG_EFFECT_VOICES + 0x00ff) & ~0x00ff) + 2027 chip->work_size; 2028 /* work_ptr must be aligned to 256 bytes, but it's already 2029 covered with the kernel page allocation mechanism */ 2030 if (snd_dma_alloc_pages(SNDRV_DMA_TYPE_DEV, snd_dma_pci_data(chip->pci), 2031 size, &chip->work_ptr) < 0) 2032 return -ENOMEM; 2033 ptr = chip->work_ptr.area; 2034 ptr_addr = chip->work_ptr.addr; 2035 memset(ptr, 0, size); /* for sure */ 2036 2037 chip->bank_base_playback = ptr; 2038 chip->bank_base_playback_addr = ptr_addr; 2039 chip->ctrl_playback = (u32 *)ptr; 2040 chip->ctrl_playback[0] = cpu_to_le32(YDSXG_PLAYBACK_VOICES); 2041 ptr += (playback_ctrl_size + 0x00ff) & ~0x00ff; 2042 ptr_addr += (playback_ctrl_size + 0x00ff) & ~0x00ff; 2043 for (voice = 0; voice < YDSXG_PLAYBACK_VOICES; voice++) { 2044 chip->voices[voice].number = voice; 2045 chip->voices[voice].bank = (struct snd_ymfpci_playback_bank *)ptr; 2046 chip->voices[voice].bank_addr = ptr_addr; 2047 for (bank = 0; bank < 2; bank++) { 2048 chip->bank_playback[voice][bank] = (struct snd_ymfpci_playback_bank *)ptr; 2049 ptr += chip->bank_size_playback; 2050 ptr_addr += chip->bank_size_playback; 2051 } 2052 } 2053 ptr = (char *)(((unsigned long)ptr + 0x00ff) & ~0x00ff); 2054 ptr_addr = (ptr_addr + 0x00ff) & ~0x00ff; 2055 chip->bank_base_capture = ptr; 2056 chip->bank_base_capture_addr = ptr_addr; 2057 for (voice = 0; voice < YDSXG_CAPTURE_VOICES; voice++) 2058 for (bank = 0; bank < 2; bank++) { 2059 chip->bank_capture[voice][bank] = (struct snd_ymfpci_capture_bank *)ptr; 2060 ptr += chip->bank_size_capture; 2061 ptr_addr += chip->bank_size_capture; 2062 } 2063 ptr = (char *)(((unsigned long)ptr + 0x00ff) & ~0x00ff); 2064 ptr_addr = (ptr_addr + 0x00ff) & ~0x00ff; 2065 chip->bank_base_effect = ptr; 2066 chip->bank_base_effect_addr = ptr_addr; 2067 for (voice = 0; voice < YDSXG_EFFECT_VOICES; voice++) 2068 for (bank = 0; bank < 2; bank++) { 2069 chip->bank_effect[voice][bank] = (struct snd_ymfpci_effect_bank *)ptr; 2070 ptr += chip->bank_size_effect; 2071 ptr_addr += chip->bank_size_effect; 2072 } 2073 ptr = (char *)(((unsigned long)ptr + 0x00ff) & ~0x00ff); 2074 ptr_addr = (ptr_addr + 0x00ff) & ~0x00ff; 2075 chip->work_base = ptr; 2076 chip->work_base_addr = ptr_addr; 2077 2078 snd_assert(ptr + chip->work_size == chip->work_ptr.area + chip->work_ptr.bytes, ); 2079 2080 snd_ymfpci_writel(chip, YDSXGR_PLAYCTRLBASE, chip->bank_base_playback_addr); 2081 snd_ymfpci_writel(chip, YDSXGR_RECCTRLBASE, chip->bank_base_capture_addr); 2082 snd_ymfpci_writel(chip, YDSXGR_EFFCTRLBASE, chip->bank_base_effect_addr); 2083 snd_ymfpci_writel(chip, YDSXGR_WORKBASE, chip->work_base_addr); 2084 snd_ymfpci_writel(chip, YDSXGR_WORKSIZE, chip->work_size >> 2); 2085 2086 /* S/PDIF output initialization */ 2087 chip->spdif_bits = chip->spdif_pcm_bits = SNDRV_PCM_DEFAULT_CON_SPDIF & 0xffff; 2088 snd_ymfpci_writew(chip, YDSXGR_SPDIFOUTCTRL, 0); 2089 snd_ymfpci_writew(chip, YDSXGR_SPDIFOUTSTATUS, chip->spdif_bits); 2090 2091 /* S/PDIF input initialization */ 2092 snd_ymfpci_writew(chip, YDSXGR_SPDIFINCTRL, 0); 2093 2094 /* digital mixer setup */ 2095 for (reg = 0x80; reg < 0xc0; reg += 4) 2096 snd_ymfpci_writel(chip, reg, 0); 2097 snd_ymfpci_writel(chip, YDSXGR_NATIVEDACOUTVOL, 0x3fff3fff); 2098 snd_ymfpci_writel(chip, YDSXGR_ZVOUTVOL, 0x3fff3fff); 2099 snd_ymfpci_writel(chip, YDSXGR_SPDIFOUTVOL, 0x3fff3fff); 2100 snd_ymfpci_writel(chip, YDSXGR_NATIVEADCINVOL, 0x3fff3fff); 2101 snd_ymfpci_writel(chip, YDSXGR_NATIVEDACINVOL, 0x3fff3fff); 2102 snd_ymfpci_writel(chip, YDSXGR_PRIADCLOOPVOL, 0x3fff3fff); 2103 snd_ymfpci_writel(chip, YDSXGR_LEGACYOUTVOL, 0x3fff3fff); 2104 2105 return 0; 2106 } 2107 2108 static int snd_ymfpci_free(struct snd_ymfpci *chip) 2109 { 2110 u16 ctrl; 2111 2112 snd_assert(chip != NULL, return -EINVAL); 2113 2114 if (chip->res_reg_area) { /* don't touch busy hardware */ 2115 snd_ymfpci_writel(chip, YDSXGR_NATIVEDACOUTVOL, 0); 2116 snd_ymfpci_writel(chip, YDSXGR_BUF441OUTVOL, 0); 2117 snd_ymfpci_writel(chip, YDSXGR_LEGACYOUTVOL, 0); 2118 snd_ymfpci_writel(chip, YDSXGR_STATUS, ~0); 2119 snd_ymfpci_disable_dsp(chip); 2120 snd_ymfpci_writel(chip, YDSXGR_PLAYCTRLBASE, 0); 2121 snd_ymfpci_writel(chip, YDSXGR_RECCTRLBASE, 0); 2122 snd_ymfpci_writel(chip, YDSXGR_EFFCTRLBASE, 0); 2123 snd_ymfpci_writel(chip, YDSXGR_WORKBASE, 0); 2124 snd_ymfpci_writel(chip, YDSXGR_WORKSIZE, 0); 2125 ctrl = snd_ymfpci_readw(chip, YDSXGR_GLOBALCTRL); 2126 snd_ymfpci_writew(chip, YDSXGR_GLOBALCTRL, ctrl & ~0x0007); 2127 } 2128 2129 snd_ymfpci_ac3_done(chip); 2130 2131 /* Set PCI device to D3 state */ 2132 #if 0 2133 /* FIXME: temporarily disabled, otherwise we cannot fire up 2134 * the chip again unless reboot. ACPI bug? 2135 */ 2136 pci_set_power_state(chip->pci, 3); 2137 #endif 2138 2139 #ifdef CONFIG_PM 2140 vfree(chip->saved_regs); 2141 #endif 2142 release_and_free_resource(chip->mpu_res); 2143 release_and_free_resource(chip->fm_res); 2144 snd_ymfpci_free_gameport(chip); 2145 if (chip->reg_area_virt) 2146 iounmap(chip->reg_area_virt); 2147 if (chip->work_ptr.area) 2148 snd_dma_free_pages(&chip->work_ptr); 2149 2150 if (chip->irq >= 0) 2151 free_irq(chip->irq, (void *)chip); 2152 release_and_free_resource(chip->res_reg_area); 2153 2154 pci_write_config_word(chip->pci, 0x40, chip->old_legacy_ctrl); 2155 2156 pci_disable_device(chip->pci); 2157 kfree(chip); 2158 return 0; 2159 } 2160 2161 static int snd_ymfpci_dev_free(struct snd_device *device) 2162 { 2163 struct snd_ymfpci *chip = device->device_data; 2164 return snd_ymfpci_free(chip); 2165 } 2166 2167 #ifdef CONFIG_PM 2168 static int saved_regs_index[] = { 2169 /* spdif */ 2170 YDSXGR_SPDIFOUTCTRL, 2171 YDSXGR_SPDIFOUTSTATUS, 2172 YDSXGR_SPDIFINCTRL, 2173 /* volumes */ 2174 YDSXGR_PRIADCLOOPVOL, 2175 YDSXGR_NATIVEDACINVOL, 2176 YDSXGR_NATIVEDACOUTVOL, 2177 // YDSXGR_BUF441OUTVOL, 2178 YDSXGR_NATIVEADCINVOL, 2179 YDSXGR_SPDIFLOOPVOL, 2180 YDSXGR_SPDIFOUTVOL, 2181 YDSXGR_ZVOUTVOL, 2182 YDSXGR_LEGACYOUTVOL, 2183 /* address bases */ 2184 YDSXGR_PLAYCTRLBASE, 2185 YDSXGR_RECCTRLBASE, 2186 YDSXGR_EFFCTRLBASE, 2187 YDSXGR_WORKBASE, 2188 /* capture set up */ 2189 YDSXGR_MAPOFREC, 2190 YDSXGR_RECFORMAT, 2191 YDSXGR_RECSLOTSR, 2192 YDSXGR_ADCFORMAT, 2193 YDSXGR_ADCSLOTSR, 2194 }; 2195 #define YDSXGR_NUM_SAVED_REGS ARRAY_SIZE(saved_regs_index) 2196 2197 int snd_ymfpci_suspend(struct pci_dev *pci, pm_message_t state) 2198 { 2199 struct snd_card *card = pci_get_drvdata(pci); 2200 struct snd_ymfpci *chip = card->private_data; 2201 unsigned int i; 2202 2203 snd_power_change_state(card, SNDRV_CTL_POWER_D3hot); 2204 snd_pcm_suspend_all(chip->pcm); 2205 snd_pcm_suspend_all(chip->pcm2); 2206 snd_pcm_suspend_all(chip->pcm_spdif); 2207 snd_pcm_suspend_all(chip->pcm_4ch); 2208 snd_ac97_suspend(chip->ac97); 2209 for (i = 0; i < YDSXGR_NUM_SAVED_REGS; i++) 2210 chip->saved_regs[i] = snd_ymfpci_readl(chip, saved_regs_index[i]); 2211 chip->saved_ydsxgr_mode = snd_ymfpci_readl(chip, YDSXGR_MODE); 2212 snd_ymfpci_writel(chip, YDSXGR_NATIVEDACOUTVOL, 0); 2213 snd_ymfpci_disable_dsp(chip); 2214 pci_disable_device(pci); 2215 pci_save_state(pci); 2216 return 0; 2217 } 2218 2219 int snd_ymfpci_resume(struct pci_dev *pci) 2220 { 2221 struct snd_card *card = pci_get_drvdata(pci); 2222 struct snd_ymfpci *chip = card->private_data; 2223 unsigned int i; 2224 2225 pci_restore_state(pci); 2226 pci_enable_device(pci); 2227 pci_set_master(pci); 2228 snd_ymfpci_aclink_reset(pci); 2229 snd_ymfpci_codec_ready(chip, 0); 2230 snd_ymfpci_download_image(chip); 2231 udelay(100); 2232 2233 for (i = 0; i < YDSXGR_NUM_SAVED_REGS; i++) 2234 snd_ymfpci_writel(chip, saved_regs_index[i], chip->saved_regs[i]); 2235 2236 snd_ac97_resume(chip->ac97); 2237 2238 /* start hw again */ 2239 if (chip->start_count > 0) { 2240 spin_lock_irq(&chip->reg_lock); 2241 snd_ymfpci_writel(chip, YDSXGR_MODE, chip->saved_ydsxgr_mode); 2242 chip->active_bank = snd_ymfpci_readl(chip, YDSXGR_CTRLSELECT); 2243 spin_unlock_irq(&chip->reg_lock); 2244 } 2245 snd_power_change_state(card, SNDRV_CTL_POWER_D0); 2246 return 0; 2247 } 2248 #endif /* CONFIG_PM */ 2249 2250 int __devinit snd_ymfpci_create(struct snd_card *card, 2251 struct pci_dev * pci, 2252 unsigned short old_legacy_ctrl, 2253 struct snd_ymfpci ** rchip) 2254 { 2255 struct snd_ymfpci *chip; 2256 int err; 2257 static struct snd_device_ops ops = { 2258 .dev_free = snd_ymfpci_dev_free, 2259 }; 2260 2261 *rchip = NULL; 2262 2263 /* enable PCI device */ 2264 if ((err = pci_enable_device(pci)) < 0) 2265 return err; 2266 2267 chip = kzalloc(sizeof(*chip), GFP_KERNEL); 2268 if (chip == NULL) { 2269 pci_disable_device(pci); 2270 return -ENOMEM; 2271 } 2272 chip->old_legacy_ctrl = old_legacy_ctrl; 2273 spin_lock_init(&chip->reg_lock); 2274 spin_lock_init(&chip->voice_lock); 2275 init_waitqueue_head(&chip->interrupt_sleep); 2276 atomic_set(&chip->interrupt_sleep_count, 0); 2277 chip->card = card; 2278 chip->pci = pci; 2279 chip->irq = -1; 2280 chip->device_id = pci->device; 2281 pci_read_config_byte(pci, PCI_REVISION_ID, (u8 *)&chip->rev); 2282 chip->reg_area_phys = pci_resource_start(pci, 0); 2283 chip->reg_area_virt = ioremap_nocache(chip->reg_area_phys, 0x8000); 2284 pci_set_master(pci); 2285 2286 if ((chip->res_reg_area = request_mem_region(chip->reg_area_phys, 0x8000, "YMFPCI")) == NULL) { 2287 snd_printk(KERN_ERR "unable to grab memory region 0x%lx-0x%lx\n", chip->reg_area_phys, chip->reg_area_phys + 0x8000 - 1); 2288 snd_ymfpci_free(chip); 2289 return -EBUSY; 2290 } 2291 if (request_irq(pci->irq, snd_ymfpci_interrupt, SA_INTERRUPT|SA_SHIRQ, "YMFPCI", (void *) chip)) { 2292 snd_printk(KERN_ERR "unable to grab IRQ %d\n", pci->irq); 2293 snd_ymfpci_free(chip); 2294 return -EBUSY; 2295 } 2296 chip->irq = pci->irq; 2297 2298 snd_ymfpci_aclink_reset(pci); 2299 if (snd_ymfpci_codec_ready(chip, 0) < 0) { 2300 snd_ymfpci_free(chip); 2301 return -EIO; 2302 } 2303 2304 snd_ymfpci_download_image(chip); 2305 2306 udelay(100); /* seems we need a delay after downloading image.. */ 2307 2308 if (snd_ymfpci_memalloc(chip) < 0) { 2309 snd_ymfpci_free(chip); 2310 return -EIO; 2311 } 2312 2313 chip->rear_swap = 1; 2314 if ((err = snd_ymfpci_ac3_init(chip)) < 0) { 2315 snd_ymfpci_free(chip); 2316 return err; 2317 } 2318 2319 #ifdef CONFIG_PM 2320 chip->saved_regs = vmalloc(YDSXGR_NUM_SAVED_REGS * sizeof(u32)); 2321 if (chip->saved_regs == NULL) { 2322 snd_ymfpci_free(chip); 2323 return -ENOMEM; 2324 } 2325 #endif 2326 2327 if ((err = snd_device_new(card, SNDRV_DEV_LOWLEVEL, chip, &ops)) < 0) { 2328 snd_ymfpci_free(chip); 2329 return err; 2330 } 2331 2332 snd_ymfpci_proc_init(card, chip); 2333 2334 snd_card_set_dev(card, &pci->dev); 2335 2336 *rchip = chip; 2337 return 0; 2338 } 2339