sound/ppc/pmac.c

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