treewide: remove redundant IS_ERR() before error code check
[linux/fpc-iii.git] / sound / soc / samsung / speyside.c
blobea0d1ec67f0101fc565c60d3b4c36d4e053d022d
1 // SPDX-License-Identifier: GPL-2.0+
2 //
3 // Speyside audio support
4 //
5 // Copyright 2011 Wolfson Microelectronics
7 #include <sound/soc.h>
8 #include <sound/soc-dapm.h>
9 #include <sound/jack.h>
10 #include <linux/gpio.h>
11 #include <linux/module.h>
13 #include "../codecs/wm8996.h"
14 #include "../codecs/wm9081.h"
16 #define WM8996_HPSEL_GPIO 214
17 #define MCLK_AUDIO_RATE (512 * 48000)
19 static int speyside_set_bias_level(struct snd_soc_card *card,
20 struct snd_soc_dapm_context *dapm,
21 enum snd_soc_bias_level level)
23 struct snd_soc_pcm_runtime *rtd;
24 struct snd_soc_dai *codec_dai;
25 int ret;
27 rtd = snd_soc_get_pcm_runtime(card, &card->dai_link[1]);
28 codec_dai = rtd->codec_dai;
30 if (dapm->dev != codec_dai->dev)
31 return 0;
33 switch (level) {
34 case SND_SOC_BIAS_STANDBY:
35 ret = snd_soc_dai_set_sysclk(codec_dai, WM8996_SYSCLK_MCLK2,
36 32768, SND_SOC_CLOCK_IN);
37 if (ret < 0)
38 return ret;
40 ret = snd_soc_dai_set_pll(codec_dai, WM8996_FLL_MCLK2,
41 0, 0, 0);
42 if (ret < 0) {
43 pr_err("Failed to stop FLL\n");
44 return ret;
46 break;
48 default:
49 break;
52 return 0;
55 static int speyside_set_bias_level_post(struct snd_soc_card *card,
56 struct snd_soc_dapm_context *dapm,
57 enum snd_soc_bias_level level)
59 struct snd_soc_pcm_runtime *rtd;
60 struct snd_soc_dai *codec_dai;
61 int ret;
63 rtd = snd_soc_get_pcm_runtime(card, &card->dai_link[1]);
64 codec_dai = rtd->codec_dai;
66 if (dapm->dev != codec_dai->dev)
67 return 0;
69 switch (level) {
70 case SND_SOC_BIAS_PREPARE:
71 if (card->dapm.bias_level == SND_SOC_BIAS_STANDBY) {
72 ret = snd_soc_dai_set_pll(codec_dai, 0,
73 WM8996_FLL_MCLK2,
74 32768, MCLK_AUDIO_RATE);
75 if (ret < 0) {
76 pr_err("Failed to start FLL\n");
77 return ret;
80 ret = snd_soc_dai_set_sysclk(codec_dai,
81 WM8996_SYSCLK_FLL,
82 MCLK_AUDIO_RATE,
83 SND_SOC_CLOCK_IN);
84 if (ret < 0)
85 return ret;
87 break;
89 default:
90 break;
93 card->dapm.bias_level = level;
95 return 0;
98 static struct snd_soc_jack speyside_headset;
100 /* Headset jack detection DAPM pins */
101 static struct snd_soc_jack_pin speyside_headset_pins[] = {
103 .pin = "Headset Mic",
104 .mask = SND_JACK_MICROPHONE,
108 /* Default the headphone selection to active high */
109 static int speyside_jack_polarity;
111 static int speyside_get_micbias(struct snd_soc_dapm_widget *source,
112 struct snd_soc_dapm_widget *sink)
114 if (speyside_jack_polarity && (strcmp(source->name, "MICB1") == 0))
115 return 1;
116 if (!speyside_jack_polarity && (strcmp(source->name, "MICB2") == 0))
117 return 1;
119 return 0;
122 static void speyside_set_polarity(struct snd_soc_component *component,
123 int polarity)
125 speyside_jack_polarity = !polarity;
126 gpio_direction_output(WM8996_HPSEL_GPIO, speyside_jack_polarity);
128 /* Re-run DAPM to make sure we're using the correct mic bias */
129 snd_soc_dapm_sync(snd_soc_component_get_dapm(component));
132 static int speyside_wm0010_init(struct snd_soc_pcm_runtime *rtd)
134 struct snd_soc_dai *dai = rtd->codec_dai;
135 int ret;
137 ret = snd_soc_dai_set_sysclk(dai, 0, MCLK_AUDIO_RATE, 0);
138 if (ret < 0)
139 return ret;
141 return 0;
144 static int speyside_wm8996_init(struct snd_soc_pcm_runtime *rtd)
146 struct snd_soc_dai *dai = rtd->codec_dai;
147 struct snd_soc_component *component = dai->component;
148 int ret;
150 ret = snd_soc_dai_set_sysclk(dai, WM8996_SYSCLK_MCLK2, 32768, 0);
151 if (ret < 0)
152 return ret;
154 ret = gpio_request(WM8996_HPSEL_GPIO, "HP_SEL");
155 if (ret != 0)
156 pr_err("Failed to request HP_SEL GPIO: %d\n", ret);
157 gpio_direction_output(WM8996_HPSEL_GPIO, speyside_jack_polarity);
159 ret = snd_soc_card_jack_new(rtd->card, "Headset", SND_JACK_LINEOUT |
160 SND_JACK_HEADSET | SND_JACK_BTN_0,
161 &speyside_headset, speyside_headset_pins,
162 ARRAY_SIZE(speyside_headset_pins));
163 if (ret)
164 return ret;
166 wm8996_detect(component, &speyside_headset, speyside_set_polarity);
168 return 0;
171 static int speyside_late_probe(struct snd_soc_card *card)
173 snd_soc_dapm_ignore_suspend(&card->dapm, "Headphone");
174 snd_soc_dapm_ignore_suspend(&card->dapm, "Headset Mic");
175 snd_soc_dapm_ignore_suspend(&card->dapm, "Main AMIC");
176 snd_soc_dapm_ignore_suspend(&card->dapm, "Main DMIC");
177 snd_soc_dapm_ignore_suspend(&card->dapm, "Main Speaker");
178 snd_soc_dapm_ignore_suspend(&card->dapm, "WM1250 Output");
179 snd_soc_dapm_ignore_suspend(&card->dapm, "WM1250 Input");
181 return 0;
184 static const struct snd_soc_pcm_stream dsp_codec_params = {
185 .formats = SNDRV_PCM_FMTBIT_S32_LE,
186 .rate_min = 48000,
187 .rate_max = 48000,
188 .channels_min = 2,
189 .channels_max = 2,
192 SND_SOC_DAILINK_DEFS(cpu_dsp,
193 DAILINK_COMP_ARRAY(COMP_CPU("samsung-i2s.0")),
194 DAILINK_COMP_ARRAY(COMP_CODEC("spi0.0", "wm0010-sdi1")),
195 DAILINK_COMP_ARRAY(COMP_PLATFORM("samsung-i2s.0")));
197 SND_SOC_DAILINK_DEFS(dsp_codec,
198 DAILINK_COMP_ARRAY(COMP_CPU("wm0010-sdi2")),
199 DAILINK_COMP_ARRAY(COMP_CODEC("wm8996.1-001a", "wm8996-aif1")));
201 SND_SOC_DAILINK_DEFS(baseband,
202 DAILINK_COMP_ARRAY(COMP_CPU("wm8996-aif2")),
203 DAILINK_COMP_ARRAY(COMP_CODEC("wm1250-ev1.1-0027", "wm1250-ev1")));
205 static struct snd_soc_dai_link speyside_dai[] = {
207 .name = "CPU-DSP",
208 .stream_name = "CPU-DSP",
209 .init = speyside_wm0010_init,
210 .dai_fmt = SND_SOC_DAIFMT_I2S | SND_SOC_DAIFMT_NB_NF
211 | SND_SOC_DAIFMT_CBM_CFM,
212 SND_SOC_DAILINK_REG(cpu_dsp),
215 .name = "DSP-CODEC",
216 .stream_name = "DSP-CODEC",
217 .init = speyside_wm8996_init,
218 .dai_fmt = SND_SOC_DAIFMT_I2S | SND_SOC_DAIFMT_NB_NF
219 | SND_SOC_DAIFMT_CBM_CFM,
220 .params = &dsp_codec_params,
221 .ignore_suspend = 1,
222 SND_SOC_DAILINK_REG(dsp_codec),
225 .name = "Baseband",
226 .stream_name = "Baseband",
227 .dai_fmt = SND_SOC_DAIFMT_I2S | SND_SOC_DAIFMT_NB_NF
228 | SND_SOC_DAIFMT_CBM_CFM,
229 .ignore_suspend = 1,
230 SND_SOC_DAILINK_REG(baseband),
234 static int speyside_wm9081_init(struct snd_soc_component *component)
236 /* At any time the WM9081 is active it will have this clock */
237 return snd_soc_component_set_sysclk(component, WM9081_SYSCLK_MCLK, 0,
238 MCLK_AUDIO_RATE, 0);
241 static struct snd_soc_aux_dev speyside_aux_dev[] = {
243 .dlc = COMP_AUX("wm9081.1-006c"),
244 .init = speyside_wm9081_init,
248 static struct snd_soc_codec_conf speyside_codec_conf[] = {
250 .dlc = COMP_CODEC_CONF("wm9081.1-006c"),
251 .name_prefix = "Sub",
255 static const struct snd_kcontrol_new controls[] = {
256 SOC_DAPM_PIN_SWITCH("Main Speaker"),
257 SOC_DAPM_PIN_SWITCH("Main DMIC"),
258 SOC_DAPM_PIN_SWITCH("Main AMIC"),
259 SOC_DAPM_PIN_SWITCH("WM1250 Input"),
260 SOC_DAPM_PIN_SWITCH("WM1250 Output"),
261 SOC_DAPM_PIN_SWITCH("Headphone"),
264 static struct snd_soc_dapm_widget widgets[] = {
265 SND_SOC_DAPM_HP("Headphone", NULL),
266 SND_SOC_DAPM_MIC("Headset Mic", NULL),
268 SND_SOC_DAPM_SPK("Main Speaker", NULL),
270 SND_SOC_DAPM_MIC("Main AMIC", NULL),
271 SND_SOC_DAPM_MIC("Main DMIC", NULL),
274 static struct snd_soc_dapm_route audio_paths[] = {
275 { "IN1RN", NULL, "MICB1" },
276 { "IN1RP", NULL, "MICB1" },
277 { "IN1RN", NULL, "MICB2" },
278 { "IN1RP", NULL, "MICB2" },
279 { "MICB1", NULL, "Headset Mic", speyside_get_micbias },
280 { "MICB2", NULL, "Headset Mic", speyside_get_micbias },
282 { "IN1LP", NULL, "MICB2" },
283 { "IN1RN", NULL, "MICB1" },
284 { "MICB2", NULL, "Main AMIC" },
286 { "DMIC1DAT", NULL, "MICB1" },
287 { "DMIC2DAT", NULL, "MICB1" },
288 { "MICB1", NULL, "Main DMIC" },
290 { "Headphone", NULL, "HPOUT1L" },
291 { "Headphone", NULL, "HPOUT1R" },
293 { "Sub IN1", NULL, "HPOUT2L" },
294 { "Sub IN2", NULL, "HPOUT2R" },
296 { "Main Speaker", NULL, "Sub SPKN" },
297 { "Main Speaker", NULL, "Sub SPKP" },
298 { "Main Speaker", NULL, "SPKDAT" },
301 static struct snd_soc_card speyside = {
302 .name = "Speyside",
303 .owner = THIS_MODULE,
304 .dai_link = speyside_dai,
305 .num_links = ARRAY_SIZE(speyside_dai),
306 .aux_dev = speyside_aux_dev,
307 .num_aux_devs = ARRAY_SIZE(speyside_aux_dev),
308 .codec_conf = speyside_codec_conf,
309 .num_configs = ARRAY_SIZE(speyside_codec_conf),
311 .set_bias_level = speyside_set_bias_level,
312 .set_bias_level_post = speyside_set_bias_level_post,
314 .controls = controls,
315 .num_controls = ARRAY_SIZE(controls),
316 .dapm_widgets = widgets,
317 .num_dapm_widgets = ARRAY_SIZE(widgets),
318 .dapm_routes = audio_paths,
319 .num_dapm_routes = ARRAY_SIZE(audio_paths),
320 .fully_routed = true,
322 .late_probe = speyside_late_probe,
325 static int speyside_probe(struct platform_device *pdev)
327 struct snd_soc_card *card = &speyside;
328 int ret;
330 card->dev = &pdev->dev;
332 ret = devm_snd_soc_register_card(&pdev->dev, card);
333 if (ret)
334 dev_err(&pdev->dev, "snd_soc_register_card() failed: %d\n",
335 ret);
337 return ret;
340 static struct platform_driver speyside_driver = {
341 .driver = {
342 .name = "speyside",
343 .pm = &snd_soc_pm_ops,
345 .probe = speyside_probe,
348 module_platform_driver(speyside_driver);
350 MODULE_DESCRIPTION("Speyside audio support");
351 MODULE_AUTHOR("Mark Brown <broonie@opensource.wolfsonmicro.com>");
352 MODULE_LICENSE("GPL");
353 MODULE_ALIAS("platform:speyside");