sfc: Get port number from CS_PORT_NUM, not PCI function number
[zen-stable.git] / sound / soc / s3c24xx / s3c24xx_simtec.c
blob4984754f3298dac412f9ee22dfbce4de5f5804f8
1 /* sound/soc/s3c24xx/s3c24xx_simtec.c
3 * Copyright 2009 Simtec Electronics
5 * This program is free software; you can redistribute it and/or modify
6 * it under the terms of the GNU General Public License version 2 as
7 * published by the Free Software Foundation.
8 */
10 #include <linux/module.h>
11 #include <linux/moduleparam.h>
12 #include <linux/platform_device.h>
13 #include <linux/gpio.h>
14 #include <linux/clk.h>
15 #include <linux/i2c.h>
17 #include <sound/core.h>
18 #include <sound/pcm.h>
19 #include <sound/soc.h>
20 #include <sound/soc-dapm.h>
22 #include <plat/audio-simtec.h>
24 #include "s3c-dma.h"
25 #include "s3c24xx-i2s.h"
26 #include "s3c24xx_simtec.h"
28 static struct s3c24xx_audio_simtec_pdata *pdata;
29 static struct clk *xtal_clk;
31 static int spk_gain;
32 static int spk_unmute;
34 /**
35 * speaker_gain_get - read the speaker gain setting.
36 * @kcontrol: The control for the speaker gain.
37 * @ucontrol: The value that needs to be updated.
39 * Read the value for the AMP gain control.
41 static int speaker_gain_get(struct snd_kcontrol *kcontrol,
42 struct snd_ctl_elem_value *ucontrol)
44 ucontrol->value.integer.value[0] = spk_gain;
45 return 0;
48 /**
49 * speaker_gain_set - set the value of the speaker amp gain
50 * @value: The value to write.
52 static void speaker_gain_set(int value)
54 gpio_set_value_cansleep(pdata->amp_gain[0], value & 1);
55 gpio_set_value_cansleep(pdata->amp_gain[1], value >> 1);
58 /**
59 * speaker_gain_put - set the speaker gain setting.
60 * @kcontrol: The control for the speaker gain.
61 * @ucontrol: The value that needs to be set.
63 * Set the value of the speaker gain from the specified
64 * @ucontrol setting.
66 * Note, if the speaker amp is muted, then we do not set a gain value
67 * as at-least one of the ICs that is fitted will try and power up even
68 * if the main control is set to off.
70 static int speaker_gain_put(struct snd_kcontrol *kcontrol,
71 struct snd_ctl_elem_value *ucontrol)
73 int value = ucontrol->value.integer.value[0];
75 spk_gain = value;
77 if (!spk_unmute)
78 speaker_gain_set(value);
80 return 0;
83 static const struct snd_kcontrol_new amp_gain_controls[] = {
84 SOC_SINGLE_EXT("Speaker Gain", 0, 0, 3, 0,
85 speaker_gain_get, speaker_gain_put),
88 /**
89 * spk_unmute_state - set the unmute state of the speaker
90 * @to: zero to unmute, non-zero to ununmute.
92 static void spk_unmute_state(int to)
94 pr_debug("%s: to=%d\n", __func__, to);
96 spk_unmute = to;
97 gpio_set_value(pdata->amp_gpio, to);
99 /* if we're umuting, also re-set the gain */
100 if (to && pdata->amp_gain[0] > 0)
101 speaker_gain_set(spk_gain);
105 * speaker_unmute_get - read the speaker unmute setting.
106 * @kcontrol: The control for the speaker gain.
107 * @ucontrol: The value that needs to be updated.
109 * Read the value for the AMP gain control.
111 static int speaker_unmute_get(struct snd_kcontrol *kcontrol,
112 struct snd_ctl_elem_value *ucontrol)
114 ucontrol->value.integer.value[0] = spk_unmute;
115 return 0;
119 * speaker_unmute_put - set the speaker unmute setting.
120 * @kcontrol: The control for the speaker gain.
121 * @ucontrol: The value that needs to be set.
123 * Set the value of the speaker gain from the specified
124 * @ucontrol setting.
126 static int speaker_unmute_put(struct snd_kcontrol *kcontrol,
127 struct snd_ctl_elem_value *ucontrol)
129 spk_unmute_state(ucontrol->value.integer.value[0]);
130 return 0;
133 /* This is added as a manual control as the speaker amps create clicks
134 * when their power state is changed, which are far more noticeable than
135 * anything produced by the CODEC itself.
137 static const struct snd_kcontrol_new amp_unmute_controls[] = {
138 SOC_SINGLE_EXT("Speaker Switch", 0, 0, 1, 0,
139 speaker_unmute_get, speaker_unmute_put),
142 void simtec_audio_init(struct snd_soc_codec *codec)
144 if (pdata->amp_gpio > 0) {
145 pr_debug("%s: adding amp routes\n", __func__);
147 snd_soc_add_controls(codec, amp_unmute_controls,
148 ARRAY_SIZE(amp_unmute_controls));
151 if (pdata->amp_gain[0] > 0) {
152 pr_debug("%s: adding amp controls\n", __func__);
153 snd_soc_add_controls(codec, amp_gain_controls,
154 ARRAY_SIZE(amp_gain_controls));
157 EXPORT_SYMBOL_GPL(simtec_audio_init);
159 #define CODEC_CLOCK 12000000
162 * simtec_hw_params - update hardware parameters
163 * @substream: The audio substream instance.
164 * @params: The parameters requested.
166 * Update the codec data routing and configuration settings
167 * from the supplied data.
169 static int simtec_hw_params(struct snd_pcm_substream *substream,
170 struct snd_pcm_hw_params *params)
172 struct snd_soc_pcm_runtime *rtd = substream->private_data;
173 struct snd_soc_dai *codec_dai = rtd->dai->codec_dai;
174 struct snd_soc_dai *cpu_dai = rtd->dai->cpu_dai;
175 int ret;
177 /* Set the CODEC as the bus clock master, I2S */
178 ret = snd_soc_dai_set_fmt(cpu_dai, SND_SOC_DAIFMT_I2S |
179 SND_SOC_DAIFMT_NB_NF |
180 SND_SOC_DAIFMT_CBM_CFM);
181 if (ret) {
182 pr_err("%s: failed set cpu dai format\n", __func__);
183 return ret;
186 /* Set the CODEC as the bus clock master */
187 ret = snd_soc_dai_set_fmt(codec_dai, SND_SOC_DAIFMT_I2S |
188 SND_SOC_DAIFMT_NB_NF |
189 SND_SOC_DAIFMT_CBM_CFM);
190 if (ret) {
191 pr_err("%s: failed set codec dai format\n", __func__);
192 return ret;
195 ret = snd_soc_dai_set_sysclk(codec_dai, 0,
196 CODEC_CLOCK, SND_SOC_CLOCK_IN);
197 if (ret) {
198 pr_err( "%s: failed setting codec sysclk\n", __func__);
199 return ret;
202 if (pdata->use_mpllin) {
203 ret = snd_soc_dai_set_sysclk(cpu_dai, S3C24XX_CLKSRC_MPLL,
204 0, SND_SOC_CLOCK_OUT);
206 if (ret) {
207 pr_err("%s: failed to set MPLLin as clksrc\n",
208 __func__);
209 return ret;
213 if (pdata->output_cdclk) {
214 int cdclk_scale;
216 cdclk_scale = clk_get_rate(xtal_clk) / CODEC_CLOCK;
217 cdclk_scale--;
219 ret = snd_soc_dai_set_clkdiv(cpu_dai, S3C24XX_DIV_PRESCALER,
220 cdclk_scale);
223 return 0;
226 static int simtec_call_startup(struct s3c24xx_audio_simtec_pdata *pd)
228 /* call any board supplied startup code, this currently only
229 * covers the bast/vr1000 which have a CPLD in the way of the
230 * LRCLK */
231 if (pd->startup)
232 pd->startup();
234 return 0;
237 static struct snd_soc_ops simtec_snd_ops = {
238 .hw_params = simtec_hw_params,
242 * attach_gpio_amp - get and configure the necessary gpios
243 * @dev: The device we're probing.
244 * @pd: The platform data supplied by the board.
246 * If there is a GPIO based amplifier attached to the board, claim
247 * the necessary GPIO lines for it, and set default values.
249 static int attach_gpio_amp(struct device *dev,
250 struct s3c24xx_audio_simtec_pdata *pd)
252 int ret;
254 /* attach gpio amp gain (if any) */
255 if (pdata->amp_gain[0] > 0) {
256 ret = gpio_request(pd->amp_gain[0], "gpio-amp-gain0");
257 if (ret) {
258 dev_err(dev, "cannot get amp gpio gain0\n");
259 return ret;
262 ret = gpio_request(pd->amp_gain[1], "gpio-amp-gain1");
263 if (ret) {
264 dev_err(dev, "cannot get amp gpio gain1\n");
265 gpio_free(pdata->amp_gain[0]);
266 return ret;
269 gpio_direction_output(pd->amp_gain[0], 0);
270 gpio_direction_output(pd->amp_gain[1], 0);
273 /* note, currently we assume GPA0 isn't valid amp */
274 if (pdata->amp_gpio > 0) {
275 ret = gpio_request(pd->amp_gpio, "gpio-amp");
276 if (ret) {
277 dev_err(dev, "cannot get amp gpio %d (%d)\n",
278 pd->amp_gpio, ret);
279 goto err_amp;
282 /* set the amp off at startup */
283 spk_unmute_state(0);
286 return 0;
288 err_amp:
289 if (pd->amp_gain[0] > 0) {
290 gpio_free(pd->amp_gain[0]);
291 gpio_free(pd->amp_gain[1]);
294 return ret;
297 static void detach_gpio_amp(struct s3c24xx_audio_simtec_pdata *pd)
299 if (pd->amp_gain[0] > 0) {
300 gpio_free(pd->amp_gain[0]);
301 gpio_free(pd->amp_gain[1]);
304 if (pd->amp_gpio > 0)
305 gpio_free(pd->amp_gpio);
308 #ifdef CONFIG_PM
309 int simtec_audio_resume(struct device *dev)
311 simtec_call_startup(pdata);
312 return 0;
315 const struct dev_pm_ops simtec_audio_pmops = {
316 .resume = simtec_audio_resume,
318 EXPORT_SYMBOL_GPL(simtec_audio_pmops);
319 #endif
321 int __devinit simtec_audio_core_probe(struct platform_device *pdev,
322 struct snd_soc_device *socdev)
324 struct platform_device *snd_dev;
325 int ret;
327 socdev->card->dai_link->ops = &simtec_snd_ops;
329 pdata = pdev->dev.platform_data;
330 if (!pdata) {
331 dev_err(&pdev->dev, "no platform data supplied\n");
332 return -EINVAL;
335 simtec_call_startup(pdata);
337 xtal_clk = clk_get(&pdev->dev, "xtal");
338 if (IS_ERR(xtal_clk)) {
339 dev_err(&pdev->dev, "could not get clkout0\n");
340 return -EINVAL;
343 dev_info(&pdev->dev, "xtal rate is %ld\n", clk_get_rate(xtal_clk));
345 ret = attach_gpio_amp(&pdev->dev, pdata);
346 if (ret)
347 goto err_clk;
349 snd_dev = platform_device_alloc("soc-audio", -1);
350 if (!snd_dev) {
351 dev_err(&pdev->dev, "failed to alloc soc-audio devicec\n");
352 ret = -ENOMEM;
353 goto err_gpio;
356 platform_set_drvdata(snd_dev, socdev);
357 socdev->dev = &snd_dev->dev;
359 ret = platform_device_add(snd_dev);
360 if (ret) {
361 dev_err(&pdev->dev, "failed to add soc-audio dev\n");
362 goto err_pdev;
365 platform_set_drvdata(pdev, snd_dev);
366 return 0;
368 err_pdev:
369 platform_device_put(snd_dev);
371 err_gpio:
372 detach_gpio_amp(pdata);
374 err_clk:
375 clk_put(xtal_clk);
376 return ret;
378 EXPORT_SYMBOL_GPL(simtec_audio_core_probe);
380 int __devexit simtec_audio_remove(struct platform_device *pdev)
382 struct platform_device *snd_dev = platform_get_drvdata(pdev);
384 platform_device_unregister(snd_dev);
386 detach_gpio_amp(pdata);
387 clk_put(xtal_clk);
388 return 0;
390 EXPORT_SYMBOL_GPL(simtec_audio_remove);
392 MODULE_AUTHOR("Ben Dooks <ben@simtec.co.uk>");
393 MODULE_DESCRIPTION("ALSA SoC Simtec Audio common support");
394 MODULE_LICENSE("GPL");