Blame view

kernel/linux-rt-4.4.41/sound/pci/cs5535audio/cs5535audio_pm.c 3.43 KB
5113f6f70   김현기   kernel add
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
106
107
108
109
110
111
112
113
114
115
116
  /*
   * Power management for audio on multifunction CS5535 companion device
   * Copyright (C) Jaya Kumar
   *
   * This program is free software; you can redistribute it and/or modify
   * it under the terms of the GNU General Public License as published by
   * the Free Software Foundation; either version 2 of the License, or
   * (at your option) any later version.
   *
   * This program is distributed in the hope that it will be useful,
   * but WITHOUT ANY WARRANTY; without even the implied warranty of
   * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
   * GNU General Public License for more details.
   *
   * You should have received a copy of the GNU General Public License
   * along with this program; if not, write to the Free Software
   * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA  02111-1307 USA
   *
   */
  
  #include <linux/init.h>
  #include <linux/pci.h>
  #include <linux/delay.h>
  #include <sound/core.h>
  #include <sound/control.h>
  #include <sound/initval.h>
  #include <sound/asoundef.h>
  #include <sound/pcm.h>
  #include <sound/ac97_codec.h>
  #include "cs5535audio.h"
  
  static void snd_cs5535audio_stop_hardware(struct cs5535audio *cs5535au)
  {
  	/* 
  	we depend on snd_ac97_suspend to tell the
  	AC97 codec to shutdown. the amd spec suggests
  	that the LNK_SHUTDOWN be done at the same time
  	that the codec power-down is issued. instead,
  	we do it just after rather than at the same 
  	time. excluding codec specific build_ops->suspend
  	ac97 powerdown hits:
  	0x8000 EAPD 
  	0x4000 Headphone amplifier 
  	0x0300 ADC & DAC 
  	0x0400 Analog Mixer powerdown (Vref on) 
  	I am not sure if this is the best that we can do.
  	The remainder to be investigated are:
  	- analog mixer (vref off) 0x0800
  	- AC-link powerdown 0x1000
  	- codec internal clock 0x2000
  	*/
  
  	/* set LNK_SHUTDOWN to shutdown AC link */
  	cs_writel(cs5535au, ACC_CODEC_CNTL, ACC_CODEC_CNTL_LNK_SHUTDOWN);
  
  }
  
  static int snd_cs5535audio_suspend(struct device *dev)
  {
  	struct snd_card *card = dev_get_drvdata(dev);
  	struct cs5535audio *cs5535au = card->private_data;
  	int i;
  
  	snd_power_change_state(card, SNDRV_CTL_POWER_D3hot);
  	snd_pcm_suspend_all(cs5535au->pcm);
  	snd_ac97_suspend(cs5535au->ac97);
  	for (i = 0; i < NUM_CS5535AUDIO_DMAS; i++) {
  		struct cs5535audio_dma *dma = &cs5535au->dmas[i];
  		if (dma && dma->substream)
  			dma->saved_prd = dma->ops->read_prd(cs5535au);
  	}
  	/* save important regs, then disable aclink in hw */
  	snd_cs5535audio_stop_hardware(cs5535au);
  	return 0;
  }
  
  static int snd_cs5535audio_resume(struct device *dev)
  {
  	struct snd_card *card = dev_get_drvdata(dev);
  	struct cs5535audio *cs5535au = card->private_data;
  	u32 tmp;
  	int timeout;
  	int i;
  
  	/* set LNK_WRM_RST to reset AC link */
  	cs_writel(cs5535au, ACC_CODEC_CNTL, ACC_CODEC_CNTL_LNK_WRM_RST);
  
  	timeout = 50;
  	do {
  		tmp = cs_readl(cs5535au, ACC_CODEC_STATUS);
  		if (tmp & PRM_RDY_STS)
  			break;
  		udelay(1);
  	} while (--timeout);
  
  	if (!timeout)
  		dev_err(cs5535au->card->dev, "Failure getting AC Link ready
  ");
  
  	/* set up rate regs, dma. actual initiation is done in trig */
  	for (i = 0; i < NUM_CS5535AUDIO_DMAS; i++) {
  		struct cs5535audio_dma *dma = &cs5535au->dmas[i];
  		if (dma && dma->substream) {
  			dma->substream->ops->prepare(dma->substream);
  			dma->ops->setup_prd(cs5535au, dma->saved_prd);
  		}
  	}
  
  	/* we depend on ac97 to perform the codec power up */
  	snd_ac97_resume(cs5535au->ac97);
  	snd_power_change_state(card, SNDRV_CTL_POWER_D0);
  
  	return 0;
  }
  
  SIMPLE_DEV_PM_OPS(snd_cs5535audio_pm, snd_cs5535audio_suspend, snd_cs5535audio_resume);