treewide: remove redundant IS_ERR() before error code check
[linux/fpc-iii.git] / sound / soc / samsung / s3c2412-i2s.c
blob787a3f6e9f242235f581aec16c32e28b862d9903
1 // SPDX-License-Identifier: GPL-2.0+
2 //
3 // ALSA Soc Audio Layer - S3C2412 I2S driver
4 //
5 // Copyright (c) 2006 Wolfson Microelectronics PLC.
6 // Graeme Gregory graeme.gregory@wolfsonmicro.com
7 // linux@wolfsonmicro.com
8 //
9 // Copyright (c) 2007, 2004-2005 Simtec Electronics
10 // http://armlinux.simtec.co.uk/
11 // Ben Dooks <ben@simtec.co.uk>
13 #include <linux/delay.h>
14 #include <linux/gpio.h>
15 #include <linux/clk.h>
16 #include <linux/io.h>
17 #include <linux/module.h>
19 #include <sound/soc.h>
20 #include <sound/pcm_params.h>
22 #include <mach/gpio-samsung.h>
23 #include <plat/gpio-cfg.h>
25 #include "dma.h"
26 #include "regs-i2s-v2.h"
27 #include "s3c2412-i2s.h"
29 #include <linux/platform_data/asoc-s3c.h>
31 static struct snd_dmaengine_dai_dma_data s3c2412_i2s_pcm_stereo_out = {
32 .chan_name = "tx",
33 .addr_width = 4,
36 static struct snd_dmaengine_dai_dma_data s3c2412_i2s_pcm_stereo_in = {
37 .chan_name = "rx",
38 .addr_width = 4,
41 static struct s3c_i2sv2_info s3c2412_i2s;
43 static int s3c2412_i2s_probe(struct snd_soc_dai *dai)
45 int ret;
47 pr_debug("Entered %s\n", __func__);
49 snd_soc_dai_init_dma_data(dai, &s3c2412_i2s_pcm_stereo_out,
50 &s3c2412_i2s_pcm_stereo_in);
52 ret = s3c_i2sv2_probe(dai, &s3c2412_i2s, S3C2410_PA_IIS);
53 if (ret)
54 return ret;
56 s3c2412_i2s.dma_capture = &s3c2412_i2s_pcm_stereo_in;
57 s3c2412_i2s.dma_playback = &s3c2412_i2s_pcm_stereo_out;
59 s3c2412_i2s.iis_cclk = devm_clk_get(dai->dev, "i2sclk");
60 if (IS_ERR(s3c2412_i2s.iis_cclk)) {
61 pr_err("failed to get i2sclk clock\n");
62 ret = PTR_ERR(s3c2412_i2s.iis_cclk);
63 goto err;
66 /* Set MPLL as the source for IIS CLK */
68 clk_set_parent(s3c2412_i2s.iis_cclk, clk_get(NULL, "mpll"));
69 ret = clk_prepare_enable(s3c2412_i2s.iis_cclk);
70 if (ret)
71 goto err;
73 /* Configure the I2S pins (GPE0...GPE4) in correct mode */
74 s3c_gpio_cfgall_range(S3C2410_GPE(0), 5, S3C_GPIO_SFN(2),
75 S3C_GPIO_PULL_NONE);
77 return 0;
79 err:
80 s3c_i2sv2_cleanup(dai, &s3c2412_i2s);
82 return ret;
85 static int s3c2412_i2s_remove(struct snd_soc_dai *dai)
87 clk_disable_unprepare(s3c2412_i2s.iis_cclk);
88 s3c_i2sv2_cleanup(dai, &s3c2412_i2s);
90 return 0;
93 static int s3c2412_i2s_hw_params(struct snd_pcm_substream *substream,
94 struct snd_pcm_hw_params *params,
95 struct snd_soc_dai *cpu_dai)
97 struct s3c_i2sv2_info *i2s = snd_soc_dai_get_drvdata(cpu_dai);
98 u32 iismod;
100 pr_debug("Entered %s\n", __func__);
102 iismod = readl(i2s->regs + S3C2412_IISMOD);
103 pr_debug("%s: r: IISMOD: %x\n", __func__, iismod);
105 switch (params_width(params)) {
106 case 8:
107 iismod |= S3C2412_IISMOD_8BIT;
108 break;
109 case 16:
110 iismod &= ~S3C2412_IISMOD_8BIT;
111 break;
114 writel(iismod, i2s->regs + S3C2412_IISMOD);
115 pr_debug("%s: w: IISMOD: %x\n", __func__, iismod);
117 return 0;
120 #define S3C2412_I2S_RATES \
121 (SNDRV_PCM_RATE_8000 | SNDRV_PCM_RATE_11025 | SNDRV_PCM_RATE_16000 | \
122 SNDRV_PCM_RATE_22050 | SNDRV_PCM_RATE_32000 | SNDRV_PCM_RATE_44100 | \
123 SNDRV_PCM_RATE_48000 | SNDRV_PCM_RATE_88200 | SNDRV_PCM_RATE_96000)
125 static const struct snd_soc_dai_ops s3c2412_i2s_dai_ops = {
126 .hw_params = s3c2412_i2s_hw_params,
129 static struct snd_soc_dai_driver s3c2412_i2s_dai = {
130 .probe = s3c2412_i2s_probe,
131 .remove = s3c2412_i2s_remove,
132 .playback = {
133 .channels_min = 2,
134 .channels_max = 2,
135 .rates = S3C2412_I2S_RATES,
136 .formats = SNDRV_PCM_FMTBIT_S8 | SNDRV_PCM_FMTBIT_S16_LE,
138 .capture = {
139 .channels_min = 2,
140 .channels_max = 2,
141 .rates = S3C2412_I2S_RATES,
142 .formats = SNDRV_PCM_FMTBIT_S8 | SNDRV_PCM_FMTBIT_S16_LE,
144 .ops = &s3c2412_i2s_dai_ops,
147 static const struct snd_soc_component_driver s3c2412_i2s_component = {
148 .name = "s3c2412-i2s",
151 static int s3c2412_iis_dev_probe(struct platform_device *pdev)
153 int ret = 0;
154 struct resource *res;
155 struct s3c_audio_pdata *pdata = dev_get_platdata(&pdev->dev);
157 if (!pdata) {
158 dev_err(&pdev->dev, "missing platform data");
159 return -ENXIO;
162 res = platform_get_resource(pdev, IORESOURCE_MEM, 0);
163 s3c2412_i2s.regs = devm_ioremap_resource(&pdev->dev, res);
164 if (IS_ERR(s3c2412_i2s.regs))
165 return PTR_ERR(s3c2412_i2s.regs);
167 s3c2412_i2s_pcm_stereo_out.addr = res->start + S3C2412_IISTXD;
168 s3c2412_i2s_pcm_stereo_out.filter_data = pdata->dma_playback;
169 s3c2412_i2s_pcm_stereo_in.addr = res->start + S3C2412_IISRXD;
170 s3c2412_i2s_pcm_stereo_in.filter_data = pdata->dma_capture;
172 ret = samsung_asoc_dma_platform_register(&pdev->dev,
173 pdata->dma_filter,
174 "tx", "rx", NULL);
175 if (ret) {
176 pr_err("failed to register the DMA: %d\n", ret);
177 return ret;
180 ret = s3c_i2sv2_register_component(&pdev->dev, -1,
181 &s3c2412_i2s_component,
182 &s3c2412_i2s_dai);
183 if (ret)
184 pr_err("failed to register the dai\n");
186 return ret;
189 static struct platform_driver s3c2412_iis_driver = {
190 .probe = s3c2412_iis_dev_probe,
191 .driver = {
192 .name = "s3c2412-iis",
196 module_platform_driver(s3c2412_iis_driver);
198 /* Module information */
199 MODULE_AUTHOR("Ben Dooks, <ben@simtec.co.uk>");
200 MODULE_DESCRIPTION("S3C2412 I2S SoC Interface");
201 MODULE_LICENSE("GPL");
202 MODULE_ALIAS("platform:s3c2412-iis");