treewide: remove redundant IS_ERR() before error code check
[linux/fpc-iii.git] / sound / soc / atmel / sam9g20_wm8731.c
blobb1bef2bf142dc1e392b284f262f08933f1346a65
1 // SPDX-License-Identifier: GPL-2.0-or-later
2 /*
3 * sam9g20_wm8731 -- SoC audio for AT91SAM9G20-based
4 * ATMEL AT91SAM9G20ek board.
6 * Copyright (C) 2005 SAN People
7 * Copyright (C) 2008 Atmel
9 * Authors: Sedji Gaouaou <sedji.gaouaou@atmel.com>
11 * Based on ati_b1_wm8731.c by:
12 * Frank Mandarino <fmandarino@endrelia.com>
13 * Copyright 2006 Endrelia Technologies Inc.
14 * Based on corgi.c by:
15 * Copyright 2005 Wolfson Microelectronics PLC.
16 * Copyright 2005 Openedhand Ltd.
19 #include <linux/module.h>
20 #include <linux/moduleparam.h>
21 #include <linux/kernel.h>
22 #include <linux/clk.h>
23 #include <linux/timer.h>
24 #include <linux/interrupt.h>
25 #include <linux/platform_device.h>
26 #include <linux/i2c.h>
27 #include <linux/of.h>
29 #include <linux/atmel-ssc.h>
31 #include <sound/core.h>
32 #include <sound/pcm.h>
33 #include <sound/pcm_params.h>
34 #include <sound/soc.h>
36 #include "../codecs/wm8731.h"
37 #include "atmel-pcm.h"
38 #include "atmel_ssc_dai.h"
40 #define MCLK_RATE 12000000
43 * As shipped the board does not have inputs. However, it is relatively
44 * straightforward to modify the board to hook them up so support is left
45 * in the driver.
47 #undef ENABLE_MIC_INPUT
49 static struct clk *mclk;
51 static int at91sam9g20ek_set_bias_level(struct snd_soc_card *card,
52 struct snd_soc_dapm_context *dapm,
53 enum snd_soc_bias_level level)
55 static int mclk_on;
56 int ret = 0;
58 switch (level) {
59 case SND_SOC_BIAS_ON:
60 case SND_SOC_BIAS_PREPARE:
61 if (!mclk_on)
62 ret = clk_enable(mclk);
63 if (ret == 0)
64 mclk_on = 1;
65 break;
67 case SND_SOC_BIAS_OFF:
68 case SND_SOC_BIAS_STANDBY:
69 if (mclk_on)
70 clk_disable(mclk);
71 mclk_on = 0;
72 break;
75 return ret;
78 static const struct snd_soc_dapm_widget at91sam9g20ek_dapm_widgets[] = {
79 SND_SOC_DAPM_MIC("Int Mic", NULL),
80 SND_SOC_DAPM_SPK("Ext Spk", NULL),
83 static const struct snd_soc_dapm_route intercon[] = {
85 /* speaker connected to LHPOUT/RHPOUT */
86 {"Ext Spk", NULL, "LHPOUT"},
87 {"Ext Spk", NULL, "RHPOUT"},
89 /* mic is connected to Mic Jack, with WM8731 Mic Bias */
90 {"MICIN", NULL, "Mic Bias"},
91 {"Mic Bias", NULL, "Int Mic"},
95 * Logic for a wm8731 as connected on a at91sam9g20ek board.
97 static int at91sam9g20ek_wm8731_init(struct snd_soc_pcm_runtime *rtd)
99 struct snd_soc_dai *codec_dai = rtd->codec_dai;
100 struct device *dev = rtd->dev;
101 int ret;
103 dev_dbg(dev, "%s called\n", __func__);
105 ret = snd_soc_dai_set_sysclk(codec_dai, WM8731_SYSCLK_MCLK,
106 MCLK_RATE, SND_SOC_CLOCK_IN);
107 if (ret < 0) {
108 dev_err(dev, "Failed to set WM8731 SYSCLK: %d\n", ret);
109 return ret;
112 #ifndef ENABLE_MIC_INPUT
113 snd_soc_dapm_nc_pin(&rtd->card->dapm, "Int Mic");
114 #endif
116 return 0;
119 SND_SOC_DAILINK_DEFS(pcm,
120 DAILINK_COMP_ARRAY(COMP_CPU("at91rm9200_ssc.0")),
121 DAILINK_COMP_ARRAY(COMP_CODEC("wm8731.0-001b", "wm8731-hifi")),
122 DAILINK_COMP_ARRAY(COMP_PLATFORM("at91rm9200_ssc.0")));
124 static struct snd_soc_dai_link at91sam9g20ek_dai = {
125 .name = "WM8731",
126 .stream_name = "WM8731 PCM",
127 .init = at91sam9g20ek_wm8731_init,
128 .dai_fmt = SND_SOC_DAIFMT_I2S | SND_SOC_DAIFMT_NB_NF |
129 SND_SOC_DAIFMT_CBM_CFM,
130 SND_SOC_DAILINK_REG(pcm),
133 static struct snd_soc_card snd_soc_at91sam9g20ek = {
134 .name = "AT91SAMG20-EK",
135 .owner = THIS_MODULE,
136 .dai_link = &at91sam9g20ek_dai,
137 .num_links = 1,
138 .set_bias_level = at91sam9g20ek_set_bias_level,
140 .dapm_widgets = at91sam9g20ek_dapm_widgets,
141 .num_dapm_widgets = ARRAY_SIZE(at91sam9g20ek_dapm_widgets),
142 .dapm_routes = intercon,
143 .num_dapm_routes = ARRAY_SIZE(intercon),
144 .fully_routed = true,
147 static int at91sam9g20ek_audio_probe(struct platform_device *pdev)
149 struct device_node *np = pdev->dev.of_node;
150 struct device_node *codec_np, *cpu_np;
151 struct clk *pllb;
152 struct snd_soc_card *card = &snd_soc_at91sam9g20ek;
153 int ret;
155 if (!np) {
156 return -ENODEV;
159 ret = atmel_ssc_set_audio(0);
160 if (ret) {
161 dev_err(&pdev->dev, "ssc channel is not valid\n");
162 return -EINVAL;
166 * Codec MCLK is supplied by PCK0 - set it up.
168 mclk = clk_get(NULL, "pck0");
169 if (IS_ERR(mclk)) {
170 dev_err(&pdev->dev, "Failed to get MCLK\n");
171 ret = PTR_ERR(mclk);
172 goto err;
175 pllb = clk_get(NULL, "pllb");
176 if (IS_ERR(pllb)) {
177 dev_err(&pdev->dev, "Failed to get PLLB\n");
178 ret = PTR_ERR(pllb);
179 goto err_mclk;
181 ret = clk_set_parent(mclk, pllb);
182 clk_put(pllb);
183 if (ret != 0) {
184 dev_err(&pdev->dev, "Failed to set MCLK parent\n");
185 goto err_mclk;
188 clk_set_rate(mclk, MCLK_RATE);
190 card->dev = &pdev->dev;
192 /* Parse device node info */
193 ret = snd_soc_of_parse_card_name(card, "atmel,model");
194 if (ret)
195 goto err;
197 ret = snd_soc_of_parse_audio_routing(card,
198 "atmel,audio-routing");
199 if (ret)
200 goto err;
202 /* Parse codec info */
203 at91sam9g20ek_dai.codecs->name = NULL;
204 codec_np = of_parse_phandle(np, "atmel,audio-codec", 0);
205 if (!codec_np) {
206 dev_err(&pdev->dev, "codec info missing\n");
207 return -EINVAL;
209 at91sam9g20ek_dai.codecs->of_node = codec_np;
211 /* Parse dai and platform info */
212 at91sam9g20ek_dai.cpus->dai_name = NULL;
213 at91sam9g20ek_dai.platforms->name = NULL;
214 cpu_np = of_parse_phandle(np, "atmel,ssc-controller", 0);
215 if (!cpu_np) {
216 dev_err(&pdev->dev, "dai and pcm info missing\n");
217 return -EINVAL;
219 at91sam9g20ek_dai.cpus->of_node = cpu_np;
220 at91sam9g20ek_dai.platforms->of_node = cpu_np;
222 of_node_put(codec_np);
223 of_node_put(cpu_np);
225 ret = snd_soc_register_card(card);
226 if (ret) {
227 dev_err(&pdev->dev, "snd_soc_register_card() failed\n");
230 return ret;
232 err_mclk:
233 clk_put(mclk);
234 mclk = NULL;
235 err:
236 atmel_ssc_put_audio(0);
237 return ret;
240 static int at91sam9g20ek_audio_remove(struct platform_device *pdev)
242 struct snd_soc_card *card = platform_get_drvdata(pdev);
244 clk_disable(mclk);
245 mclk = NULL;
246 snd_soc_unregister_card(card);
247 atmel_ssc_put_audio(0);
249 return 0;
252 #ifdef CONFIG_OF
253 static const struct of_device_id at91sam9g20ek_wm8731_dt_ids[] = {
254 { .compatible = "atmel,at91sam9g20ek-wm8731-audio", },
257 MODULE_DEVICE_TABLE(of, at91sam9g20ek_wm8731_dt_ids);
258 #endif
260 static struct platform_driver at91sam9g20ek_audio_driver = {
261 .driver = {
262 .name = "at91sam9g20ek-audio",
263 .of_match_table = of_match_ptr(at91sam9g20ek_wm8731_dt_ids),
265 .probe = at91sam9g20ek_audio_probe,
266 .remove = at91sam9g20ek_audio_remove,
269 module_platform_driver(at91sam9g20ek_audio_driver);
271 /* Module information */
272 MODULE_AUTHOR("Sedji Gaouaou <sedji.gaouaou@atmel.com>");
273 MODULE_DESCRIPTION("ALSA SoC AT91SAM9G20EK_WM8731");
274 MODULE_ALIAS("platform:at91sam9g20ek-audio");
275 MODULE_LICENSE("GPL");