Lines Matching +full:stm32h7 +full:- +full:i2s
1 // SPDX-License-Identifier: GPL-2.0-only
3 * STM32 ALSA SoC Digital Audio Interface (I2S) driver.
5 * Copyright (C) 2017, STMicroelectronics - All Rights Reserved
134 #define I2S_CGFR_I2SDIV_MAX ((1 << (I2S_CGFR_I2SDIV_BIT_H -\
135 I2S_CGFR_I2SDIV_SHIFT)) - 1)
141 /* Registers below apply to I2S version 1.1 and more */
196 #define STM32_I2S_IS_MASTER(x) ((x)->ms_flg == I2S_MS_MASTER)
197 #define STM32_I2S_IS_SLAVE(x) ((x)->ms_flg == I2S_MS_SLAVE)
200 * struct stm32_i2s_data - private data of I2S
201 * @regmap_conf: I2S register map configuration pointer
202 * @regmap: I2S register map pointer
208 * @i2sclk: kernel clock feeding the I2S clock generator
210 * @x8kclk: I2S parent clock for sampling frequencies multiple of 8kHz
211 * @x11kclk: I2S parent clock for sampling frequencies multiple of 11kHz
213 * @phys_addr: I2S registers physical base address
218 * @refcount: keep count of opened streams on I2S
245 struct stm32_i2s_data *i2s = (struct stm32_i2s_data *)devid; in stm32_i2s_isr() local
246 struct platform_device *pdev = i2s->pdev; in stm32_i2s_isr()
251 regmap_read(i2s->regmap, STM32_I2S_SR_REG, &sr); in stm32_i2s_isr()
252 regmap_read(i2s->regmap, STM32_I2S_IER_REG, &ier); in stm32_i2s_isr()
256 dev_dbg(&pdev->dev, "Spurious IRQ sr=0x%08x, ier=0x%08x\n", in stm32_i2s_isr()
261 regmap_write_bits(i2s->regmap, STM32_I2S_IFCR_REG, in stm32_i2s_isr()
265 dev_dbg(&pdev->dev, "Overrun\n"); in stm32_i2s_isr()
270 dev_dbg(&pdev->dev, "Underrun\n"); in stm32_i2s_isr()
275 dev_dbg(&pdev->dev, "Frame error\n"); in stm32_i2s_isr()
277 spin_lock(&i2s->irq_lock); in stm32_i2s_isr()
278 if (err && i2s->substream) in stm32_i2s_isr()
279 snd_pcm_stop_xrun(i2s->substream); in stm32_i2s_isr()
280 spin_unlock(&i2s->irq_lock); in stm32_i2s_isr()
334 struct stm32_i2s_data *i2s = snd_soc_dai_get_drvdata(cpu_dai); in stm32_i2s_set_dai_fmt() local
339 dev_dbg(cpu_dai->dev, "fmt %x\n", fmt); in stm32_i2s_set_dai_fmt()
358 /* DSP_B not mapped on I2S PCM long format. 1 bit offset does not fit */ in stm32_i2s_set_dai_fmt()
360 dev_err(cpu_dai->dev, "Unsupported protocol %#x\n", in stm32_i2s_set_dai_fmt()
362 return -EINVAL; in stm32_i2s_set_dai_fmt()
380 dev_err(cpu_dai->dev, "Unsupported strobing %#x\n", in stm32_i2s_set_dai_fmt()
382 return -EINVAL; in stm32_i2s_set_dai_fmt()
388 i2s->ms_flg = I2S_MS_SLAVE; in stm32_i2s_set_dai_fmt()
391 i2s->ms_flg = I2S_MS_MASTER; in stm32_i2s_set_dai_fmt()
394 dev_err(cpu_dai->dev, "Unsupported mode %#x\n", in stm32_i2s_set_dai_fmt()
396 return -EINVAL; in stm32_i2s_set_dai_fmt()
399 i2s->fmt = fmt; in stm32_i2s_set_dai_fmt()
400 return regmap_update_bits(i2s->regmap, STM32_I2S_CGFR_REG, in stm32_i2s_set_dai_fmt()
407 struct stm32_i2s_data *i2s = snd_soc_dai_get_drvdata(cpu_dai); in stm32_i2s_set_sysclk() local
409 dev_dbg(cpu_dai->dev, "I2S MCLK frequency is %uHz\n", freq); in stm32_i2s_set_sysclk()
411 if ((dir == SND_SOC_CLOCK_OUT) && STM32_I2S_IS_MASTER(i2s)) { in stm32_i2s_set_sysclk()
412 i2s->mclk_rate = freq; in stm32_i2s_set_sysclk()
414 /* Enable master clock if master mode and mclk-fs are set */ in stm32_i2s_set_sysclk()
415 return regmap_update_bits(i2s->regmap, STM32_I2S_CGFR_REG, in stm32_i2s_set_sysclk()
425 struct stm32_i2s_data *i2s = snd_soc_dai_get_drvdata(cpu_dai); in stm32_i2s_configure_clock() local
434 clk_set_parent(i2s->i2sclk, i2s->x11kclk); in stm32_i2s_configure_clock()
436 clk_set_parent(i2s->i2sclk, i2s->x8kclk); in stm32_i2s_configure_clock()
437 i2s_clock_rate = clk_get_rate(i2s->i2sclk); in stm32_i2s_configure_clock()
441 * i2s mode : mclk_ratio = 256 in stm32_i2s_configure_clock()
445 * i2s mode : div = i2s_clk / (mclk_ratio * ws) in stm32_i2s_configure_clock()
448 * i2s mode : div = i2s_clk / (nb_bits x ws) in stm32_i2s_configure_clock()
451 if (i2s->mclk_rate) { in stm32_i2s_configure_clock()
452 tmp = DIV_ROUND_CLOSEST(i2s_clock_rate, i2s->mclk_rate); in stm32_i2s_configure_clock()
455 if ((i2s->fmt & SND_SOC_DAIFMT_FORMAT_MASK) == in stm32_i2s_configure_clock()
460 ret = regmap_read(i2s->regmap, STM32_I2S_CGFR_REG, &cgfr); in stm32_i2s_configure_clock()
478 dev_dbg(cpu_dai->dev, "I2S clk: %ld, SCLK: %d\n", in stm32_i2s_configure_clock()
480 dev_dbg(cpu_dai->dev, "Divider: 2*%d(div)+%d(odd) = %d\n", in stm32_i2s_configure_clock()
484 dev_err(cpu_dai->dev, "Wrong divider setting\n"); in stm32_i2s_configure_clock()
485 return -EINVAL; in stm32_i2s_configure_clock()
489 dev_warn(cpu_dai->dev, "real divider forced to 1\n"); in stm32_i2s_configure_clock()
491 ret = regmap_update_bits(i2s->regmap, STM32_I2S_CGFR_REG, in stm32_i2s_configure_clock()
497 return regmap_update_bits(i2s->regmap, STM32_I2S_CFG2_REG, in stm32_i2s_configure_clock()
505 struct stm32_i2s_data *i2s = snd_soc_dai_get_drvdata(cpu_dai); in stm32_i2s_configure() local
522 dev_err(cpu_dai->dev, "Unexpected format %d", format); in stm32_i2s_configure()
523 return -EINVAL; in stm32_i2s_configure()
526 if (STM32_I2S_IS_SLAVE(i2s)) { in stm32_i2s_configure()
537 ret = regmap_update_bits(i2s->regmap, STM32_I2S_CGFR_REG, in stm32_i2s_configure()
543 cfg1 = I2S_CFG1_FTHVL_SET(fthlv - 1); in stm32_i2s_configure()
545 return regmap_update_bits(i2s->regmap, STM32_I2S_CFG1_REG, in stm32_i2s_configure()
552 struct stm32_i2s_data *i2s = snd_soc_dai_get_drvdata(cpu_dai); in stm32_i2s_startup() local
556 spin_lock_irqsave(&i2s->irq_lock, flags); in stm32_i2s_startup()
557 i2s->substream = substream; in stm32_i2s_startup()
558 spin_unlock_irqrestore(&i2s->irq_lock, flags); in stm32_i2s_startup()
560 if ((i2s->fmt & SND_SOC_DAIFMT_FORMAT_MASK) != SND_SOC_DAIFMT_DSP_A) in stm32_i2s_startup()
561 snd_pcm_hw_constraint_single(substream->runtime, in stm32_i2s_startup()
564 ret = clk_prepare_enable(i2s->i2sclk); in stm32_i2s_startup()
566 dev_err(cpu_dai->dev, "Failed to enable clock: %d\n", ret); in stm32_i2s_startup()
570 return regmap_write_bits(i2s->regmap, STM32_I2S_IFCR_REG, in stm32_i2s_startup()
578 struct stm32_i2s_data *i2s = snd_soc_dai_get_drvdata(cpu_dai); in stm32_i2s_hw_params() local
583 dev_err(cpu_dai->dev, "Configuration returned error %d\n", ret); in stm32_i2s_hw_params()
587 if (STM32_I2S_IS_MASTER(i2s)) in stm32_i2s_hw_params()
596 struct stm32_i2s_data *i2s = snd_soc_dai_get_drvdata(cpu_dai); in stm32_i2s_trigger() local
597 bool playback_flg = (substream->stream == SNDRV_PCM_STREAM_PLAYBACK); in stm32_i2s_trigger()
605 /* Enable i2s */ in stm32_i2s_trigger()
606 dev_dbg(cpu_dai->dev, "start I2S %s\n", in stm32_i2s_trigger()
610 regmap_update_bits(i2s->regmap, STM32_I2S_CFG1_REG, in stm32_i2s_trigger()
613 ret = regmap_update_bits(i2s->regmap, STM32_I2S_CR1_REG, in stm32_i2s_trigger()
616 dev_err(cpu_dai->dev, "Error %d enabling I2S\n", ret); in stm32_i2s_trigger()
620 ret = regmap_write_bits(i2s->regmap, STM32_I2S_CR1_REG, in stm32_i2s_trigger()
623 dev_err(cpu_dai->dev, "Error %d starting I2S\n", ret); in stm32_i2s_trigger()
627 regmap_write_bits(i2s->regmap, STM32_I2S_IFCR_REG, in stm32_i2s_trigger()
630 spin_lock(&i2s->lock_fd); in stm32_i2s_trigger()
631 i2s->refcount++; in stm32_i2s_trigger()
637 if (STM32_I2S_IS_MASTER(i2s) && i2s->refcount == 1) in stm32_i2s_trigger()
639 regmap_write(i2s->regmap, in stm32_i2s_trigger()
642 spin_unlock(&i2s->lock_fd); in stm32_i2s_trigger()
644 if (STM32_I2S_IS_SLAVE(i2s)) in stm32_i2s_trigger()
647 regmap_update_bits(i2s->regmap, STM32_I2S_IER_REG, ier, ier); in stm32_i2s_trigger()
652 dev_dbg(cpu_dai->dev, "stop I2S %s\n", in stm32_i2s_trigger()
656 regmap_update_bits(i2s->regmap, STM32_I2S_IER_REG, in stm32_i2s_trigger()
660 regmap_update_bits(i2s->regmap, STM32_I2S_IER_REG, in stm32_i2s_trigger()
664 spin_lock(&i2s->lock_fd); in stm32_i2s_trigger()
665 i2s->refcount--; in stm32_i2s_trigger()
666 if (i2s->refcount) { in stm32_i2s_trigger()
667 spin_unlock(&i2s->lock_fd); in stm32_i2s_trigger()
671 ret = regmap_update_bits(i2s->regmap, STM32_I2S_CR1_REG, in stm32_i2s_trigger()
674 dev_err(cpu_dai->dev, "Error %d disabling I2S\n", ret); in stm32_i2s_trigger()
675 spin_unlock(&i2s->lock_fd); in stm32_i2s_trigger()
678 spin_unlock(&i2s->lock_fd); in stm32_i2s_trigger()
681 regmap_update_bits(i2s->regmap, STM32_I2S_CFG1_REG, in stm32_i2s_trigger()
685 return -EINVAL; in stm32_i2s_trigger()
694 struct stm32_i2s_data *i2s = snd_soc_dai_get_drvdata(cpu_dai); in stm32_i2s_shutdown() local
697 regmap_update_bits(i2s->regmap, STM32_I2S_CGFR_REG, in stm32_i2s_shutdown()
700 clk_disable_unprepare(i2s->i2sclk); in stm32_i2s_shutdown()
702 spin_lock_irqsave(&i2s->irq_lock, flags); in stm32_i2s_shutdown()
703 i2s->substream = NULL; in stm32_i2s_shutdown()
704 spin_unlock_irqrestore(&i2s->irq_lock, flags); in stm32_i2s_shutdown()
709 struct stm32_i2s_data *i2s = dev_get_drvdata(cpu_dai->dev); in stm32_i2s_dai_probe() local
710 struct snd_dmaengine_dai_dma_data *dma_data_tx = &i2s->dma_data_tx; in stm32_i2s_dai_probe()
711 struct snd_dmaengine_dai_dma_data *dma_data_rx = &i2s->dma_data_rx; in stm32_i2s_dai_probe()
714 dma_data_tx->addr_width = DMA_SLAVE_BUSWIDTH_UNDEFINED; in stm32_i2s_dai_probe()
715 dma_data_tx->addr = (dma_addr_t)(i2s->phys_addr) + STM32_I2S_TXDR_REG; in stm32_i2s_dai_probe()
716 dma_data_tx->maxburst = 1; in stm32_i2s_dai_probe()
717 dma_data_rx->addr_width = DMA_SLAVE_BUSWIDTH_UNDEFINED; in stm32_i2s_dai_probe()
718 dma_data_rx->addr = (dma_addr_t)(i2s->phys_addr) + STM32_I2S_RXDR_REG; in stm32_i2s_dai_probe()
719 dma_data_rx->maxburst = 1; in stm32_i2s_dai_probe()
764 .name = "stm32-i2s",
770 stream->stream_name = stream_name; in stm32_i2s_dai_init()
771 stream->channels_min = 1; in stm32_i2s_dai_init()
772 stream->channels_max = 2; in stm32_i2s_dai_init()
773 stream->rates = SNDRV_PCM_RATE_8000_192000; in stm32_i2s_dai_init()
774 stream->formats = SNDRV_PCM_FMTBIT_S16_LE | in stm32_i2s_dai_init()
779 struct stm32_i2s_data *i2s) in stm32_i2s_dais_init() argument
783 dai_ptr = devm_kzalloc(&pdev->dev, sizeof(struct snd_soc_dai_driver), in stm32_i2s_dais_init()
786 return -ENOMEM; in stm32_i2s_dais_init()
788 dai_ptr->probe = stm32_i2s_dai_probe; in stm32_i2s_dais_init()
789 dai_ptr->ops = &stm32_i2s_pcm_dai_ops; in stm32_i2s_dais_init()
790 dai_ptr->id = 1; in stm32_i2s_dais_init()
791 stm32_i2s_dai_init(&dai_ptr->playback, "playback"); in stm32_i2s_dais_init()
792 stm32_i2s_dai_init(&dai_ptr->capture, "capture"); in stm32_i2s_dais_init()
793 i2s->dai_drv = dai_ptr; in stm32_i2s_dais_init()
800 .compatible = "st,stm32h7-i2s",
807 struct stm32_i2s_data *i2s) in stm32_i2s_parse_dt() argument
809 struct device_node *np = pdev->dev.of_node; in stm32_i2s_parse_dt()
816 return -ENODEV; in stm32_i2s_parse_dt()
818 of_id = of_match_device(stm32_i2s_ids, &pdev->dev); in stm32_i2s_parse_dt()
820 i2s->regmap_conf = (const struct regmap_config *)of_id->data; in stm32_i2s_parse_dt()
822 return -EINVAL; in stm32_i2s_parse_dt()
825 i2s->base = devm_ioremap_resource(&pdev->dev, res); in stm32_i2s_parse_dt()
826 if (IS_ERR(i2s->base)) in stm32_i2s_parse_dt()
827 return PTR_ERR(i2s->base); in stm32_i2s_parse_dt()
829 i2s->phys_addr = res->start; in stm32_i2s_parse_dt()
832 i2s->pclk = devm_clk_get(&pdev->dev, "pclk"); in stm32_i2s_parse_dt()
833 if (IS_ERR(i2s->pclk)) { in stm32_i2s_parse_dt()
834 if (PTR_ERR(i2s->pclk) != -EPROBE_DEFER) in stm32_i2s_parse_dt()
835 dev_err(&pdev->dev, "Could not get pclk: %ld\n", in stm32_i2s_parse_dt()
836 PTR_ERR(i2s->pclk)); in stm32_i2s_parse_dt()
837 return PTR_ERR(i2s->pclk); in stm32_i2s_parse_dt()
840 i2s->i2sclk = devm_clk_get(&pdev->dev, "i2sclk"); in stm32_i2s_parse_dt()
841 if (IS_ERR(i2s->i2sclk)) { in stm32_i2s_parse_dt()
842 if (PTR_ERR(i2s->i2sclk) != -EPROBE_DEFER) in stm32_i2s_parse_dt()
843 dev_err(&pdev->dev, "Could not get i2sclk: %ld\n", in stm32_i2s_parse_dt()
844 PTR_ERR(i2s->i2sclk)); in stm32_i2s_parse_dt()
845 return PTR_ERR(i2s->i2sclk); in stm32_i2s_parse_dt()
848 i2s->x8kclk = devm_clk_get(&pdev->dev, "x8k"); in stm32_i2s_parse_dt()
849 if (IS_ERR(i2s->x8kclk)) { in stm32_i2s_parse_dt()
850 if (PTR_ERR(i2s->x8kclk) != -EPROBE_DEFER) in stm32_i2s_parse_dt()
851 dev_err(&pdev->dev, "Could not get x8k parent clock: %ld\n", in stm32_i2s_parse_dt()
852 PTR_ERR(i2s->x8kclk)); in stm32_i2s_parse_dt()
853 return PTR_ERR(i2s->x8kclk); in stm32_i2s_parse_dt()
856 i2s->x11kclk = devm_clk_get(&pdev->dev, "x11k"); in stm32_i2s_parse_dt()
857 if (IS_ERR(i2s->x11kclk)) { in stm32_i2s_parse_dt()
858 if (PTR_ERR(i2s->x11kclk) != -EPROBE_DEFER) in stm32_i2s_parse_dt()
859 dev_err(&pdev->dev, "Could not get x11k parent clock: %ld\n", in stm32_i2s_parse_dt()
860 PTR_ERR(i2s->x11kclk)); in stm32_i2s_parse_dt()
861 return PTR_ERR(i2s->x11kclk); in stm32_i2s_parse_dt()
869 ret = devm_request_irq(&pdev->dev, irq, stm32_i2s_isr, IRQF_ONESHOT, in stm32_i2s_parse_dt()
870 dev_name(&pdev->dev), i2s); in stm32_i2s_parse_dt()
872 dev_err(&pdev->dev, "irq request returned %d\n", ret); in stm32_i2s_parse_dt()
877 rst = devm_reset_control_get_optional_exclusive(&pdev->dev, NULL); in stm32_i2s_parse_dt()
879 if (PTR_ERR(rst) != -EPROBE_DEFER) in stm32_i2s_parse_dt()
880 dev_err(&pdev->dev, "Reset controller error %ld\n", in stm32_i2s_parse_dt()
893 snd_dmaengine_pcm_unregister(&pdev->dev); in stm32_i2s_remove()
894 snd_soc_unregister_component(&pdev->dev); in stm32_i2s_remove()
901 struct stm32_i2s_data *i2s; in stm32_i2s_probe() local
905 i2s = devm_kzalloc(&pdev->dev, sizeof(*i2s), GFP_KERNEL); in stm32_i2s_probe()
906 if (!i2s) in stm32_i2s_probe()
907 return -ENOMEM; in stm32_i2s_probe()
909 ret = stm32_i2s_parse_dt(pdev, i2s); in stm32_i2s_probe()
913 i2s->pdev = pdev; in stm32_i2s_probe()
914 i2s->ms_flg = I2S_MS_NOT_SET; in stm32_i2s_probe()
915 spin_lock_init(&i2s->lock_fd); in stm32_i2s_probe()
916 spin_lock_init(&i2s->irq_lock); in stm32_i2s_probe()
917 platform_set_drvdata(pdev, i2s); in stm32_i2s_probe()
919 ret = stm32_i2s_dais_init(pdev, i2s); in stm32_i2s_probe()
923 i2s->regmap = devm_regmap_init_mmio_clk(&pdev->dev, "pclk", in stm32_i2s_probe()
924 i2s->base, i2s->regmap_conf); in stm32_i2s_probe()
925 if (IS_ERR(i2s->regmap)) { in stm32_i2s_probe()
926 if (PTR_ERR(i2s->regmap) != -EPROBE_DEFER) in stm32_i2s_probe()
927 dev_err(&pdev->dev, "Regmap init error %ld\n", in stm32_i2s_probe()
928 PTR_ERR(i2s->regmap)); in stm32_i2s_probe()
929 return PTR_ERR(i2s->regmap); in stm32_i2s_probe()
932 ret = snd_dmaengine_pcm_register(&pdev->dev, &stm32_i2s_pcm_config, 0); in stm32_i2s_probe()
934 if (ret != -EPROBE_DEFER) in stm32_i2s_probe()
935 dev_err(&pdev->dev, "PCM DMA register error %d\n", ret); in stm32_i2s_probe()
939 ret = snd_soc_register_component(&pdev->dev, &stm32_i2s_component, in stm32_i2s_probe()
940 i2s->dai_drv, 1); in stm32_i2s_probe()
942 snd_dmaengine_pcm_unregister(&pdev->dev); in stm32_i2s_probe()
946 /* Set SPI/I2S in i2s mode */ in stm32_i2s_probe()
947 ret = regmap_update_bits(i2s->regmap, STM32_I2S_CGFR_REG, in stm32_i2s_probe()
952 ret = regmap_read(i2s->regmap, STM32_I2S_IPIDR_REG, &val); in stm32_i2s_probe()
957 ret = regmap_read(i2s->regmap, STM32_I2S_HWCFGR_REG, &val); in stm32_i2s_probe()
962 dev_err(&pdev->dev, in stm32_i2s_probe()
963 "Device does not support i2s mode\n"); in stm32_i2s_probe()
964 ret = -EPERM; in stm32_i2s_probe()
968 ret = regmap_read(i2s->regmap, STM32_I2S_VERR_REG, &val); in stm32_i2s_probe()
972 dev_dbg(&pdev->dev, "I2S version: %lu.%lu registered\n", in stm32_i2s_probe()
990 struct stm32_i2s_data *i2s = dev_get_drvdata(dev); in stm32_i2s_suspend() local
992 regcache_cache_only(i2s->regmap, true); in stm32_i2s_suspend()
993 regcache_mark_dirty(i2s->regmap); in stm32_i2s_suspend()
1000 struct stm32_i2s_data *i2s = dev_get_drvdata(dev); in stm32_i2s_resume() local
1002 regcache_cache_only(i2s->regmap, false); in stm32_i2s_resume()
1003 return regcache_sync(i2s->regmap); in stm32_i2s_resume()
1013 .name = "st,stm32-i2s",
1023 MODULE_DESCRIPTION("STM32 Soc i2s Interface");
1025 MODULE_ALIAS("platform:stm32-i2s");