1 /* 2 * PMac DBDMA lowlevel functions 3 * 4 * Copyright (c) by Takashi Iwai <tiwai@suse.de> 5 * code based on dmasound.c. 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 <sound/driver.h> 24 #include <asm/io.h> 25 #include <asm/irq.h> 26 #include <linux/init.h> 27 #include <linux/delay.h> 28 #include <linux/slab.h> 29 #include <linux/interrupt.h> 30 #include <linux/pci.h> 31 #include <linux/dma-mapping.h> 32 #include <sound/core.h> 33 #include "pmac.h" 34 #include <sound/pcm_params.h> 35 #include <asm/pmac_feature.h> 36 #include <asm/pci-bridge.h> 37 38 39 #if defined(CONFIG_PM) && defined(CONFIG_PMAC_PBOOK) 40 static int snd_pmac_register_sleep_notifier(pmac_t *chip); 41 static int snd_pmac_unregister_sleep_notifier(pmac_t *chip); 42 static int snd_pmac_suspend(snd_card_t *card, pm_message_t state); 43 static int snd_pmac_resume(snd_card_t *card); 44 #endif 45 46 47 /* fixed frequency table for awacs, screamer, burgundy, DACA (44100 max) */ 48 static int awacs_freqs[8] = { 49 44100, 29400, 22050, 17640, 14700, 11025, 8820, 7350 50 }; 51 /* fixed frequency table for tumbler */ 52 static int tumbler_freqs[1] = { 53 44100 54 }; 55 56 /* 57 * allocate DBDMA command arrays 58 */ 59 static int snd_pmac_dbdma_alloc(pmac_t *chip, pmac_dbdma_t *rec, int size) 60 { 61 unsigned int rsize = sizeof(struct dbdma_cmd) * (size + 1); 62 63 rec->space = dma_alloc_coherent(&chip->pdev->dev, rsize, 64 &rec->dma_base, GFP_KERNEL); 65 if (rec->space == NULL) 66 return -ENOMEM; 67 rec->size = size; 68 memset(rec->space, 0, rsize); 69 rec->cmds = (void __iomem *)DBDMA_ALIGN(rec->space); 70 rec->addr = rec->dma_base + (unsigned long)((char *)rec->cmds - (char *)rec->space); 71 72 return 0; 73 } 74 75 static void snd_pmac_dbdma_free(pmac_t *chip, pmac_dbdma_t *rec) 76 { 77 if (rec) { 78 unsigned int rsize = sizeof(struct dbdma_cmd) * (rec->size + 1); 79 80 dma_free_coherent(&chip->pdev->dev, rsize, rec->space, rec->dma_base); 81 } 82 } 83 84 85 /* 86 * pcm stuff 87 */ 88 89 /* 90 * look up frequency table 91 */ 92 93 unsigned int snd_pmac_rate_index(pmac_t *chip, pmac_stream_t *rec, unsigned int rate) 94 { 95 int i, ok, found; 96 97 ok = rec->cur_freqs; 98 if (rate > chip->freq_table[0]) 99 return 0; 100 found = 0; 101 for (i = 0; i < chip->num_freqs; i++, ok >>= 1) { 102 if (! (ok & 1)) continue; 103 found = i; 104 if (rate >= chip->freq_table[i]) 105 break; 106 } 107 return found; 108 } 109 110 /* 111 * check whether another stream is active 112 */ 113 static inline int another_stream(int stream) 114 { 115 return (stream == SNDRV_PCM_STREAM_PLAYBACK) ? 116 SNDRV_PCM_STREAM_CAPTURE : SNDRV_PCM_STREAM_PLAYBACK; 117 } 118 119 /* 120 * allocate buffers 121 */ 122 static int snd_pmac_pcm_hw_params(snd_pcm_substream_t *subs, 123 snd_pcm_hw_params_t *hw_params) 124 { 125 return snd_pcm_lib_malloc_pages(subs, params_buffer_bytes(hw_params)); 126 } 127 128 /* 129 * release buffers 130 */ 131 static int snd_pmac_pcm_hw_free(snd_pcm_substream_t *subs) 132 { 133 snd_pcm_lib_free_pages(subs); 134 return 0; 135 } 136 137 /* 138 * get a stream of the opposite direction 139 */ 140 static pmac_stream_t *snd_pmac_get_stream(pmac_t *chip, int stream) 141 { 142 switch (stream) { 143 case SNDRV_PCM_STREAM_PLAYBACK: 144 return &chip->playback; 145 case SNDRV_PCM_STREAM_CAPTURE: 146 return &chip->capture; 147 default: 148 snd_BUG(); 149 return NULL; 150 } 151 } 152 153 /* 154 * wait while run status is on 155 */ 156 inline static void 157 snd_pmac_wait_ack(pmac_stream_t *rec) 158 { 159 int timeout = 50000; 160 while ((in_le32(&rec->dma->status) & RUN) && timeout-- > 0) 161 udelay(1); 162 } 163 164 /* 165 * set the format and rate to the chip. 166 * call the lowlevel function if defined (e.g. for AWACS). 167 */ 168 static void snd_pmac_pcm_set_format(pmac_t *chip) 169 { 170 /* set up frequency and format */ 171 out_le32(&chip->awacs->control, chip->control_mask | (chip->rate_index << 8)); 172 out_le32(&chip->awacs->byteswap, chip->format == SNDRV_PCM_FORMAT_S16_LE ? 1 : 0); 173 if (chip->set_format) 174 chip->set_format(chip); 175 } 176 177 /* 178 * stop the DMA transfer 179 */ 180 inline static void snd_pmac_dma_stop(pmac_stream_t *rec) 181 { 182 out_le32(&rec->dma->control, (RUN|WAKE|FLUSH|PAUSE) << 16); 183 snd_pmac_wait_ack(rec); 184 } 185 186 /* 187 * set the command pointer address 188 */ 189 inline static void snd_pmac_dma_set_command(pmac_stream_t *rec, pmac_dbdma_t *cmd) 190 { 191 out_le32(&rec->dma->cmdptr, cmd->addr); 192 } 193 194 /* 195 * start the DMA 196 */ 197 inline static void snd_pmac_dma_run(pmac_stream_t *rec, int status) 198 { 199 out_le32(&rec->dma->control, status | (status << 16)); 200 } 201 202 203 /* 204 * prepare playback/capture stream 205 */ 206 static int snd_pmac_pcm_prepare(pmac_t *chip, pmac_stream_t *rec, snd_pcm_substream_t *subs) 207 { 208 int i; 209 volatile struct dbdma_cmd __iomem *cp; 210 snd_pcm_runtime_t *runtime = subs->runtime; 211 int rate_index; 212 long offset; 213 pmac_stream_t *astr; 214 215 rec->dma_size = snd_pcm_lib_buffer_bytes(subs); 216 rec->period_size = snd_pcm_lib_period_bytes(subs); 217 rec->nperiods = rec->dma_size / rec->period_size; 218 rec->cur_period = 0; 219 rate_index = snd_pmac_rate_index(chip, rec, runtime->rate); 220 221 /* set up constraints */ 222 astr = snd_pmac_get_stream(chip, another_stream(rec->stream)); 223 snd_runtime_check(astr, return -EINVAL); 224 astr->cur_freqs = 1 << rate_index; 225 astr->cur_formats = 1 << runtime->format; 226 chip->rate_index = rate_index; 227 chip->format = runtime->format; 228 229 /* We really want to execute a DMA stop command, after the AWACS 230 * is initialized. 231 * For reasons I don't understand, it stops the hissing noise 232 * common to many PowerBook G3 systems and random noise otherwise 233 * captured on iBook2's about every third time. -ReneR 234 */ 235 spin_lock_irq(&chip->reg_lock); 236 snd_pmac_dma_stop(rec); 237 st_le16(&chip->extra_dma.cmds->command, DBDMA_STOP); 238 snd_pmac_dma_set_command(rec, &chip->extra_dma); 239 snd_pmac_dma_run(rec, RUN); 240 spin_unlock_irq(&chip->reg_lock); 241 mdelay(5); 242 spin_lock_irq(&chip->reg_lock); 243 /* continuous DMA memory type doesn't provide the physical address, 244 * so we need to resolve the address here... 245 */ 246 offset = runtime->dma_addr; 247 for (i = 0, cp = rec->cmd.cmds; i < rec->nperiods; i++, cp++) { 248 st_le32(&cp->phy_addr, offset); 249 st_le16(&cp->req_count, rec->period_size); 250 /*st_le16(&cp->res_count, 0);*/ 251 st_le16(&cp->xfer_status, 0); 252 offset += rec->period_size; 253 } 254 /* make loop */ 255 st_le16(&cp->command, DBDMA_NOP + BR_ALWAYS); 256 st_le32(&cp->cmd_dep, rec->cmd.addr); 257 258 snd_pmac_dma_stop(rec); 259 snd_pmac_dma_set_command(rec, &rec->cmd); 260 spin_unlock_irq(&chip->reg_lock); 261 262 return 0; 263 } 264 265 266 /* 267 * PCM trigger/stop 268 */ 269 static int snd_pmac_pcm_trigger(pmac_t *chip, pmac_stream_t *rec, 270 snd_pcm_substream_t *subs, int cmd) 271 { 272 volatile struct dbdma_cmd __iomem *cp; 273 int i, command; 274 275 switch (cmd) { 276 case SNDRV_PCM_TRIGGER_START: 277 case SNDRV_PCM_TRIGGER_RESUME: 278 if (rec->running) 279 return -EBUSY; 280 command = (subs->stream == SNDRV_PCM_STREAM_PLAYBACK ? 281 OUTPUT_MORE : INPUT_MORE) + INTR_ALWAYS; 282 spin_lock(&chip->reg_lock); 283 snd_pmac_beep_stop(chip); 284 snd_pmac_pcm_set_format(chip); 285 for (i = 0, cp = rec->cmd.cmds; i < rec->nperiods; i++, cp++) 286 out_le16(&cp->command, command); 287 snd_pmac_dma_set_command(rec, &rec->cmd); 288 (void)in_le32(&rec->dma->status); 289 snd_pmac_dma_run(rec, RUN|WAKE); 290 rec->running = 1; 291 spin_unlock(&chip->reg_lock); 292 break; 293 294 case SNDRV_PCM_TRIGGER_STOP: 295 case SNDRV_PCM_TRIGGER_SUSPEND: 296 spin_lock(&chip->reg_lock); 297 rec->running = 0; 298 /*printk("stopped!!\n");*/ 299 snd_pmac_dma_stop(rec); 300 for (i = 0, cp = rec->cmd.cmds; i < rec->nperiods; i++, cp++) 301 out_le16(&cp->command, DBDMA_STOP); 302 spin_unlock(&chip->reg_lock); 303 break; 304 305 default: 306 return -EINVAL; 307 } 308 309 return 0; 310 } 311 312 /* 313 * return the current pointer 314 */ 315 inline 316 static snd_pcm_uframes_t snd_pmac_pcm_pointer(pmac_t *chip, pmac_stream_t *rec, 317 snd_pcm_substream_t *subs) 318 { 319 int count = 0; 320 321 #if 1 /* hmm.. how can we get the current dma pointer?? */ 322 int stat; 323 volatile struct dbdma_cmd __iomem *cp = &rec->cmd.cmds[rec->cur_period]; 324 stat = ld_le16(&cp->xfer_status); 325 if (stat & (ACTIVE|DEAD)) { 326 count = in_le16(&cp->res_count); 327 if (count) 328 count = rec->period_size - count; 329 } 330 #endif 331 count += rec->cur_period * rec->period_size; 332 /*printk("pointer=%d\n", count);*/ 333 return bytes_to_frames(subs->runtime, count); 334 } 335 336 /* 337 * playback 338 */ 339 340 static int snd_pmac_playback_prepare(snd_pcm_substream_t *subs) 341 { 342 pmac_t *chip = snd_pcm_substream_chip(subs); 343 return snd_pmac_pcm_prepare(chip, &chip->playback, subs); 344 } 345 346 static int snd_pmac_playback_trigger(snd_pcm_substream_t *subs, 347 int cmd) 348 { 349 pmac_t *chip = snd_pcm_substream_chip(subs); 350 return snd_pmac_pcm_trigger(chip, &chip->playback, subs, cmd); 351 } 352 353 static snd_pcm_uframes_t snd_pmac_playback_pointer(snd_pcm_substream_t *subs) 354 { 355 pmac_t *chip = snd_pcm_substream_chip(subs); 356 return snd_pmac_pcm_pointer(chip, &chip->playback, subs); 357 } 358 359 360 /* 361 * capture 362 */ 363 364 static int snd_pmac_capture_prepare(snd_pcm_substream_t *subs) 365 { 366 pmac_t *chip = snd_pcm_substream_chip(subs); 367 return snd_pmac_pcm_prepare(chip, &chip->capture, subs); 368 } 369 370 static int snd_pmac_capture_trigger(snd_pcm_substream_t *subs, 371 int cmd) 372 { 373 pmac_t *chip = snd_pcm_substream_chip(subs); 374 return snd_pmac_pcm_trigger(chip, &chip->capture, subs, cmd); 375 } 376 377 static snd_pcm_uframes_t snd_pmac_capture_pointer(snd_pcm_substream_t *subs) 378 { 379 pmac_t *chip = snd_pcm_substream_chip(subs); 380 return snd_pmac_pcm_pointer(chip, &chip->capture, subs); 381 } 382 383 384 /* 385 * update playback/capture pointer from interrupts 386 */ 387 static void snd_pmac_pcm_update(pmac_t *chip, pmac_stream_t *rec) 388 { 389 volatile struct dbdma_cmd __iomem *cp; 390 int c; 391 int stat; 392 393 spin_lock(&chip->reg_lock); 394 if (rec->running) { 395 cp = &rec->cmd.cmds[rec->cur_period]; 396 for (c = 0; c < rec->nperiods; c++) { /* at most all fragments */ 397 stat = ld_le16(&cp->xfer_status); 398 if (! (stat & ACTIVE)) 399 break; 400 /*printk("update frag %d\n", rec->cur_period);*/ 401 st_le16(&cp->xfer_status, 0); 402 st_le16(&cp->req_count, rec->period_size); 403 /*st_le16(&cp->res_count, 0);*/ 404 rec->cur_period++; 405 if (rec->cur_period >= rec->nperiods) { 406 rec->cur_period = 0; 407 cp = rec->cmd.cmds; 408 } else 409 cp++; 410 spin_unlock(&chip->reg_lock); 411 snd_pcm_period_elapsed(rec->substream); 412 spin_lock(&chip->reg_lock); 413 } 414 } 415 spin_unlock(&chip->reg_lock); 416 } 417 418 419 /* 420 * hw info 421 */ 422 423 static snd_pcm_hardware_t snd_pmac_playback = 424 { 425 .info = (SNDRV_PCM_INFO_INTERLEAVED | 426 SNDRV_PCM_INFO_MMAP | 427 SNDRV_PCM_INFO_MMAP_VALID | 428 SNDRV_PCM_INFO_RESUME), 429 .formats = SNDRV_PCM_FMTBIT_S16_BE | SNDRV_PCM_FMTBIT_S16_LE, 430 .rates = SNDRV_PCM_RATE_8000_44100, 431 .rate_min = 7350, 432 .rate_max = 44100, 433 .channels_min = 2, 434 .channels_max = 2, 435 .buffer_bytes_max = 131072, 436 .period_bytes_min = 256, 437 .period_bytes_max = 16384, 438 .periods_min = 3, 439 .periods_max = PMAC_MAX_FRAGS, 440 }; 441 442 static snd_pcm_hardware_t snd_pmac_capture = 443 { 444 .info = (SNDRV_PCM_INFO_INTERLEAVED | 445 SNDRV_PCM_INFO_MMAP | 446 SNDRV_PCM_INFO_MMAP_VALID | 447 SNDRV_PCM_INFO_RESUME), 448 .formats = SNDRV_PCM_FMTBIT_S16_BE | SNDRV_PCM_FMTBIT_S16_LE, 449 .rates = SNDRV_PCM_RATE_8000_44100, 450 .rate_min = 7350, 451 .rate_max = 44100, 452 .channels_min = 2, 453 .channels_max = 2, 454 .buffer_bytes_max = 131072, 455 .period_bytes_min = 256, 456 .period_bytes_max = 16384, 457 .periods_min = 3, 458 .periods_max = PMAC_MAX_FRAGS, 459 }; 460 461 462 #if 0 // NYI 463 static int snd_pmac_hw_rule_rate(snd_pcm_hw_params_t *params, 464 snd_pcm_hw_rule_t *rule) 465 { 466 pmac_t *chip = rule->private; 467 pmac_stream_t *rec = snd_pmac_get_stream(chip, rule->deps[0]); 468 int i, freq_table[8], num_freqs; 469 470 snd_runtime_check(rec, return -EINVAL); 471 num_freqs = 0; 472 for (i = chip->num_freqs - 1; i >= 0; i--) { 473 if (rec->cur_freqs & (1 << i)) 474 freq_table[num_freqs++] = chip->freq_table[i]; 475 } 476 477 return snd_interval_list(hw_param_interval(params, rule->var), 478 num_freqs, freq_table, 0); 479 } 480 481 static int snd_pmac_hw_rule_format(snd_pcm_hw_params_t *params, 482 snd_pcm_hw_rule_t *rule) 483 { 484 pmac_t *chip = rule->private; 485 pmac_stream_t *rec = snd_pmac_get_stream(chip, rule->deps[0]); 486 487 snd_runtime_check(rec, return -EINVAL); 488 return snd_mask_refine_set(hw_param_mask(params, SNDRV_PCM_HW_PARAM_FORMAT), 489 rec->cur_formats); 490 } 491 #endif // NYI 492 493 static int snd_pmac_pcm_open(pmac_t *chip, pmac_stream_t *rec, snd_pcm_substream_t *subs) 494 { 495 snd_pcm_runtime_t *runtime = subs->runtime; 496 int i, j, fflags; 497 static int typical_freqs[] = { 498 44100, 499 22050, 500 11025, 501 0, 502 }; 503 static int typical_freq_flags[] = { 504 SNDRV_PCM_RATE_44100, 505 SNDRV_PCM_RATE_22050, 506 SNDRV_PCM_RATE_11025, 507 0, 508 }; 509 510 /* look up frequency table and fill bit mask */ 511 runtime->hw.rates = 0; 512 fflags = chip->freqs_ok; 513 for (i = 0; typical_freqs[i]; i++) { 514 for (j = 0; j < chip->num_freqs; j++) { 515 if ((chip->freqs_ok & (1 << j)) && 516 chip->freq_table[j] == typical_freqs[i]) { 517 runtime->hw.rates |= typical_freq_flags[i]; 518 fflags &= ~(1 << j); 519 break; 520 } 521 } 522 } 523 if (fflags) /* rest */ 524 runtime->hw.rates |= SNDRV_PCM_RATE_KNOT; 525 526 /* check for minimum and maximum rates */ 527 for (i = 0; i < chip->num_freqs; i++) { 528 if (chip->freqs_ok & (1 << i)) { 529 runtime->hw.rate_max = chip->freq_table[i]; 530 break; 531 } 532 } 533 for (i = chip->num_freqs - 1; i >= 0; i--) { 534 if (chip->freqs_ok & (1 << i)) { 535 runtime->hw.rate_min = chip->freq_table[i]; 536 break; 537 } 538 } 539 runtime->hw.formats = chip->formats_ok; 540 if (chip->can_capture) { 541 if (! chip->can_duplex) 542 runtime->hw.info |= SNDRV_PCM_INFO_HALF_DUPLEX; 543 runtime->hw.info |= SNDRV_PCM_INFO_JOINT_DUPLEX; 544 } 545 runtime->private_data = rec; 546 rec->substream = subs; 547 548 #if 0 /* FIXME: still under development.. */ 549 snd_pcm_hw_rule_add(runtime, 0, SNDRV_PCM_HW_PARAM_RATE, 550 snd_pmac_hw_rule_rate, chip, rec->stream, -1); 551 snd_pcm_hw_rule_add(runtime, 0, SNDRV_PCM_HW_PARAM_FORMAT, 552 snd_pmac_hw_rule_format, chip, rec->stream, -1); 553 #endif 554 555 runtime->hw.periods_max = rec->cmd.size - 1; 556 557 if (chip->can_duplex) 558 snd_pcm_set_sync(subs); 559 560 /* constraints to fix choppy sound */ 561 snd_pcm_hw_constraint_integer(runtime, SNDRV_PCM_HW_PARAM_PERIODS); 562 return 0; 563 } 564 565 static int snd_pmac_pcm_close(pmac_t *chip, pmac_stream_t *rec, snd_pcm_substream_t *subs) 566 { 567 pmac_stream_t *astr; 568 569 snd_pmac_dma_stop(rec); 570 571 astr = snd_pmac_get_stream(chip, another_stream(rec->stream)); 572 snd_runtime_check(astr, return -EINVAL); 573 574 /* reset constraints */ 575 astr->cur_freqs = chip->freqs_ok; 576 astr->cur_formats = chip->formats_ok; 577 578 return 0; 579 } 580 581 static int snd_pmac_playback_open(snd_pcm_substream_t *subs) 582 { 583 pmac_t *chip = snd_pcm_substream_chip(subs); 584 585 subs->runtime->hw = snd_pmac_playback; 586 return snd_pmac_pcm_open(chip, &chip->playback, subs); 587 } 588 589 static int snd_pmac_capture_open(snd_pcm_substream_t *subs) 590 { 591 pmac_t *chip = snd_pcm_substream_chip(subs); 592 593 subs->runtime->hw = snd_pmac_capture; 594 return snd_pmac_pcm_open(chip, &chip->capture, subs); 595 } 596 597 static int snd_pmac_playback_close(snd_pcm_substream_t *subs) 598 { 599 pmac_t *chip = snd_pcm_substream_chip(subs); 600 601 return snd_pmac_pcm_close(chip, &chip->playback, subs); 602 } 603 604 static int snd_pmac_capture_close(snd_pcm_substream_t *subs) 605 { 606 pmac_t *chip = snd_pcm_substream_chip(subs); 607 608 return snd_pmac_pcm_close(chip, &chip->capture, subs); 609 } 610 611 /* 612 */ 613 614 static snd_pcm_ops_t snd_pmac_playback_ops = { 615 .open = snd_pmac_playback_open, 616 .close = snd_pmac_playback_close, 617 .ioctl = snd_pcm_lib_ioctl, 618 .hw_params = snd_pmac_pcm_hw_params, 619 .hw_free = snd_pmac_pcm_hw_free, 620 .prepare = snd_pmac_playback_prepare, 621 .trigger = snd_pmac_playback_trigger, 622 .pointer = snd_pmac_playback_pointer, 623 }; 624 625 static snd_pcm_ops_t snd_pmac_capture_ops = { 626 .open = snd_pmac_capture_open, 627 .close = snd_pmac_capture_close, 628 .ioctl = snd_pcm_lib_ioctl, 629 .hw_params = snd_pmac_pcm_hw_params, 630 .hw_free = snd_pmac_pcm_hw_free, 631 .prepare = snd_pmac_capture_prepare, 632 .trigger = snd_pmac_capture_trigger, 633 .pointer = snd_pmac_capture_pointer, 634 }; 635 636 static void pmac_pcm_free(snd_pcm_t *pcm) 637 { 638 snd_pcm_lib_preallocate_free_for_all(pcm); 639 } 640 641 int __init snd_pmac_pcm_new(pmac_t *chip) 642 { 643 snd_pcm_t *pcm; 644 int err; 645 int num_captures = 1; 646 647 if (! chip->can_capture) 648 num_captures = 0; 649 err = snd_pcm_new(chip->card, chip->card->driver, 0, 1, num_captures, &pcm); 650 if (err < 0) 651 return err; 652 653 snd_pcm_set_ops(pcm, SNDRV_PCM_STREAM_PLAYBACK, &snd_pmac_playback_ops); 654 if (chip->can_capture) 655 snd_pcm_set_ops(pcm, SNDRV_PCM_STREAM_CAPTURE, &snd_pmac_capture_ops); 656 657 pcm->private_data = chip; 658 pcm->private_free = pmac_pcm_free; 659 pcm->info_flags = SNDRV_PCM_INFO_JOINT_DUPLEX; 660 strcpy(pcm->name, chip->card->shortname); 661 chip->pcm = pcm; 662 663 chip->formats_ok = SNDRV_PCM_FMTBIT_S16_BE; 664 if (chip->can_byte_swap) 665 chip->formats_ok |= SNDRV_PCM_FMTBIT_S16_LE; 666 667 chip->playback.cur_formats = chip->formats_ok; 668 chip->capture.cur_formats = chip->formats_ok; 669 chip->playback.cur_freqs = chip->freqs_ok; 670 chip->capture.cur_freqs = chip->freqs_ok; 671 672 /* preallocate 64k buffer */ 673 snd_pcm_lib_preallocate_pages_for_all(pcm, SNDRV_DMA_TYPE_DEV, 674 &chip->pdev->dev, 675 64 * 1024, 64 * 1024); 676 677 return 0; 678 } 679 680 681 static void snd_pmac_dbdma_reset(pmac_t *chip) 682 { 683 out_le32(&chip->playback.dma->control, (RUN|PAUSE|FLUSH|WAKE|DEAD) << 16); 684 snd_pmac_wait_ack(&chip->playback); 685 out_le32(&chip->capture.dma->control, (RUN|PAUSE|FLUSH|WAKE|DEAD) << 16); 686 snd_pmac_wait_ack(&chip->capture); 687 } 688 689 690 /* 691 * handling beep 692 */ 693 void snd_pmac_beep_dma_start(pmac_t *chip, int bytes, unsigned long addr, int speed) 694 { 695 pmac_stream_t *rec = &chip->playback; 696 697 snd_pmac_dma_stop(rec); 698 st_le16(&chip->extra_dma.cmds->req_count, bytes); 699 st_le16(&chip->extra_dma.cmds->xfer_status, 0); 700 st_le32(&chip->extra_dma.cmds->cmd_dep, chip->extra_dma.addr); 701 st_le32(&chip->extra_dma.cmds->phy_addr, addr); 702 st_le16(&chip->extra_dma.cmds->command, OUTPUT_MORE + BR_ALWAYS); 703 out_le32(&chip->awacs->control, 704 (in_le32(&chip->awacs->control) & ~0x1f00) 705 | (speed << 8)); 706 out_le32(&chip->awacs->byteswap, 0); 707 snd_pmac_dma_set_command(rec, &chip->extra_dma); 708 snd_pmac_dma_run(rec, RUN); 709 } 710 711 void snd_pmac_beep_dma_stop(pmac_t *chip) 712 { 713 snd_pmac_dma_stop(&chip->playback); 714 st_le16(&chip->extra_dma.cmds->command, DBDMA_STOP); 715 snd_pmac_pcm_set_format(chip); /* reset format */ 716 } 717 718 719 /* 720 * interrupt handlers 721 */ 722 static irqreturn_t 723 snd_pmac_tx_intr(int irq, void *devid, struct pt_regs *regs) 724 { 725 pmac_t *chip = devid; 726 snd_pmac_pcm_update(chip, &chip->playback); 727 return IRQ_HANDLED; 728 } 729 730 731 static irqreturn_t 732 snd_pmac_rx_intr(int irq, void *devid, struct pt_regs *regs) 733 { 734 pmac_t *chip = devid; 735 snd_pmac_pcm_update(chip, &chip->capture); 736 return IRQ_HANDLED; 737 } 738 739 740 static irqreturn_t 741 snd_pmac_ctrl_intr(int irq, void *devid, struct pt_regs *regs) 742 { 743 pmac_t *chip = devid; 744 int ctrl = in_le32(&chip->awacs->control); 745 746 /*printk("pmac: control interrupt.. 0x%x\n", ctrl);*/ 747 if (ctrl & MASK_PORTCHG) { 748 /* do something when headphone is plugged/unplugged? */ 749 if (chip->update_automute) 750 chip->update_automute(chip, 1); 751 } 752 if (ctrl & MASK_CNTLERR) { 753 int err = (in_le32(&chip->awacs->codec_stat) & MASK_ERRCODE) >> 16; 754 if (err && chip->model <= PMAC_SCREAMER) 755 snd_printk(KERN_DEBUG "error %x\n", err); 756 } 757 /* Writing 1s to the CNTLERR and PORTCHG bits clears them... */ 758 out_le32(&chip->awacs->control, ctrl); 759 return IRQ_HANDLED; 760 } 761 762 763 /* 764 * a wrapper to feature call for compatibility 765 */ 766 static void snd_pmac_sound_feature(pmac_t *chip, int enable) 767 { 768 ppc_md.feature_call(PMAC_FTR_SOUND_CHIP_ENABLE, chip->node, 0, enable); 769 } 770 771 /* 772 * release resources 773 */ 774 775 static int snd_pmac_free(pmac_t *chip) 776 { 777 /* stop sounds */ 778 if (chip->initialized) { 779 snd_pmac_dbdma_reset(chip); 780 /* disable interrupts from awacs interface */ 781 out_le32(&chip->awacs->control, in_le32(&chip->awacs->control) & 0xfff); 782 } 783 784 snd_pmac_sound_feature(chip, 0); 785 #if defined(CONFIG_PM) && defined(CONFIG_PMAC_PBOOK) 786 snd_pmac_unregister_sleep_notifier(chip); 787 #endif 788 789 /* clean up mixer if any */ 790 if (chip->mixer_free) 791 chip->mixer_free(chip); 792 793 snd_pmac_detach_beep(chip); 794 795 /* release resources */ 796 if (chip->irq >= 0) 797 free_irq(chip->irq, (void*)chip); 798 if (chip->tx_irq >= 0) 799 free_irq(chip->tx_irq, (void*)chip); 800 if (chip->rx_irq >= 0) 801 free_irq(chip->rx_irq, (void*)chip); 802 snd_pmac_dbdma_free(chip, &chip->playback.cmd); 803 snd_pmac_dbdma_free(chip, &chip->capture.cmd); 804 snd_pmac_dbdma_free(chip, &chip->extra_dma); 805 if (chip->macio_base) 806 iounmap(chip->macio_base); 807 if (chip->latch_base) 808 iounmap(chip->latch_base); 809 if (chip->awacs) 810 iounmap(chip->awacs); 811 if (chip->playback.dma) 812 iounmap(chip->playback.dma); 813 if (chip->capture.dma) 814 iounmap(chip->capture.dma); 815 #ifndef CONFIG_PPC64 816 if (chip->node) { 817 int i; 818 819 for (i = 0; i < 3; i++) { 820 if (chip->of_requested & (1 << i)) { 821 if (chip->is_k2) 822 release_OF_resource(chip->node->parent, 823 i); 824 else 825 release_OF_resource(chip->node, i); 826 } 827 } 828 } 829 #endif /* CONFIG_PPC64 */ 830 if (chip->pdev) 831 pci_dev_put(chip->pdev); 832 kfree(chip); 833 return 0; 834 } 835 836 837 /* 838 * free the device 839 */ 840 static int snd_pmac_dev_free(snd_device_t *device) 841 { 842 pmac_t *chip = device->device_data; 843 return snd_pmac_free(chip); 844 } 845 846 847 /* 848 * check the machine support byteswap (little-endian) 849 */ 850 851 static void __init detect_byte_swap(pmac_t *chip) 852 { 853 struct device_node *mio; 854 855 /* if seems that Keylargo can't byte-swap */ 856 for (mio = chip->node->parent; mio; mio = mio->parent) { 857 if (strcmp(mio->name, "mac-io") == 0) { 858 if (device_is_compatible(mio, "Keylargo")) 859 chip->can_byte_swap = 0; 860 break; 861 } 862 } 863 864 /* it seems the Pismo & iBook can't byte-swap in hardware. */ 865 if (machine_is_compatible("PowerBook3,1") || 866 machine_is_compatible("PowerBook2,1")) 867 chip->can_byte_swap = 0 ; 868 869 if (machine_is_compatible("PowerBook2,1")) 870 chip->can_duplex = 0; 871 } 872 873 874 /* 875 * detect a sound chip 876 */ 877 static int __init snd_pmac_detect(pmac_t *chip) 878 { 879 struct device_node *sound = NULL; 880 unsigned int *prop, l; 881 struct macio_chip* macio; 882 883 u32 layout_id = 0; 884 885 if (_machine != _MACH_Pmac) 886 return -ENODEV; 887 888 chip->subframe = 0; 889 chip->revision = 0; 890 chip->freqs_ok = 0xff; /* all ok */ 891 chip->model = PMAC_AWACS; 892 chip->can_byte_swap = 1; 893 chip->can_duplex = 1; 894 chip->can_capture = 1; 895 chip->num_freqs = ARRAY_SIZE(awacs_freqs); 896 chip->freq_table = awacs_freqs; 897 898 chip->control_mask = MASK_IEPC | MASK_IEE | 0x11; /* default */ 899 900 /* check machine type */ 901 if (machine_is_compatible("AAPL,3400/2400") 902 || machine_is_compatible("AAPL,3500")) 903 chip->is_pbook_3400 = 1; 904 else if (machine_is_compatible("PowerBook1,1") 905 || machine_is_compatible("AAPL,PowerBook1998")) 906 chip->is_pbook_G3 = 1; 907 chip->node = find_devices("awacs"); 908 if (chip->node) 909 sound = chip->node; 910 911 /* 912 * powermac G3 models have a node called "davbus" 913 * with a child called "sound". 914 */ 915 if (!chip->node) 916 chip->node = find_devices("davbus"); 917 /* 918 * if we didn't find a davbus device, try 'i2s-a' since 919 * this seems to be what iBooks have 920 */ 921 if (! chip->node) { 922 chip->node = find_devices("i2s-a"); 923 if (chip->node && chip->node->parent && 924 chip->node->parent->parent) { 925 if (device_is_compatible(chip->node->parent->parent, 926 "K2-Keylargo")) 927 chip->is_k2 = 1; 928 } 929 } 930 if (! chip->node) 931 return -ENODEV; 932 933 if (!sound) { 934 sound = find_devices("sound"); 935 while (sound && sound->parent != chip->node) 936 sound = sound->next; 937 } 938 if (! sound) 939 return -ENODEV; 940 prop = (unsigned int *) get_property(sound, "sub-frame", NULL); 941 if (prop && *prop < 16) 942 chip->subframe = *prop; 943 prop = (unsigned int *) get_property(sound, "layout-id", NULL); 944 if (prop) 945 layout_id = *prop; 946 /* This should be verified on older screamers */ 947 if (device_is_compatible(sound, "screamer")) { 948 chip->model = PMAC_SCREAMER; 949 // chip->can_byte_swap = 0; /* FIXME: check this */ 950 } 951 if (device_is_compatible(sound, "burgundy")) { 952 chip->model = PMAC_BURGUNDY; 953 chip->control_mask = MASK_IEPC | 0x11; /* disable IEE */ 954 } 955 if (device_is_compatible(sound, "daca")) { 956 chip->model = PMAC_DACA; 957 chip->can_capture = 0; /* no capture */ 958 chip->can_duplex = 0; 959 // chip->can_byte_swap = 0; /* FIXME: check this */ 960 chip->control_mask = MASK_IEPC | 0x11; /* disable IEE */ 961 } 962 if (device_is_compatible(sound, "tumbler")) { 963 chip->model = PMAC_TUMBLER; 964 chip->can_capture = 0; /* no capture */ 965 chip->can_duplex = 0; 966 // chip->can_byte_swap = 0; /* FIXME: check this */ 967 chip->num_freqs = ARRAY_SIZE(tumbler_freqs); 968 chip->freq_table = tumbler_freqs; 969 chip->control_mask = MASK_IEPC | 0x11; /* disable IEE */ 970 } 971 if (device_is_compatible(sound, "snapper")) { 972 chip->model = PMAC_SNAPPER; 973 // chip->can_byte_swap = 0; /* FIXME: check this */ 974 chip->num_freqs = ARRAY_SIZE(tumbler_freqs); 975 chip->freq_table = tumbler_freqs; 976 chip->control_mask = MASK_IEPC | 0x11; /* disable IEE */ 977 } 978 if (device_is_compatible(sound, "AOAKeylargo") || 979 device_is_compatible(sound, "AOAbase") || 980 device_is_compatible(sound, "AOAK2")) { 981 /* For now, only support very basic TAS3004 based machines with 982 * single frequency until proper i2s control is implemented 983 */ 984 switch(layout_id) { 985 case 0x48: 986 case 0x46: 987 case 0x33: 988 case 0x29: 989 case 0x24: 990 chip->num_freqs = ARRAY_SIZE(tumbler_freqs); 991 chip->model = PMAC_SNAPPER; 992 chip->can_byte_swap = 0; /* FIXME: check this */ 993 chip->control_mask = MASK_IEPC | 0x11;/* disable IEE */ 994 break; 995 case 0x3a: 996 chip->num_freqs = ARRAY_SIZE(tumbler_freqs); 997 chip->model = PMAC_TOONIE; 998 chip->can_byte_swap = 0; /* FIXME: check this */ 999 chip->control_mask = MASK_IEPC | 0x11;/* disable IEE */ 1000 break; 1001 } 1002 } 1003 prop = (unsigned int *)get_property(sound, "device-id", NULL); 1004 if (prop) 1005 chip->device_id = *prop; 1006 chip->has_iic = (find_devices("perch") != NULL); 1007 1008 /* We need the PCI device for DMA allocations, let's use a crude method 1009 * for now ... 1010 */ 1011 macio = macio_find(chip->node, macio_unknown); 1012 if (macio == NULL) 1013 printk(KERN_WARNING "snd-powermac: can't locate macio !\n"); 1014 else { 1015 struct pci_dev *pdev = NULL; 1016 1017 for_each_pci_dev(pdev) { 1018 struct device_node *np = pci_device_to_OF_node(pdev); 1019 if (np && np == macio->of_node) { 1020 chip->pdev = pdev; 1021 break; 1022 } 1023 } 1024 } 1025 if (chip->pdev == NULL) 1026 printk(KERN_WARNING "snd-powermac: can't locate macio PCI" 1027 " device !\n"); 1028 1029 detect_byte_swap(chip); 1030 1031 /* look for a property saying what sample rates 1032 are available */ 1033 prop = (unsigned int *) get_property(sound, "sample-rates", &l); 1034 if (! prop) 1035 prop = (unsigned int *) get_property(sound, 1036 "output-frame-rates", &l); 1037 if (prop) { 1038 int i; 1039 chip->freqs_ok = 0; 1040 for (l /= sizeof(int); l > 0; --l) { 1041 unsigned int r = *prop++; 1042 /* Apple 'Fixed' format */ 1043 if (r >= 0x10000) 1044 r >>= 16; 1045 for (i = 0; i < chip->num_freqs; ++i) { 1046 if (r == chip->freq_table[i]) { 1047 chip->freqs_ok |= (1 << i); 1048 break; 1049 } 1050 } 1051 } 1052 } else { 1053 /* assume only 44.1khz */ 1054 chip->freqs_ok = 1; 1055 } 1056 1057 return 0; 1058 } 1059 1060 /* 1061 * exported - boolean info callbacks for ease of programming 1062 */ 1063 int snd_pmac_boolean_stereo_info(snd_kcontrol_t *kcontrol, 1064 snd_ctl_elem_info_t *uinfo) 1065 { 1066 uinfo->type = SNDRV_CTL_ELEM_TYPE_BOOLEAN; 1067 uinfo->count = 2; 1068 uinfo->value.integer.min = 0; 1069 uinfo->value.integer.max = 1; 1070 return 0; 1071 } 1072 1073 int snd_pmac_boolean_mono_info(snd_kcontrol_t *kcontrol, 1074 snd_ctl_elem_info_t *uinfo) 1075 { 1076 uinfo->type = SNDRV_CTL_ELEM_TYPE_BOOLEAN; 1077 uinfo->count = 1; 1078 uinfo->value.integer.min = 0; 1079 uinfo->value.integer.max = 1; 1080 return 0; 1081 } 1082 1083 #ifdef PMAC_SUPPORT_AUTOMUTE 1084 /* 1085 * auto-mute 1086 */ 1087 static int pmac_auto_mute_get(snd_kcontrol_t *kcontrol, snd_ctl_elem_value_t *ucontrol) 1088 { 1089 pmac_t *chip = snd_kcontrol_chip(kcontrol); 1090 ucontrol->value.integer.value[0] = chip->auto_mute; 1091 return 0; 1092 } 1093 1094 static int pmac_auto_mute_put(snd_kcontrol_t *kcontrol, snd_ctl_elem_value_t *ucontrol) 1095 { 1096 pmac_t *chip = snd_kcontrol_chip(kcontrol); 1097 if (ucontrol->value.integer.value[0] != chip->auto_mute) { 1098 chip->auto_mute = ucontrol->value.integer.value[0]; 1099 if (chip->update_automute) 1100 chip->update_automute(chip, 1); 1101 return 1; 1102 } 1103 return 0; 1104 } 1105 1106 static int pmac_hp_detect_get(snd_kcontrol_t *kcontrol, snd_ctl_elem_value_t *ucontrol) 1107 { 1108 pmac_t *chip = snd_kcontrol_chip(kcontrol); 1109 if (chip->detect_headphone) 1110 ucontrol->value.integer.value[0] = chip->detect_headphone(chip); 1111 else 1112 ucontrol->value.integer.value[0] = 0; 1113 return 0; 1114 } 1115 1116 static snd_kcontrol_new_t auto_mute_controls[] __initdata = { 1117 { .iface = SNDRV_CTL_ELEM_IFACE_MIXER, 1118 .name = "Auto Mute Switch", 1119 .info = snd_pmac_boolean_mono_info, 1120 .get = pmac_auto_mute_get, 1121 .put = pmac_auto_mute_put, 1122 }, 1123 { .iface = SNDRV_CTL_ELEM_IFACE_MIXER, 1124 .name = "Headphone Detection", 1125 .access = SNDRV_CTL_ELEM_ACCESS_READ, 1126 .info = snd_pmac_boolean_mono_info, 1127 .get = pmac_hp_detect_get, 1128 }, 1129 }; 1130 1131 int __init snd_pmac_add_automute(pmac_t *chip) 1132 { 1133 int err; 1134 chip->auto_mute = 1; 1135 err = snd_ctl_add(chip->card, snd_ctl_new1(&auto_mute_controls[0], chip)); 1136 if (err < 0) { 1137 printk(KERN_ERR "snd-powermac: Failed to add automute control\n"); 1138 return err; 1139 } 1140 chip->hp_detect_ctl = snd_ctl_new1(&auto_mute_controls[1], chip); 1141 return snd_ctl_add(chip->card, chip->hp_detect_ctl); 1142 } 1143 #endif /* PMAC_SUPPORT_AUTOMUTE */ 1144 1145 /* 1146 * create and detect a pmac chip record 1147 */ 1148 int __init snd_pmac_new(snd_card_t *card, pmac_t **chip_return) 1149 { 1150 pmac_t *chip; 1151 struct device_node *np; 1152 int i, err; 1153 unsigned long ctrl_addr, txdma_addr, rxdma_addr; 1154 static snd_device_ops_t ops = { 1155 .dev_free = snd_pmac_dev_free, 1156 }; 1157 1158 snd_runtime_check(chip_return, return -EINVAL); 1159 *chip_return = NULL; 1160 1161 chip = kcalloc(1, sizeof(*chip), GFP_KERNEL); 1162 if (chip == NULL) 1163 return -ENOMEM; 1164 chip->card = card; 1165 1166 spin_lock_init(&chip->reg_lock); 1167 chip->irq = chip->tx_irq = chip->rx_irq = -1; 1168 1169 chip->playback.stream = SNDRV_PCM_STREAM_PLAYBACK; 1170 chip->capture.stream = SNDRV_PCM_STREAM_CAPTURE; 1171 1172 if ((err = snd_pmac_detect(chip)) < 0) 1173 goto __error; 1174 1175 if (snd_pmac_dbdma_alloc(chip, &chip->playback.cmd, PMAC_MAX_FRAGS + 1) < 0 || 1176 snd_pmac_dbdma_alloc(chip, &chip->capture.cmd, PMAC_MAX_FRAGS + 1) < 0 || 1177 snd_pmac_dbdma_alloc(chip, &chip->extra_dma, 2) < 0) { 1178 err = -ENOMEM; 1179 goto __error; 1180 } 1181 1182 np = chip->node; 1183 if (chip->is_k2) { 1184 if (np->parent->n_addrs < 2 || np->n_intrs < 3) { 1185 err = -ENODEV; 1186 goto __error; 1187 } 1188 for (i = 0; i < 2; i++) { 1189 #ifndef CONFIG_PPC64 1190 static char *name[2] = { "- Control", "- DMA" }; 1191 if (! request_OF_resource(np->parent, i, name[i])) { 1192 snd_printk(KERN_ERR "pmac: can't request resource %d!\n", i); 1193 err = -ENODEV; 1194 goto __error; 1195 } 1196 chip->of_requested |= (1 << i); 1197 #endif /* CONFIG_PPC64 */ 1198 ctrl_addr = np->parent->addrs[0].address; 1199 txdma_addr = np->parent->addrs[1].address; 1200 rxdma_addr = txdma_addr + 0x100; 1201 } 1202 1203 } else { 1204 if (np->n_addrs < 3 || np->n_intrs < 3) { 1205 err = -ENODEV; 1206 goto __error; 1207 } 1208 1209 for (i = 0; i < 3; i++) { 1210 #ifndef CONFIG_PPC64 1211 static char *name[3] = { "- Control", "- Tx DMA", "- Rx DMA" }; 1212 if (! request_OF_resource(np, i, name[i])) { 1213 snd_printk(KERN_ERR "pmac: can't request resource %d!\n", i); 1214 err = -ENODEV; 1215 goto __error; 1216 } 1217 chip->of_requested |= (1 << i); 1218 #endif /* CONFIG_PPC64 */ 1219 ctrl_addr = np->addrs[0].address; 1220 txdma_addr = np->addrs[1].address; 1221 rxdma_addr = np->addrs[2].address; 1222 } 1223 } 1224 1225 chip->awacs = ioremap(ctrl_addr, 0x1000); 1226 chip->playback.dma = ioremap(txdma_addr, 0x100); 1227 chip->capture.dma = ioremap(rxdma_addr, 0x100); 1228 if (chip->model <= PMAC_BURGUNDY) { 1229 if (request_irq(np->intrs[0].line, snd_pmac_ctrl_intr, 0, 1230 "PMac", (void*)chip)) { 1231 snd_printk(KERN_ERR "pmac: unable to grab IRQ %d\n", np->intrs[0].line); 1232 err = -EBUSY; 1233 goto __error; 1234 } 1235 chip->irq = np->intrs[0].line; 1236 } 1237 if (request_irq(np->intrs[1].line, snd_pmac_tx_intr, 0, 1238 "PMac Output", (void*)chip)) { 1239 snd_printk(KERN_ERR "pmac: unable to grab IRQ %d\n", np->intrs[1].line); 1240 err = -EBUSY; 1241 goto __error; 1242 } 1243 chip->tx_irq = np->intrs[1].line; 1244 if (request_irq(np->intrs[2].line, snd_pmac_rx_intr, 0, 1245 "PMac Input", (void*)chip)) { 1246 snd_printk(KERN_ERR "pmac: unable to grab IRQ %d\n", np->intrs[2].line); 1247 err = -EBUSY; 1248 goto __error; 1249 } 1250 chip->rx_irq = np->intrs[2].line; 1251 1252 snd_pmac_sound_feature(chip, 1); 1253 1254 /* reset */ 1255 if (chip->model == PMAC_AWACS) 1256 out_le32(&chip->awacs->control, 0x11); 1257 1258 /* Powerbooks have odd ways of enabling inputs such as 1259 an expansion-bay CD or sound from an internal modem 1260 or a PC-card modem. */ 1261 if (chip->is_pbook_3400) { 1262 /* Enable CD and PC-card sound inputs. */ 1263 /* This is done by reading from address 1264 * f301a000, + 0x10 to enable the expansion-bay 1265 * CD sound input, + 0x80 to enable the PC-card 1266 * sound input. The 0x100 enables the SCSI bus 1267 * terminator power. 1268 */ 1269 chip->latch_base = ioremap (0xf301a000, 0x1000); 1270 in_8(chip->latch_base + 0x190); 1271 } else if (chip->is_pbook_G3) { 1272 struct device_node* mio; 1273 for (mio = chip->node->parent; mio; mio = mio->parent) { 1274 if (strcmp(mio->name, "mac-io") == 0 1275 && mio->n_addrs > 0) { 1276 chip->macio_base = ioremap(mio->addrs[0].address, 0x40); 1277 break; 1278 } 1279 } 1280 /* Enable CD sound input. */ 1281 /* The relevant bits for writing to this byte are 0x8f. 1282 * I haven't found out what the 0x80 bit does. 1283 * For the 0xf bits, writing 3 or 7 enables the CD 1284 * input, any other value disables it. Values 1285 * 1, 3, 5, 7 enable the microphone. Values 0, 2, 1286 * 4, 6, 8 - f enable the input from the modem. 1287 */ 1288 if (chip->macio_base) 1289 out_8(chip->macio_base + 0x37, 3); 1290 } 1291 1292 /* Reset dbdma channels */ 1293 snd_pmac_dbdma_reset(chip); 1294 1295 #if defined(CONFIG_PM) && defined(CONFIG_PMAC_PBOOK) 1296 /* add sleep notifier */ 1297 if (! snd_pmac_register_sleep_notifier(chip)) 1298 snd_card_set_pm_callback(chip->card, snd_pmac_suspend, snd_pmac_resume, chip); 1299 #endif 1300 1301 if ((err = snd_device_new(card, SNDRV_DEV_LOWLEVEL, chip, &ops)) < 0) 1302 goto __error; 1303 1304 *chip_return = chip; 1305 return 0; 1306 1307 __error: 1308 if (chip->pdev) 1309 pci_dev_put(chip->pdev); 1310 snd_pmac_free(chip); 1311 return err; 1312 } 1313 1314 1315 /* 1316 * sleep notify for powerbook 1317 */ 1318 1319 #if defined(CONFIG_PM) && defined(CONFIG_PMAC_PBOOK) 1320 1321 /* 1322 * Save state when going to sleep, restore it afterwards. 1323 */ 1324 1325 static int snd_pmac_suspend(snd_card_t *card, pm_message_t state) 1326 { 1327 pmac_t *chip = card->pm_private_data; 1328 unsigned long flags; 1329 1330 if (chip->suspend) 1331 chip->suspend(chip); 1332 snd_pcm_suspend_all(chip->pcm); 1333 spin_lock_irqsave(&chip->reg_lock, flags); 1334 snd_pmac_beep_stop(chip); 1335 spin_unlock_irqrestore(&chip->reg_lock, flags); 1336 if (chip->irq >= 0) 1337 disable_irq(chip->irq); 1338 if (chip->tx_irq >= 0) 1339 disable_irq(chip->tx_irq); 1340 if (chip->rx_irq >= 0) 1341 disable_irq(chip->rx_irq); 1342 snd_pmac_sound_feature(chip, 0); 1343 return 0; 1344 } 1345 1346 static int snd_pmac_resume(snd_card_t *card) 1347 { 1348 pmac_t *chip = card->pm_private_data; 1349 1350 snd_pmac_sound_feature(chip, 1); 1351 if (chip->resume) 1352 chip->resume(chip); 1353 /* enable CD sound input */ 1354 if (chip->macio_base && chip->is_pbook_G3) { 1355 out_8(chip->macio_base + 0x37, 3); 1356 } else if (chip->is_pbook_3400) { 1357 in_8(chip->latch_base + 0x190); 1358 } 1359 1360 snd_pmac_pcm_set_format(chip); 1361 1362 if (chip->irq >= 0) 1363 enable_irq(chip->irq); 1364 if (chip->tx_irq >= 0) 1365 enable_irq(chip->tx_irq); 1366 if (chip->rx_irq >= 0) 1367 enable_irq(chip->rx_irq); 1368 1369 return 0; 1370 } 1371 1372 /* the chip is stored statically by snd_pmac_register_sleep_notifier 1373 * because we can't have any private data for notify callback. 1374 */ 1375 static pmac_t *sleeping_pmac = NULL; 1376 1377 static int snd_pmac_sleep_notify(struct pmu_sleep_notifier *self, int when) 1378 { 1379 pmac_t *chip; 1380 1381 chip = sleeping_pmac; 1382 snd_runtime_check(chip, return 0); 1383 1384 switch (when) { 1385 case PBOOK_SLEEP_NOW: 1386 snd_pmac_suspend(chip->card, PMSG_SUSPEND); 1387 break; 1388 case PBOOK_WAKE: 1389 snd_pmac_resume(chip->card); 1390 break; 1391 } 1392 return PBOOK_SLEEP_OK; 1393 } 1394 1395 static struct pmu_sleep_notifier snd_pmac_sleep_notifier = { 1396 snd_pmac_sleep_notify, SLEEP_LEVEL_SOUND, 1397 }; 1398 1399 static int __init snd_pmac_register_sleep_notifier(pmac_t *chip) 1400 { 1401 /* should be protected here.. */ 1402 snd_assert(! sleeping_pmac, return -EBUSY); 1403 sleeping_pmac = chip; 1404 pmu_register_sleep_notifier(&snd_pmac_sleep_notifier); 1405 return 0; 1406 } 1407 1408 static int snd_pmac_unregister_sleep_notifier(pmac_t *chip) 1409 { 1410 /* should be protected here.. */ 1411 snd_assert(sleeping_pmac == chip, return -ENODEV); 1412 pmu_unregister_sleep_notifier(&snd_pmac_sleep_notifier); 1413 sleeping_pmac = NULL; 1414 return 0; 1415 } 1416 1417 #endif /* CONFIG_PM && CONFIG_PMAC_PBOOK */ 1418