diff options
author | Damien.Horsley <Damien.Horsley@imgtec.com> | 2015-11-04 09:40:50 -0500 |
---|---|---|
committer | Mark Brown <broonie@kernel.org> | 2015-11-16 05:06:58 -0500 |
commit | d0e3992c939cb146a0de9e7c74a227e8be4629a9 (patch) | |
tree | 04e8e42d0d9aaa5151a46640ac8e5ce27f9fc25d /sound/soc/img | |
parent | 2dcfa06e0ecfc4de783ada9d37d0e9cef4f1eeda (diff) |
ASoC: img: Add driver for I2S output controller
Add driver for Imagination Technologies I2S output
controller
Signed-off-by: Damien.Horsley <Damien.Horsley@imgtec.com>
Signed-off-by: Mark Brown <broonie@kernel.org>
Diffstat (limited to 'sound/soc/img')
-rw-r--r-- | sound/soc/img/Kconfig | 8 | ||||
-rw-r--r-- | sound/soc/img/Makefile | 1 | ||||
-rw-r--r-- | sound/soc/img/img-i2s-out.c | 565 |
3 files changed, 574 insertions, 0 deletions
diff --git a/sound/soc/img/Kconfig b/sound/soc/img/Kconfig index f9f73d0323f1..fe83c8e344b2 100644 --- a/sound/soc/img/Kconfig +++ b/sound/soc/img/Kconfig | |||
@@ -10,3 +10,11 @@ config SND_SOC_IMG_I2S_IN | |||
10 | help | 10 | help |
11 | Say Y or M if you want to add support for I2S in driver for | 11 | Say Y or M if you want to add support for I2S in driver for |
12 | Imagination Technologies I2S in device. | 12 | Imagination Technologies I2S in device. |
13 | |||
14 | config SND_SOC_IMG_I2S_OUT | ||
15 | tristate "Imagination I2S Output Device Driver" | ||
16 | depends on SND_SOC_IMG | ||
17 | select SND_SOC_GENERIC_DMAENGINE_PCM | ||
18 | help | ||
19 | Say Y or M if you want to add support for I2S out driver for | ||
20 | Imagination Technologies I2S out device. | ||
diff --git a/sound/soc/img/Makefile b/sound/soc/img/Makefile index fe8426b369c2..c41a4af8dd89 100644 --- a/sound/soc/img/Makefile +++ b/sound/soc/img/Makefile | |||
@@ -1 +1,2 @@ | |||
1 | obj-$(CONFIG_SND_SOC_IMG_I2S_IN) += img-i2s-in.o | 1 | obj-$(CONFIG_SND_SOC_IMG_I2S_IN) += img-i2s-in.o |
2 | obj-$(CONFIG_SND_SOC_IMG_I2S_OUT) += img-i2s-out.o | ||
diff --git a/sound/soc/img/img-i2s-out.c b/sound/soc/img/img-i2s-out.c new file mode 100644 index 000000000000..5f997135a8ae --- /dev/null +++ b/sound/soc/img/img-i2s-out.c | |||
@@ -0,0 +1,565 @@ | |||
1 | /* | ||
2 | * IMG I2S output controller driver | ||
3 | * | ||
4 | * Copyright (C) 2015 Imagination Technologies Ltd. | ||
5 | * | ||
6 | * Author: Damien Horsley <Damien.Horsley@imgtec.com> | ||
7 | * | ||
8 | * This program is free software; you can redistribute it and/or modify it | ||
9 | * under the terms and conditions of the GNU General Public License, | ||
10 | * version 2, as published by the Free Software Foundation. | ||
11 | */ | ||
12 | |||
13 | #include <linux/clk.h> | ||
14 | #include <linux/init.h> | ||
15 | #include <linux/kernel.h> | ||
16 | #include <linux/module.h> | ||
17 | #include <linux/of.h> | ||
18 | #include <linux/platform_device.h> | ||
19 | #include <linux/pm_runtime.h> | ||
20 | #include <linux/reset.h> | ||
21 | |||
22 | #include <sound/core.h> | ||
23 | #include <sound/dmaengine_pcm.h> | ||
24 | #include <sound/initval.h> | ||
25 | #include <sound/pcm.h> | ||
26 | #include <sound/pcm_params.h> | ||
27 | #include <sound/soc.h> | ||
28 | |||
29 | #define IMG_I2S_OUT_TX_FIFO 0x0 | ||
30 | |||
31 | #define IMG_I2S_OUT_CTL 0x4 | ||
32 | #define IMG_I2S_OUT_CTL_DATA_EN_MASK BIT(24) | ||
33 | #define IMG_I2S_OUT_CTL_ACTIVE_CHAN_MASK 0xffe000 | ||
34 | #define IMG_I2S_OUT_CTL_ACTIVE_CHAN_SHIFT 13 | ||
35 | #define IMG_I2S_OUT_CTL_FRM_SIZE_MASK BIT(8) | ||
36 | #define IMG_I2S_OUT_CTL_MASTER_MASK BIT(6) | ||
37 | #define IMG_I2S_OUT_CTL_CLK_MASK BIT(5) | ||
38 | #define IMG_I2S_OUT_CTL_CLK_EN_MASK BIT(4) | ||
39 | #define IMG_I2S_OUT_CTL_FRM_CLK_POL_MASK BIT(3) | ||
40 | #define IMG_I2S_OUT_CTL_BCLK_POL_MASK BIT(2) | ||
41 | #define IMG_I2S_OUT_CTL_ME_MASK BIT(0) | ||
42 | |||
43 | #define IMG_I2S_OUT_CH_CTL 0x4 | ||
44 | #define IMG_I2S_OUT_CHAN_CTL_CH_MASK BIT(11) | ||
45 | #define IMG_I2S_OUT_CHAN_CTL_LT_MASK BIT(10) | ||
46 | #define IMG_I2S_OUT_CHAN_CTL_FMT_MASK 0xf0 | ||
47 | #define IMG_I2S_OUT_CHAN_CTL_FMT_SHIFT 4 | ||
48 | #define IMG_I2S_OUT_CHAN_CTL_JUST_MASK BIT(3) | ||
49 | #define IMG_I2S_OUT_CHAN_CTL_CLKT_MASK BIT(1) | ||
50 | #define IMG_I2S_OUT_CHAN_CTL_ME_MASK BIT(0) | ||
51 | |||
52 | #define IMG_I2S_OUT_CH_STRIDE 0x20 | ||
53 | |||
54 | struct img_i2s_out { | ||
55 | void __iomem *base; | ||
56 | struct clk *clk_sys; | ||
57 | struct clk *clk_ref; | ||
58 | struct snd_dmaengine_dai_dma_data dma_data; | ||
59 | struct device *dev; | ||
60 | unsigned int max_i2s_chan; | ||
61 | void __iomem *channel_base; | ||
62 | bool force_clk_active; | ||
63 | unsigned int active_channels; | ||
64 | struct reset_control *rst; | ||
65 | struct snd_soc_dai_driver dai_driver; | ||
66 | }; | ||
67 | |||
68 | static int img_i2s_out_suspend(struct device *dev) | ||
69 | { | ||
70 | struct img_i2s_out *i2s = dev_get_drvdata(dev); | ||
71 | |||
72 | if (!i2s->force_clk_active) | ||
73 | clk_disable_unprepare(i2s->clk_ref); | ||
74 | |||
75 | return 0; | ||
76 | } | ||
77 | |||
78 | static int img_i2s_out_resume(struct device *dev) | ||
79 | { | ||
80 | struct img_i2s_out *i2s = dev_get_drvdata(dev); | ||
81 | int ret; | ||
82 | |||
83 | if (!i2s->force_clk_active) { | ||
84 | ret = clk_prepare_enable(i2s->clk_ref); | ||
85 | if (ret) { | ||
86 | dev_err(dev, "clk_enable failed: %d\n", ret); | ||
87 | return ret; | ||
88 | } | ||
89 | } | ||
90 | |||
91 | return 0; | ||
92 | } | ||
93 | |||
94 | static inline void img_i2s_out_writel(struct img_i2s_out *i2s, u32 val, | ||
95 | u32 reg) | ||
96 | { | ||
97 | writel(val, i2s->base + reg); | ||
98 | } | ||
99 | |||
100 | static inline u32 img_i2s_out_readl(struct img_i2s_out *i2s, u32 reg) | ||
101 | { | ||
102 | return readl(i2s->base + reg); | ||
103 | } | ||
104 | |||
105 | static inline void img_i2s_out_ch_writel(struct img_i2s_out *i2s, | ||
106 | u32 chan, u32 val, u32 reg) | ||
107 | { | ||
108 | writel(val, i2s->channel_base + (chan * IMG_I2S_OUT_CH_STRIDE) + reg); | ||
109 | } | ||
110 | |||
111 | static inline u32 img_i2s_out_ch_readl(struct img_i2s_out *i2s, u32 chan, | ||
112 | u32 reg) | ||
113 | { | ||
114 | return readl(i2s->channel_base + (chan * IMG_I2S_OUT_CH_STRIDE) + reg); | ||
115 | } | ||
116 | |||
117 | static inline void img_i2s_out_ch_disable(struct img_i2s_out *i2s, u32 chan) | ||
118 | { | ||
119 | u32 reg; | ||
120 | |||
121 | reg = img_i2s_out_ch_readl(i2s, chan, IMG_I2S_OUT_CH_CTL); | ||
122 | reg &= ~IMG_I2S_OUT_CHAN_CTL_ME_MASK; | ||
123 | img_i2s_out_ch_writel(i2s, chan, reg, IMG_I2S_OUT_CH_CTL); | ||
124 | } | ||
125 | |||
126 | static inline void img_i2s_out_ch_enable(struct img_i2s_out *i2s, u32 chan) | ||
127 | { | ||
128 | u32 reg; | ||
129 | |||
130 | reg = img_i2s_out_ch_readl(i2s, chan, IMG_I2S_OUT_CH_CTL); | ||
131 | reg |= IMG_I2S_OUT_CHAN_CTL_ME_MASK; | ||
132 | img_i2s_out_ch_writel(i2s, chan, reg, IMG_I2S_OUT_CH_CTL); | ||
133 | } | ||
134 | |||
135 | static inline void img_i2s_out_disable(struct img_i2s_out *i2s) | ||
136 | { | ||
137 | u32 reg; | ||
138 | |||
139 | reg = img_i2s_out_readl(i2s, IMG_I2S_OUT_CTL); | ||
140 | reg &= ~IMG_I2S_OUT_CTL_ME_MASK; | ||
141 | img_i2s_out_writel(i2s, reg, IMG_I2S_OUT_CTL); | ||
142 | } | ||
143 | |||
144 | static inline void img_i2s_out_enable(struct img_i2s_out *i2s) | ||
145 | { | ||
146 | u32 reg; | ||
147 | |||
148 | reg = img_i2s_out_readl(i2s, IMG_I2S_OUT_CTL); | ||
149 | reg |= IMG_I2S_OUT_CTL_ME_MASK; | ||
150 | img_i2s_out_writel(i2s, reg, IMG_I2S_OUT_CTL); | ||
151 | } | ||
152 | |||
153 | static void img_i2s_out_reset(struct img_i2s_out *i2s) | ||
154 | { | ||
155 | int i; | ||
156 | u32 core_ctl, chan_ctl; | ||
157 | |||
158 | core_ctl = img_i2s_out_readl(i2s, IMG_I2S_OUT_CTL) & | ||
159 | ~IMG_I2S_OUT_CTL_ME_MASK & | ||
160 | ~IMG_I2S_OUT_CTL_DATA_EN_MASK; | ||
161 | |||
162 | if (!i2s->force_clk_active) | ||
163 | core_ctl &= ~IMG_I2S_OUT_CTL_CLK_EN_MASK; | ||
164 | |||
165 | chan_ctl = img_i2s_out_ch_readl(i2s, 0, IMG_I2S_OUT_CH_CTL) & | ||
166 | ~IMG_I2S_OUT_CHAN_CTL_ME_MASK; | ||
167 | |||
168 | reset_control_assert(i2s->rst); | ||
169 | reset_control_deassert(i2s->rst); | ||
170 | |||
171 | for (i = 0; i < i2s->max_i2s_chan; i++) | ||
172 | img_i2s_out_ch_writel(i2s, i, chan_ctl, IMG_I2S_OUT_CH_CTL); | ||
173 | |||
174 | for (i = 0; i < i2s->active_channels; i++) | ||
175 | img_i2s_out_ch_enable(i2s, i); | ||
176 | |||
177 | img_i2s_out_writel(i2s, core_ctl, IMG_I2S_OUT_CTL); | ||
178 | img_i2s_out_enable(i2s); | ||
179 | } | ||
180 | |||
181 | static int img_i2s_out_trigger(struct snd_pcm_substream *substream, int cmd, | ||
182 | struct snd_soc_dai *dai) | ||
183 | { | ||
184 | struct img_i2s_out *i2s = snd_soc_dai_get_drvdata(dai); | ||
185 | u32 reg; | ||
186 | |||
187 | switch (cmd) { | ||
188 | case SNDRV_PCM_TRIGGER_START: | ||
189 | case SNDRV_PCM_TRIGGER_RESUME: | ||
190 | case SNDRV_PCM_TRIGGER_PAUSE_RELEASE: | ||
191 | reg = img_i2s_out_readl(i2s, IMG_I2S_OUT_CTL); | ||
192 | if (!i2s->force_clk_active) | ||
193 | reg |= IMG_I2S_OUT_CTL_CLK_EN_MASK; | ||
194 | reg |= IMG_I2S_OUT_CTL_DATA_EN_MASK; | ||
195 | img_i2s_out_writel(i2s, reg, IMG_I2S_OUT_CTL); | ||
196 | break; | ||
197 | case SNDRV_PCM_TRIGGER_STOP: | ||
198 | case SNDRV_PCM_TRIGGER_SUSPEND: | ||
199 | case SNDRV_PCM_TRIGGER_PAUSE_PUSH: | ||
200 | img_i2s_out_reset(i2s); | ||
201 | break; | ||
202 | default: | ||
203 | return -EINVAL; | ||
204 | } | ||
205 | |||
206 | return 0; | ||
207 | } | ||
208 | |||
209 | static int img_i2s_out_hw_params(struct snd_pcm_substream *substream, | ||
210 | struct snd_pcm_hw_params *params, struct snd_soc_dai *dai) | ||
211 | { | ||
212 | struct img_i2s_out *i2s = snd_soc_dai_get_drvdata(dai); | ||
213 | unsigned int channels, i2s_channels; | ||
214 | long pre_div_a, pre_div_b, diff_a, diff_b, rate, clk_rate; | ||
215 | int i; | ||
216 | u32 reg, control_mask, control_set = 0; | ||
217 | snd_pcm_format_t format; | ||
218 | |||
219 | rate = params_rate(params); | ||
220 | format = params_format(params); | ||
221 | channels = params_channels(params); | ||
222 | i2s_channels = channels / 2; | ||
223 | |||
224 | if (format != SNDRV_PCM_FORMAT_S32_LE) | ||
225 | return -EINVAL; | ||
226 | |||
227 | if ((channels < 2) || | ||
228 | (channels > (i2s->max_i2s_chan * 2)) || | ||
229 | (channels % 2)) | ||
230 | return -EINVAL; | ||
231 | |||
232 | pre_div_a = clk_round_rate(i2s->clk_ref, rate * 256); | ||
233 | if (pre_div_a < 0) | ||
234 | return pre_div_a; | ||
235 | pre_div_b = clk_round_rate(i2s->clk_ref, rate * 384); | ||
236 | if (pre_div_b < 0) | ||
237 | return pre_div_b; | ||
238 | |||
239 | diff_a = abs((pre_div_a / 256) - rate); | ||
240 | diff_b = abs((pre_div_b / 384) - rate); | ||
241 | |||
242 | /* If diffs are equal, use lower clock rate */ | ||
243 | if (diff_a > diff_b) | ||
244 | clk_set_rate(i2s->clk_ref, pre_div_b); | ||
245 | else | ||
246 | clk_set_rate(i2s->clk_ref, pre_div_a); | ||
247 | |||
248 | /* | ||
249 | * Another driver (eg alsa machine driver) may have rejected the above | ||
250 | * change. Get the current rate and set the register bit according to | ||
251 | * the new minimum diff | ||
252 | */ | ||
253 | clk_rate = clk_get_rate(i2s->clk_ref); | ||
254 | |||
255 | diff_a = abs((clk_rate / 256) - rate); | ||
256 | diff_b = abs((clk_rate / 384) - rate); | ||
257 | |||
258 | if (diff_a > diff_b) | ||
259 | control_set |= IMG_I2S_OUT_CTL_CLK_MASK; | ||
260 | |||
261 | control_set |= ((i2s_channels - 1) << | ||
262 | IMG_I2S_OUT_CTL_ACTIVE_CHAN_SHIFT) & | ||
263 | IMG_I2S_OUT_CTL_ACTIVE_CHAN_MASK; | ||
264 | |||
265 | control_mask = IMG_I2S_OUT_CTL_CLK_MASK | | ||
266 | IMG_I2S_OUT_CTL_ACTIVE_CHAN_MASK; | ||
267 | |||
268 | img_i2s_out_disable(i2s); | ||
269 | |||
270 | reg = img_i2s_out_readl(i2s, IMG_I2S_OUT_CTL); | ||
271 | reg = (reg & ~control_mask) | control_set; | ||
272 | img_i2s_out_writel(i2s, reg, IMG_I2S_OUT_CTL); | ||
273 | |||
274 | for (i = 0; i < i2s_channels; i++) | ||
275 | img_i2s_out_ch_enable(i2s, i); | ||
276 | |||
277 | for (; i < i2s->max_i2s_chan; i++) | ||
278 | img_i2s_out_ch_disable(i2s, i); | ||
279 | |||
280 | img_i2s_out_enable(i2s); | ||
281 | |||
282 | i2s->active_channels = i2s_channels; | ||
283 | |||
284 | return 0; | ||
285 | } | ||
286 | |||
287 | static int img_i2s_out_set_fmt(struct snd_soc_dai *dai, unsigned int fmt) | ||
288 | { | ||
289 | struct img_i2s_out *i2s = snd_soc_dai_get_drvdata(dai); | ||
290 | int i; | ||
291 | bool force_clk_active; | ||
292 | u32 chan_control_mask, control_mask, chan_control_set = 0; | ||
293 | u32 reg, control_set = 0; | ||
294 | |||
295 | force_clk_active = ((fmt & SND_SOC_DAIFMT_CLOCK_MASK) == | ||
296 | SND_SOC_DAIFMT_CONT); | ||
297 | |||
298 | if (force_clk_active) | ||
299 | control_set |= IMG_I2S_OUT_CTL_CLK_EN_MASK; | ||
300 | |||
301 | switch (fmt & SND_SOC_DAIFMT_MASTER_MASK) { | ||
302 | case SND_SOC_DAIFMT_CBM_CFM: | ||
303 | break; | ||
304 | case SND_SOC_DAIFMT_CBS_CFS: | ||
305 | control_set |= IMG_I2S_OUT_CTL_MASTER_MASK; | ||
306 | break; | ||
307 | default: | ||
308 | return -EINVAL; | ||
309 | } | ||
310 | |||
311 | switch (fmt & SND_SOC_DAIFMT_INV_MASK) { | ||
312 | case SND_SOC_DAIFMT_NB_NF: | ||
313 | control_set |= IMG_I2S_OUT_CTL_BCLK_POL_MASK; | ||
314 | break; | ||
315 | case SND_SOC_DAIFMT_NB_IF: | ||
316 | control_set |= IMG_I2S_OUT_CTL_BCLK_POL_MASK; | ||
317 | control_set |= IMG_I2S_OUT_CTL_FRM_CLK_POL_MASK; | ||
318 | break; | ||
319 | case SND_SOC_DAIFMT_IB_NF: | ||
320 | break; | ||
321 | case SND_SOC_DAIFMT_IB_IF: | ||
322 | control_set |= IMG_I2S_OUT_CTL_FRM_CLK_POL_MASK; | ||
323 | break; | ||
324 | default: | ||
325 | return -EINVAL; | ||
326 | } | ||
327 | |||
328 | switch (fmt & SND_SOC_DAIFMT_FORMAT_MASK) { | ||
329 | case SND_SOC_DAIFMT_I2S: | ||
330 | chan_control_set |= IMG_I2S_OUT_CHAN_CTL_CLKT_MASK; | ||
331 | break; | ||
332 | case SND_SOC_DAIFMT_LEFT_J: | ||
333 | break; | ||
334 | default: | ||
335 | return -EINVAL; | ||
336 | } | ||
337 | |||
338 | control_mask = IMG_I2S_OUT_CTL_CLK_EN_MASK | | ||
339 | IMG_I2S_OUT_CTL_MASTER_MASK | | ||
340 | IMG_I2S_OUT_CTL_BCLK_POL_MASK | | ||
341 | IMG_I2S_OUT_CTL_FRM_CLK_POL_MASK; | ||
342 | |||
343 | chan_control_mask = IMG_I2S_OUT_CHAN_CTL_CLKT_MASK; | ||
344 | |||
345 | img_i2s_out_disable(i2s); | ||
346 | |||
347 | reg = img_i2s_out_readl(i2s, IMG_I2S_OUT_CTL); | ||
348 | reg = (reg & ~control_mask) | control_set; | ||
349 | img_i2s_out_writel(i2s, reg, IMG_I2S_OUT_CTL); | ||
350 | |||
351 | for (i = 0; i < i2s->active_channels; i++) | ||
352 | img_i2s_out_ch_disable(i2s, i); | ||
353 | |||
354 | for (i = 0; i < i2s->max_i2s_chan; i++) { | ||
355 | reg = img_i2s_out_ch_readl(i2s, i, IMG_I2S_OUT_CH_CTL); | ||
356 | reg = (reg & ~chan_control_mask) | chan_control_set; | ||
357 | img_i2s_out_ch_writel(i2s, i, reg, IMG_I2S_OUT_CH_CTL); | ||
358 | } | ||
359 | |||
360 | for (i = 0; i < i2s->active_channels; i++) | ||
361 | img_i2s_out_ch_enable(i2s, i); | ||
362 | |||
363 | img_i2s_out_enable(i2s); | ||
364 | |||
365 | i2s->force_clk_active = force_clk_active; | ||
366 | |||
367 | return 0; | ||
368 | } | ||
369 | |||
370 | static const struct snd_soc_dai_ops img_i2s_out_dai_ops = { | ||
371 | .trigger = img_i2s_out_trigger, | ||
372 | .hw_params = img_i2s_out_hw_params, | ||
373 | .set_fmt = img_i2s_out_set_fmt | ||
374 | }; | ||
375 | |||
376 | static int img_i2s_out_dai_probe(struct snd_soc_dai *dai) | ||
377 | { | ||
378 | struct img_i2s_out *i2s = snd_soc_dai_get_drvdata(dai); | ||
379 | |||
380 | snd_soc_dai_init_dma_data(dai, &i2s->dma_data, NULL); | ||
381 | |||
382 | return 0; | ||
383 | } | ||
384 | |||
385 | static const struct snd_soc_component_driver img_i2s_out_component = { | ||
386 | .name = "img-i2s-out" | ||
387 | }; | ||
388 | |||
389 | static int img_i2s_out_dma_prepare_slave_config(struct snd_pcm_substream *st, | ||
390 | struct snd_pcm_hw_params *params, struct dma_slave_config *sc) | ||
391 | { | ||
392 | unsigned int i2s_channels = params_channels(params) / 2; | ||
393 | struct snd_soc_pcm_runtime *rtd = st->private_data; | ||
394 | struct snd_dmaengine_dai_dma_data *dma_data; | ||
395 | int ret; | ||
396 | |||
397 | dma_data = snd_soc_dai_get_dma_data(rtd->cpu_dai, st); | ||
398 | |||
399 | ret = snd_hwparams_to_dma_slave_config(st, params, sc); | ||
400 | if (ret) | ||
401 | return ret; | ||
402 | |||
403 | sc->dst_addr = dma_data->addr; | ||
404 | sc->dst_addr_width = dma_data->addr_width; | ||
405 | sc->dst_maxburst = 4 * i2s_channels; | ||
406 | |||
407 | return 0; | ||
408 | } | ||
409 | |||
410 | static const struct snd_dmaengine_pcm_config img_i2s_out_dma_config = { | ||
411 | .prepare_slave_config = img_i2s_out_dma_prepare_slave_config | ||
412 | }; | ||
413 | |||
414 | static int img_i2s_out_probe(struct platform_device *pdev) | ||
415 | { | ||
416 | struct img_i2s_out *i2s; | ||
417 | struct resource *res; | ||
418 | void __iomem *base; | ||
419 | int i, ret; | ||
420 | unsigned int max_i2s_chan_pow_2; | ||
421 | u32 reg; | ||
422 | struct device *dev = &pdev->dev; | ||
423 | |||
424 | i2s = devm_kzalloc(&pdev->dev, sizeof(*i2s), GFP_KERNEL); | ||
425 | if (!i2s) | ||
426 | return -ENOMEM; | ||
427 | |||
428 | platform_set_drvdata(pdev, i2s); | ||
429 | |||
430 | i2s->dev = &pdev->dev; | ||
431 | |||
432 | res = platform_get_resource(pdev, IORESOURCE_MEM, 0); | ||
433 | base = devm_ioremap_resource(&pdev->dev, res); | ||
434 | if (IS_ERR(base)) | ||
435 | return PTR_ERR(base); | ||
436 | |||
437 | i2s->base = base; | ||
438 | |||
439 | if (of_property_read_u32(pdev->dev.of_node, "img,i2s-channels", | ||
440 | &i2s->max_i2s_chan)) { | ||
441 | dev_err(&pdev->dev, "No img,i2s-channels property\n"); | ||
442 | return -EINVAL; | ||
443 | } | ||
444 | |||
445 | max_i2s_chan_pow_2 = 1 << get_count_order(i2s->max_i2s_chan); | ||
446 | |||
447 | i2s->channel_base = base + (max_i2s_chan_pow_2 * 0x20); | ||
448 | |||
449 | i2s->rst = devm_reset_control_get(&pdev->dev, "rst"); | ||
450 | if (IS_ERR(i2s->rst)) { | ||
451 | if (PTR_ERR(i2s->rst) != -EPROBE_DEFER) | ||
452 | dev_err(&pdev->dev, "No top level reset found\n"); | ||
453 | return PTR_ERR(i2s->rst); | ||
454 | } | ||
455 | |||
456 | i2s->clk_sys = devm_clk_get(&pdev->dev, "sys"); | ||
457 | if (IS_ERR(i2s->clk_sys)) { | ||
458 | if (PTR_ERR(i2s->clk_sys) != -EPROBE_DEFER) | ||
459 | dev_err(dev, "Failed to acquire clock 'sys'\n"); | ||
460 | return PTR_ERR(i2s->clk_sys); | ||
461 | } | ||
462 | |||
463 | i2s->clk_ref = devm_clk_get(&pdev->dev, "ref"); | ||
464 | if (IS_ERR(i2s->clk_ref)) { | ||
465 | if (PTR_ERR(i2s->clk_ref) != -EPROBE_DEFER) | ||
466 | dev_err(dev, "Failed to acquire clock 'ref'\n"); | ||
467 | return PTR_ERR(i2s->clk_ref); | ||
468 | } | ||
469 | |||
470 | ret = clk_prepare_enable(i2s->clk_sys); | ||
471 | if (ret) | ||
472 | return ret; | ||
473 | |||
474 | reg = IMG_I2S_OUT_CTL_FRM_SIZE_MASK; | ||
475 | img_i2s_out_writel(i2s, reg, IMG_I2S_OUT_CTL); | ||
476 | |||
477 | reg = IMG_I2S_OUT_CHAN_CTL_JUST_MASK | | ||
478 | IMG_I2S_OUT_CHAN_CTL_LT_MASK | | ||
479 | IMG_I2S_OUT_CHAN_CTL_CH_MASK | | ||
480 | (8 << IMG_I2S_OUT_CHAN_CTL_FMT_SHIFT); | ||
481 | |||
482 | for (i = 0; i < i2s->max_i2s_chan; i++) | ||
483 | img_i2s_out_ch_writel(i2s, i, reg, IMG_I2S_OUT_CH_CTL); | ||
484 | |||
485 | img_i2s_out_reset(i2s); | ||
486 | |||
487 | pm_runtime_enable(&pdev->dev); | ||
488 | if (!pm_runtime_enabled(&pdev->dev)) { | ||
489 | ret = img_i2s_out_resume(&pdev->dev); | ||
490 | if (ret) | ||
491 | goto err_pm_disable; | ||
492 | } | ||
493 | |||
494 | i2s->active_channels = 1; | ||
495 | i2s->dma_data.addr = res->start + IMG_I2S_OUT_TX_FIFO; | ||
496 | i2s->dma_data.addr_width = 4; | ||
497 | i2s->dma_data.maxburst = 4; | ||
498 | |||
499 | i2s->dai_driver.probe = img_i2s_out_dai_probe; | ||
500 | i2s->dai_driver.playback.channels_min = 2; | ||
501 | i2s->dai_driver.playback.channels_max = i2s->max_i2s_chan * 2; | ||
502 | i2s->dai_driver.playback.rates = SNDRV_PCM_RATE_8000_192000; | ||
503 | i2s->dai_driver.playback.formats = SNDRV_PCM_FMTBIT_S32_LE; | ||
504 | i2s->dai_driver.ops = &img_i2s_out_dai_ops; | ||
505 | |||
506 | ret = devm_snd_soc_register_component(&pdev->dev, | ||
507 | &img_i2s_out_component, &i2s->dai_driver, 1); | ||
508 | if (ret) | ||
509 | goto err_suspend; | ||
510 | |||
511 | ret = devm_snd_dmaengine_pcm_register(&pdev->dev, | ||
512 | &img_i2s_out_dma_config, 0); | ||
513 | if (ret) | ||
514 | goto err_suspend; | ||
515 | |||
516 | return 0; | ||
517 | |||
518 | err_suspend: | ||
519 | if (!pm_runtime_status_suspended(&pdev->dev)) | ||
520 | img_i2s_out_suspend(&pdev->dev); | ||
521 | err_pm_disable: | ||
522 | pm_runtime_disable(&pdev->dev); | ||
523 | clk_disable_unprepare(i2s->clk_sys); | ||
524 | |||
525 | return ret; | ||
526 | } | ||
527 | |||
528 | static int img_i2s_out_dev_remove(struct platform_device *pdev) | ||
529 | { | ||
530 | struct img_i2s_out *i2s = platform_get_drvdata(pdev); | ||
531 | |||
532 | pm_runtime_disable(&pdev->dev); | ||
533 | if (!pm_runtime_status_suspended(&pdev->dev)) | ||
534 | img_i2s_out_suspend(&pdev->dev); | ||
535 | |||
536 | clk_disable_unprepare(i2s->clk_sys); | ||
537 | |||
538 | return 0; | ||
539 | } | ||
540 | |||
541 | static const struct of_device_id img_i2s_out_of_match[] = { | ||
542 | { .compatible = "img,i2s-out" }, | ||
543 | {} | ||
544 | }; | ||
545 | MODULE_DEVICE_TABLE(of, img_i2s_out_of_match); | ||
546 | |||
547 | static const struct dev_pm_ops img_i2s_out_pm_ops = { | ||
548 | SET_RUNTIME_PM_OPS(img_i2s_out_suspend, | ||
549 | img_i2s_out_resume, NULL) | ||
550 | }; | ||
551 | |||
552 | static struct platform_driver img_i2s_out_driver = { | ||
553 | .driver = { | ||
554 | .name = "img-i2s-out", | ||
555 | .of_match_table = img_i2s_out_of_match, | ||
556 | .pm = &img_i2s_out_pm_ops | ||
557 | }, | ||
558 | .probe = img_i2s_out_probe, | ||
559 | .remove = img_i2s_out_dev_remove | ||
560 | }; | ||
561 | module_platform_driver(img_i2s_out_driver); | ||
562 | |||
563 | MODULE_AUTHOR("Damien Horsley <Damien.Horsley@imgtec.com>"); | ||
564 | MODULE_DESCRIPTION("IMG I2S Output Driver"); | ||
565 | MODULE_LICENSE("GPL v2"); | ||