~ [ source navigation ] ~ [ diff markup ] ~ [ identifier search ] ~

TOMOYO Linux Cross Reference
Linux/sound/soc/img/img-spdif-out.c

Version: ~ [ linux-5.16 ] ~ [ linux-5.15.13 ] ~ [ linux-5.14.21 ] ~ [ linux-5.13.19 ] ~ [ linux-5.12.19 ] ~ [ linux-5.11.22 ] ~ [ linux-5.10.90 ] ~ [ linux-5.9.16 ] ~ [ linux-5.8.18 ] ~ [ linux-5.7.19 ] ~ [ linux-5.6.19 ] ~ [ linux-5.5.19 ] ~ [ linux-5.4.170 ] ~ [ linux-5.3.18 ] ~ [ linux-5.2.21 ] ~ [ linux-5.1.21 ] ~ [ linux-5.0.21 ] ~ [ linux-4.20.17 ] ~ [ linux-4.19.224 ] ~ [ linux-4.18.20 ] ~ [ linux-4.17.19 ] ~ [ linux-4.16.18 ] ~ [ linux-4.15.18 ] ~ [ linux-4.14.261 ] ~ [ linux-4.13.16 ] ~ [ linux-4.12.14 ] ~ [ linux-4.11.12 ] ~ [ linux-4.10.17 ] ~ [ linux-4.9.296 ] ~ [ linux-4.8.17 ] ~ [ linux-4.7.10 ] ~ [ linux-4.6.7 ] ~ [ linux-4.5.7 ] ~ [ linux-4.4.298 ] ~ [ linux-4.3.6 ] ~ [ linux-4.2.8 ] ~ [ linux-4.1.52 ] ~ [ linux-4.0.9 ] ~ [ linux-3.18.140 ] ~ [ linux-3.16.85 ] ~ [ linux-3.14.79 ] ~ [ linux-3.12.74 ] ~ [ linux-3.10.108 ] ~ [ linux-2.6.32.71 ] ~ [ linux-2.6.0 ] ~ [ linux-2.4.37.11 ] ~ [ unix-v6-master ] ~ [ ccs-tools-1.8.5 ] ~ [ policy-sample ] ~
Architecture: ~ [ i386 ] ~ [ alpha ] ~ [ m68k ] ~ [ mips ] ~ [ ppc ] ~ [ sparc ] ~ [ sparc64 ] ~

  1 // SPDX-License-Identifier: GPL-2.0-only
  2 /*
  3  * IMG SPDIF output controller driver
  4  *
  5  * Copyright (C) 2015 Imagination Technologies Ltd.
  6  *
  7  * Author: Damien Horsley <Damien.Horsley@imgtec.com>
  8  */
  9 
 10 #include <linux/clk.h>
 11 #include <linux/init.h>
 12 #include <linux/kernel.h>
 13 #include <linux/module.h>
 14 #include <linux/of.h>
 15 #include <linux/platform_device.h>
 16 #include <linux/pm_runtime.h>
 17 #include <linux/reset.h>
 18 
 19 #include <sound/core.h>
 20 #include <sound/dmaengine_pcm.h>
 21 #include <sound/initval.h>
 22 #include <sound/pcm.h>
 23 #include <sound/pcm_params.h>
 24 #include <sound/soc.h>
 25 
 26 #define IMG_SPDIF_OUT_TX_FIFO           0x0
 27 
 28 #define IMG_SPDIF_OUT_CTL               0x4
 29 #define IMG_SPDIF_OUT_CTL_FS_MASK       BIT(4)
 30 #define IMG_SPDIF_OUT_CTL_CLK_MASK      BIT(2)
 31 #define IMG_SPDIF_OUT_CTL_SRT_MASK      BIT(0)
 32 
 33 #define IMG_SPDIF_OUT_CSL               0x14
 34 
 35 #define IMG_SPDIF_OUT_CSH_UV            0x18
 36 #define IMG_SPDIF_OUT_CSH_UV_CSH_SHIFT  0
 37 #define IMG_SPDIF_OUT_CSH_UV_CSH_MASK   0xff
 38 
 39 struct img_spdif_out {
 40         spinlock_t lock;
 41         void __iomem *base;
 42         struct clk *clk_sys;
 43         struct clk *clk_ref;
 44         struct snd_dmaengine_dai_dma_data dma_data;
 45         struct device *dev;
 46         struct reset_control *rst;
 47         u32 suspend_ctl;
 48         u32 suspend_csl;
 49         u32 suspend_csh;
 50 };
 51 
 52 static int img_spdif_out_runtime_suspend(struct device *dev)
 53 {
 54         struct img_spdif_out *spdif = dev_get_drvdata(dev);
 55 
 56         clk_disable_unprepare(spdif->clk_ref);
 57         clk_disable_unprepare(spdif->clk_sys);
 58 
 59         return 0;
 60 }
 61 
 62 static int img_spdif_out_runtime_resume(struct device *dev)
 63 {
 64         struct img_spdif_out *spdif = dev_get_drvdata(dev);
 65         int ret;
 66 
 67         ret = clk_prepare_enable(spdif->clk_sys);
 68         if (ret) {
 69                 dev_err(dev, "clk_enable failed: %d\n", ret);
 70                 return ret;
 71         }
 72 
 73         ret = clk_prepare_enable(spdif->clk_ref);
 74         if (ret) {
 75                 dev_err(dev, "clk_enable failed: %d\n", ret);
 76                 clk_disable_unprepare(spdif->clk_sys);
 77                 return ret;
 78         }
 79 
 80         return 0;
 81 }
 82 
 83 static inline void img_spdif_out_writel(struct img_spdif_out *spdif, u32 val,
 84                                 u32 reg)
 85 {
 86         writel(val, spdif->base + reg);
 87 }
 88 
 89 static inline u32 img_spdif_out_readl(struct img_spdif_out *spdif, u32 reg)
 90 {
 91         return readl(spdif->base + reg);
 92 }
 93 
 94 static void img_spdif_out_reset(struct img_spdif_out *spdif)
 95 {
 96         u32 ctl, status_low, status_high;
 97 
 98         ctl = img_spdif_out_readl(spdif, IMG_SPDIF_OUT_CTL) &
 99                         ~IMG_SPDIF_OUT_CTL_SRT_MASK;
100         status_low = img_spdif_out_readl(spdif, IMG_SPDIF_OUT_CSL);
101         status_high = img_spdif_out_readl(spdif, IMG_SPDIF_OUT_CSH_UV);
102 
103         reset_control_assert(spdif->rst);
104         reset_control_deassert(spdif->rst);
105 
106         img_spdif_out_writel(spdif, ctl, IMG_SPDIF_OUT_CTL);
107         img_spdif_out_writel(spdif, status_low, IMG_SPDIF_OUT_CSL);
108         img_spdif_out_writel(spdif, status_high, IMG_SPDIF_OUT_CSH_UV);
109 }
110 
111 static int img_spdif_out_info(struct snd_kcontrol *kcontrol,
112                                         struct snd_ctl_elem_info *uinfo)
113 {
114         uinfo->type = SNDRV_CTL_ELEM_TYPE_IEC958;
115         uinfo->count = 1;
116 
117         return 0;
118 }
119 
120 static int img_spdif_out_get_status_mask(struct snd_kcontrol *kcontrol,
121                                        struct snd_ctl_elem_value *ucontrol)
122 {
123         ucontrol->value.iec958.status[0] = 0xff;
124         ucontrol->value.iec958.status[1] = 0xff;
125         ucontrol->value.iec958.status[2] = 0xff;
126         ucontrol->value.iec958.status[3] = 0xff;
127         ucontrol->value.iec958.status[4] = 0xff;
128 
129         return 0;
130 }
131 
132 static int img_spdif_out_get_status(struct snd_kcontrol *kcontrol,
133                                   struct snd_ctl_elem_value *ucontrol)
134 {
135         struct snd_soc_dai *cpu_dai = snd_kcontrol_chip(kcontrol);
136         struct img_spdif_out *spdif = snd_soc_dai_get_drvdata(cpu_dai);
137         u32 reg;
138         unsigned long flags;
139 
140         spin_lock_irqsave(&spdif->lock, flags);
141 
142         reg = img_spdif_out_readl(spdif, IMG_SPDIF_OUT_CSL);
143         ucontrol->value.iec958.status[0] = reg & 0xff;
144         ucontrol->value.iec958.status[1] = (reg >> 8) & 0xff;
145         ucontrol->value.iec958.status[2] = (reg >> 16) & 0xff;
146         ucontrol->value.iec958.status[3] = (reg >> 24) & 0xff;
147 
148         reg = img_spdif_out_readl(spdif, IMG_SPDIF_OUT_CSH_UV);
149         ucontrol->value.iec958.status[4] =
150                 (reg & IMG_SPDIF_OUT_CSH_UV_CSH_MASK) >>
151                 IMG_SPDIF_OUT_CSH_UV_CSH_SHIFT;
152 
153         spin_unlock_irqrestore(&spdif->lock, flags);
154 
155         return 0;
156 }
157 
158 static int img_spdif_out_set_status(struct snd_kcontrol *kcontrol,
159                                   struct snd_ctl_elem_value *ucontrol)
160 {
161         struct snd_soc_dai *cpu_dai = snd_kcontrol_chip(kcontrol);
162         struct img_spdif_out *spdif = snd_soc_dai_get_drvdata(cpu_dai);
163         u32 reg;
164         unsigned long flags;
165 
166         reg = ((u32)ucontrol->value.iec958.status[3] << 24);
167         reg |= ((u32)ucontrol->value.iec958.status[2] << 16);
168         reg |= ((u32)ucontrol->value.iec958.status[1] << 8);
169         reg |= (u32)ucontrol->value.iec958.status[0];
170 
171         spin_lock_irqsave(&spdif->lock, flags);
172 
173         img_spdif_out_writel(spdif, reg, IMG_SPDIF_OUT_CSL);
174 
175         reg = img_spdif_out_readl(spdif, IMG_SPDIF_OUT_CSH_UV);
176         reg &= ~IMG_SPDIF_OUT_CSH_UV_CSH_MASK;
177         reg |= (u32)ucontrol->value.iec958.status[4] <<
178                         IMG_SPDIF_OUT_CSH_UV_CSH_SHIFT;
179         img_spdif_out_writel(spdif, reg, IMG_SPDIF_OUT_CSH_UV);
180 
181         spin_unlock_irqrestore(&spdif->lock, flags);
182 
183         return 0;
184 }
185 
186 static struct snd_kcontrol_new img_spdif_out_controls[] = {
187         {
188                 .access = SNDRV_CTL_ELEM_ACCESS_READ,
189                 .iface = SNDRV_CTL_ELEM_IFACE_PCM,
190                 .name = SNDRV_CTL_NAME_IEC958("", PLAYBACK, MASK),
191                 .info = img_spdif_out_info,
192                 .get = img_spdif_out_get_status_mask
193         },
194         {
195                 .iface = SNDRV_CTL_ELEM_IFACE_PCM,
196                 .name = SNDRV_CTL_NAME_IEC958("", PLAYBACK, DEFAULT),
197                 .info = img_spdif_out_info,
198                 .get = img_spdif_out_get_status,
199                 .put = img_spdif_out_set_status
200         }
201 };
202 
203 static int img_spdif_out_trigger(struct snd_pcm_substream *substream, int cmd,
204                         struct snd_soc_dai *dai)
205 {
206         struct img_spdif_out *spdif = snd_soc_dai_get_drvdata(dai);
207         u32 reg;
208         unsigned long flags;
209 
210         switch (cmd) {
211         case SNDRV_PCM_TRIGGER_START:
212         case SNDRV_PCM_TRIGGER_RESUME:
213         case SNDRV_PCM_TRIGGER_PAUSE_RELEASE:
214                 reg = img_spdif_out_readl(spdif, IMG_SPDIF_OUT_CTL);
215                 reg |= IMG_SPDIF_OUT_CTL_SRT_MASK;
216                 img_spdif_out_writel(spdif, reg, IMG_SPDIF_OUT_CTL);
217                 break;
218         case SNDRV_PCM_TRIGGER_STOP:
219         case SNDRV_PCM_TRIGGER_SUSPEND:
220         case SNDRV_PCM_TRIGGER_PAUSE_PUSH:
221                 spin_lock_irqsave(&spdif->lock, flags);
222                 img_spdif_out_reset(spdif);
223                 spin_unlock_irqrestore(&spdif->lock, flags);
224                 break;
225         default:
226                 return -EINVAL;
227         }
228 
229         return 0;
230 }
231 
232 static int img_spdif_out_hw_params(struct snd_pcm_substream *substream,
233         struct snd_pcm_hw_params *params, struct snd_soc_dai *dai)
234 {
235         struct img_spdif_out *spdif = snd_soc_dai_get_drvdata(dai);
236         unsigned int channels;
237         long pre_div_a, pre_div_b, diff_a, diff_b, rate, clk_rate;
238         u32 reg;
239         snd_pcm_format_t format;
240 
241         rate = params_rate(params);
242         format = params_format(params);
243         channels = params_channels(params);
244 
245         dev_dbg(spdif->dev, "hw_params rate %ld channels %u format %u\n",
246                         rate, channels, format);
247 
248         if (format != SNDRV_PCM_FORMAT_S32_LE)
249                 return -EINVAL;
250 
251         if (channels != 2)
252                 return -EINVAL;
253 
254         pre_div_a = clk_round_rate(spdif->clk_ref, rate * 256);
255         if (pre_div_a < 0)
256                 return pre_div_a;
257         pre_div_b = clk_round_rate(spdif->clk_ref, rate * 384);
258         if (pre_div_b < 0)
259                 return pre_div_b;
260 
261         diff_a = abs((pre_div_a / 256) - rate);
262         diff_b = abs((pre_div_b / 384) - rate);
263 
264         /* If diffs are equal, use lower clock rate */
265         if (diff_a > diff_b)
266                 clk_set_rate(spdif->clk_ref, pre_div_b);
267         else
268                 clk_set_rate(spdif->clk_ref, pre_div_a);
269 
270         /*
271          * Another driver (eg machine driver) may have rejected the above
272          * change. Get the current rate and set the register bit according to
273          * the new min diff
274          */
275         clk_rate = clk_get_rate(spdif->clk_ref);
276 
277         diff_a = abs((clk_rate / 256) - rate);
278         diff_b = abs((clk_rate / 384) - rate);
279 
280         reg = img_spdif_out_readl(spdif, IMG_SPDIF_OUT_CTL);
281         if (diff_a <= diff_b)
282                 reg &= ~IMG_SPDIF_OUT_CTL_CLK_MASK;
283         else
284                 reg |= IMG_SPDIF_OUT_CTL_CLK_MASK;
285         img_spdif_out_writel(spdif, reg, IMG_SPDIF_OUT_CTL);
286 
287         return 0;
288 }
289 
290 static const struct snd_soc_dai_ops img_spdif_out_dai_ops = {
291         .trigger = img_spdif_out_trigger,
292         .hw_params = img_spdif_out_hw_params
293 };
294 
295 static int img_spdif_out_dai_probe(struct snd_soc_dai *dai)
296 {
297         struct img_spdif_out *spdif = snd_soc_dai_get_drvdata(dai);
298 
299         snd_soc_dai_init_dma_data(dai, &spdif->dma_data, NULL);
300 
301         snd_soc_add_dai_controls(dai, img_spdif_out_controls,
302                         ARRAY_SIZE(img_spdif_out_controls));
303 
304         return 0;
305 }
306 
307 static struct snd_soc_dai_driver img_spdif_out_dai = {
308         .probe = img_spdif_out_dai_probe,
309         .playback = {
310                 .channels_min = 2,
311                 .channels_max = 2,
312                 .rates = SNDRV_PCM_RATE_8000_192000,
313                 .formats = SNDRV_PCM_FMTBIT_S32_LE
314         },
315         .ops = &img_spdif_out_dai_ops
316 };
317 
318 static const struct snd_soc_component_driver img_spdif_out_component = {
319         .name = "img-spdif-out"
320 };
321 
322 static int img_spdif_out_probe(struct platform_device *pdev)
323 {
324         struct img_spdif_out *spdif;
325         struct resource *res;
326         void __iomem *base;
327         int ret;
328         struct device *dev = &pdev->dev;
329 
330         spdif = devm_kzalloc(&pdev->dev, sizeof(*spdif), GFP_KERNEL);
331         if (!spdif)
332                 return -ENOMEM;
333 
334         platform_set_drvdata(pdev, spdif);
335 
336         spdif->dev = &pdev->dev;
337 
338         res = platform_get_resource(pdev, IORESOURCE_MEM, 0);
339         base = devm_ioremap_resource(&pdev->dev, res);
340         if (IS_ERR(base))
341                 return PTR_ERR(base);
342 
343         spdif->base = base;
344 
345         spdif->rst = devm_reset_control_get_exclusive(&pdev->dev, "rst");
346         if (IS_ERR(spdif->rst)) {
347                 if (PTR_ERR(spdif->rst) != -EPROBE_DEFER)
348                         dev_err(&pdev->dev, "No top level reset found\n");
349                 return PTR_ERR(spdif->rst);
350         }
351 
352         spdif->clk_sys = devm_clk_get(&pdev->dev, "sys");
353         if (IS_ERR(spdif->clk_sys)) {
354                 if (PTR_ERR(spdif->clk_sys) != -EPROBE_DEFER)
355                         dev_err(dev, "Failed to acquire clock 'sys'\n");
356                 return PTR_ERR(spdif->clk_sys);
357         }
358 
359         spdif->clk_ref = devm_clk_get(&pdev->dev, "ref");
360         if (IS_ERR(spdif->clk_ref)) {
361                 if (PTR_ERR(spdif->clk_ref) != -EPROBE_DEFER)
362                         dev_err(dev, "Failed to acquire clock 'ref'\n");
363                 return PTR_ERR(spdif->clk_ref);
364         }
365 
366         pm_runtime_enable(&pdev->dev);
367         if (!pm_runtime_enabled(&pdev->dev)) {
368                 ret = img_spdif_out_runtime_resume(&pdev->dev);
369                 if (ret)
370                         goto err_pm_disable;
371         }
372         ret = pm_runtime_get_sync(&pdev->dev);
373         if (ret < 0)
374                 goto err_suspend;
375 
376         img_spdif_out_writel(spdif, IMG_SPDIF_OUT_CTL_FS_MASK,
377                              IMG_SPDIF_OUT_CTL);
378 
379         img_spdif_out_reset(spdif);
380         pm_runtime_put(&pdev->dev);
381 
382         spin_lock_init(&spdif->lock);
383 
384         spdif->dma_data.addr = res->start + IMG_SPDIF_OUT_TX_FIFO;
385         spdif->dma_data.addr_width = 4;
386         spdif->dma_data.maxburst = 4;
387 
388         ret = devm_snd_soc_register_component(&pdev->dev,
389                         &img_spdif_out_component,
390                         &img_spdif_out_dai, 1);
391         if (ret)
392                 goto err_suspend;
393 
394         ret = devm_snd_dmaengine_pcm_register(&pdev->dev, NULL, 0);
395         if (ret)
396                 goto err_suspend;
397 
398         dev_dbg(&pdev->dev, "Probe successful\n");
399 
400         return 0;
401 
402 err_suspend:
403         if (!pm_runtime_status_suspended(&pdev->dev))
404                 img_spdif_out_runtime_suspend(&pdev->dev);
405 err_pm_disable:
406         pm_runtime_disable(&pdev->dev);
407 
408         return ret;
409 }
410 
411 static int img_spdif_out_dev_remove(struct platform_device *pdev)
412 {
413         pm_runtime_disable(&pdev->dev);
414         if (!pm_runtime_status_suspended(&pdev->dev))
415                 img_spdif_out_runtime_suspend(&pdev->dev);
416 
417         return 0;
418 }
419 
420 #ifdef CONFIG_PM_SLEEP
421 static int img_spdif_out_suspend(struct device *dev)
422 {
423         struct img_spdif_out *spdif = dev_get_drvdata(dev);
424         int ret;
425 
426         if (pm_runtime_status_suspended(dev)) {
427                 ret = img_spdif_out_runtime_resume(dev);
428                 if (ret)
429                         return ret;
430         }
431 
432         spdif->suspend_ctl = img_spdif_out_readl(spdif, IMG_SPDIF_OUT_CTL);
433         spdif->suspend_csl = img_spdif_out_readl(spdif, IMG_SPDIF_OUT_CSL);
434         spdif->suspend_csh = img_spdif_out_readl(spdif, IMG_SPDIF_OUT_CSH_UV);
435 
436         img_spdif_out_runtime_suspend(dev);
437 
438         return 0;
439 }
440 
441 static int img_spdif_out_resume(struct device *dev)
442 {
443         struct img_spdif_out *spdif = dev_get_drvdata(dev);
444         int ret;
445 
446         ret = img_spdif_out_runtime_resume(dev);
447         if (ret)
448                 return ret;
449 
450         img_spdif_out_writel(spdif, spdif->suspend_ctl, IMG_SPDIF_OUT_CTL);
451         img_spdif_out_writel(spdif, spdif->suspend_csl, IMG_SPDIF_OUT_CSL);
452         img_spdif_out_writel(spdif, spdif->suspend_csh, IMG_SPDIF_OUT_CSH_UV);
453 
454         if (pm_runtime_status_suspended(dev))
455                 img_spdif_out_runtime_suspend(dev);
456 
457         return 0;
458 }
459 #endif
460 static const struct of_device_id img_spdif_out_of_match[] = {
461         { .compatible = "img,spdif-out" },
462         {}
463 };
464 MODULE_DEVICE_TABLE(of, img_spdif_out_of_match);
465 
466 static const struct dev_pm_ops img_spdif_out_pm_ops = {
467         SET_RUNTIME_PM_OPS(img_spdif_out_runtime_suspend,
468                            img_spdif_out_runtime_resume, NULL)
469         SET_SYSTEM_SLEEP_PM_OPS(img_spdif_out_suspend, img_spdif_out_resume)
470 };
471 
472 static struct platform_driver img_spdif_out_driver = {
473         .driver = {
474                 .name = "img-spdif-out",
475                 .of_match_table = img_spdif_out_of_match,
476                 .pm = &img_spdif_out_pm_ops
477         },
478         .probe = img_spdif_out_probe,
479         .remove = img_spdif_out_dev_remove
480 };
481 module_platform_driver(img_spdif_out_driver);
482 
483 MODULE_AUTHOR("Damien Horsley <Damien.Horsley@imgtec.com>");
484 MODULE_DESCRIPTION("IMG SPDIF Output driver");
485 MODULE_LICENSE("GPL v2");
486 

~ [ source navigation ] ~ [ diff markup ] ~ [ identifier search ] ~

kernel.org | git.kernel.org | LWN.net | Project Home | Wiki (Japanese) | Wiki (English) | SVN repository | Mail admin

Linux® is a registered trademark of Linus Torvalds in the United States and other countries.
TOMOYO® is a registered trademark of NTT DATA CORPORATION.

osdn.jp