026410c7dd71702087696c1f3681266eac7ba9ae
[muen/linux.git] / 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 int awacs_freqs[8] = {
28         44100, 29400, 22050, 17640, 14700, 11025, 8820, 7350
29 };
30 /* fixed frequency table for tumbler */
31 static 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 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 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 char *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 char *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