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