Lines Matching +full:sama7g5 +full:- +full:pdmc
1 // SPDX-License-Identifier: GPL-2.0
3 // Driver for Microchip Pulse Density Microphone Controller (PDMC) interfaces
5 // Copyright (C) 2019-2022 Microchip Technology Inc. and its subsidiaries
9 #include <dt-bindings/sound/microchip,pdmc.h>
24 * ---- PDMC Register map ----
37 * ---- Control Register (Write-only) ----
42 * ---- Mode Register (Read/Write) ----
66 * ---- Configuration Register (Read/Write) ----
75 * ---- Interrupt Enable/Disable/Mask/Status Registers ----
85 * ---- Version Register (Read-only) ----
139 struct soc_enum *e = (struct soc_enum *)kcontrol->private_value; in mchp_pdmc_sinc_order_get()
142 item = snd_soc_enum_val_to_item(e, dd->sinc_order); in mchp_pdmc_sinc_order_get()
143 uvalue->value.enumerated.item[0] = item; in mchp_pdmc_sinc_order_get()
153 struct soc_enum *e = (struct soc_enum *)kcontrol->private_value; in mchp_pdmc_sinc_order_put()
154 unsigned int *item = uvalue->value.enumerated.item; in mchp_pdmc_sinc_order_put()
157 if (item[0] >= e->items) in mchp_pdmc_sinc_order_put()
158 return -EINVAL; in mchp_pdmc_sinc_order_put()
160 val = snd_soc_enum_item_to_val(e, item[0]) << e->shift_l; in mchp_pdmc_sinc_order_put()
161 if (val == dd->sinc_order) in mchp_pdmc_sinc_order_put()
164 dd->sinc_order = val; in mchp_pdmc_sinc_order_put()
175 uvalue->value.integer.value[0] = !!dd->audio_filter_en; in mchp_pdmc_af_get()
185 bool af = uvalue->value.integer.value[0] ? true : false; in mchp_pdmc_af_put()
187 if (dd->audio_filter_en == af) in mchp_pdmc_af_put()
190 dd->audio_filter_en = af; in mchp_pdmc_af_put()
199 uinfo->type = SNDRV_CTL_ELEM_TYPE_INTEGER; in mchp_pdmc_chmap_ctl_info()
200 uinfo->count = info->dd->mic_no; in mchp_pdmc_chmap_ctl_info()
201 uinfo->value.integer.min = 0; in mchp_pdmc_chmap_ctl_info()
202 uinfo->value.integer.max = SNDRV_CHMAP_RR; /* maxmimum 4 channels */ in mchp_pdmc_chmap_ctl_info()
211 for (s = info->pcm->streams[SNDRV_PCM_STREAM_CAPTURE].substream; s; s = s->next) in mchp_pdmc_chmap_substream()
212 if (s->number == idx) in mchp_pdmc_chmap_substream()
222 for (map = ch_info->chmap; map->channels; map++) { in mchp_pdmc_chmap_get()
223 if (map->channels == substream->runtime->channels) in mchp_pdmc_chmap_get()
233 struct mchp_pdmc *dd = info->dd; in mchp_pdmc_chmap_ctl_get()
234 unsigned int idx = snd_ctl_get_ioffidx(kcontrol, &ucontrol->id); in mchp_pdmc_chmap_ctl_get()
240 if (!info->chmap) in mchp_pdmc_chmap_ctl_get()
241 return -EINVAL; in mchp_pdmc_chmap_ctl_get()
244 return -ENODEV; in mchp_pdmc_chmap_ctl_get()
245 memset(ucontrol->value.integer.value, 0, sizeof(long) * info->dd->mic_no); in mchp_pdmc_chmap_ctl_get()
246 if (!substream->runtime) in mchp_pdmc_chmap_ctl_get()
251 return -EINVAL; in mchp_pdmc_chmap_ctl_get()
253 for (i = 0; i < map->channels; i++) { in mchp_pdmc_chmap_ctl_get()
254 int map_idx = map->channels == 1 ? map->map[i] - SNDRV_CHMAP_MONO : in mchp_pdmc_chmap_ctl_get()
255 map->map[i] - SNDRV_CHMAP_FL; in mchp_pdmc_chmap_ctl_get()
258 if (dd->channel_mic_map[map_idx].ds_pos) in mchp_pdmc_chmap_ctl_get()
260 if (dd->channel_mic_map[map_idx].clk_edge) in mchp_pdmc_chmap_ctl_get()
263 ucontrol->value.integer.value[i] = map->map[i]; in mchp_pdmc_chmap_ctl_get()
266 regmap_write(dd->regmap, MCHP_PDMC_CFGR, cfgr_val); in mchp_pdmc_chmap_ctl_get()
275 struct mchp_pdmc *dd = info->dd; in mchp_pdmc_chmap_ctl_put()
276 unsigned int idx = snd_ctl_get_ioffidx(kcontrol, &ucontrol->id); in mchp_pdmc_chmap_ctl_put()
282 if (!info->chmap) in mchp_pdmc_chmap_ctl_put()
283 return -EINVAL; in mchp_pdmc_chmap_ctl_put()
286 return -ENODEV; in mchp_pdmc_chmap_ctl_put()
290 return -EINVAL; in mchp_pdmc_chmap_ctl_put()
292 for (i = 0; i < map->channels; i++) { in mchp_pdmc_chmap_ctl_put()
295 map->map[i] = ucontrol->value.integer.value[i]; in mchp_pdmc_chmap_ctl_put()
296 map_idx = map->channels == 1 ? map->map[i] - SNDRV_CHMAP_MONO : in mchp_pdmc_chmap_ctl_put()
297 map->map[i] - SNDRV_CHMAP_FL; in mchp_pdmc_chmap_ctl_put()
300 if (dd->channel_mic_map[map_idx].ds_pos) in mchp_pdmc_chmap_ctl_put()
302 if (dd->channel_mic_map[map_idx].clk_edge) in mchp_pdmc_chmap_ctl_put()
306 regmap_write(dd->regmap, MCHP_PDMC_CFGR, cfgr_val); in mchp_pdmc_chmap_ctl_put()
315 info->pcm->streams[SNDRV_PCM_STREAM_CAPTURE].chmap_kctl = NULL; in mchp_pdmc_chmap_ctl_private_free()
327 if (!info->chmap) in mchp_pdmc_chmap_ctl_tlv()
328 return -EINVAL; in mchp_pdmc_chmap_ctl_tlv()
330 return -ENOMEM; in mchp_pdmc_chmap_ctl_tlv()
332 return -EFAULT; in mchp_pdmc_chmap_ctl_tlv()
333 size -= 8; in mchp_pdmc_chmap_ctl_tlv()
335 for (map = info->chmap; map->channels; map++) { in mchp_pdmc_chmap_ctl_tlv()
336 int chs_bytes = map->channels * 4; in mchp_pdmc_chmap_ctl_tlv()
339 return -ENOMEM; in mchp_pdmc_chmap_ctl_tlv()
342 return -EFAULT; in mchp_pdmc_chmap_ctl_tlv()
344 size -= 8; in mchp_pdmc_chmap_ctl_tlv()
347 return -ENOMEM; in mchp_pdmc_chmap_ctl_tlv()
348 size -= chs_bytes; in mchp_pdmc_chmap_ctl_tlv()
350 for (c = 0; c < map->channels; c++) { in mchp_pdmc_chmap_ctl_tlv()
351 if (put_user(map->map[c], dst)) in mchp_pdmc_chmap_ctl_tlv()
352 return -EFAULT; in mchp_pdmc_chmap_ctl_tlv()
357 return -EFAULT; in mchp_pdmc_chmap_ctl_tlv()
391 if (component->name_prefix) in mchp_pdmc_open()
392 snprintf(id.name, sizeof(id.name), "%s %s", component->name_prefix, in mchp_pdmc_open()
393 control->name); in mchp_pdmc_open()
395 strscpy(id.name, control->name, sizeof(id.name)); in mchp_pdmc_open()
398 id.iface = control->iface; in mchp_pdmc_open()
399 id.device = control->device; in mchp_pdmc_open()
400 id.subdevice = control->subdevice; in mchp_pdmc_open()
401 id.index = control->index; in mchp_pdmc_open()
402 err = snd_ctl_remove_id(component->card->snd_card, &id); in mchp_pdmc_open()
404 dev_err(component->dev, "%d: Failed to remove %s\n", err, in mchp_pdmc_open()
405 control->name); in mchp_pdmc_open()
412 .name = "mchp-pdmc",
450 regmap_write(dd->regmap, MCHP_PDMC_CR, MCHP_PDMC_CR_SWRST); in mchp_pdmc_startup()
452 snd_pcm_hw_constraint_list(substream->runtime, 0, SNDRV_PCM_HW_PARAM_CHANNELS, in mchp_pdmc_startup()
453 &mchp_pdmc_chan_constr[dd->mic_no - 1]); in mchp_pdmc_startup()
462 snd_soc_dai_init_dma_data(dai, NULL, &dd->addr); in mchp_pdmc_dai_probe()
475 return -EINVAL; in mchp_pdmc_set_fmt()
479 return -EINVAL; in mchp_pdmc_set_fmt()
544 struct snd_soc_component *comp = dai->component; in mchp_pdmc_hw_params()
555 dev_dbg(comp->dev, "%s() rate=%u format=%#x width=%u channels=%u\n", in mchp_pdmc_hw_params()
559 if (channels > dd->mic_no) { in mchp_pdmc_hw_params()
560 dev_err(comp->dev, "more channels %u than microphones %d\n", in mchp_pdmc_hw_params()
561 channels, dd->mic_no); in mchp_pdmc_hw_params()
562 return -EINVAL; in mchp_pdmc_hw_params()
565 dd->pdmcen = 0; in mchp_pdmc_hw_params()
567 dd->pdmcen |= MCHP_PDMC_MR_PDMCEN(i); in mchp_pdmc_hw_params()
568 if (dd->channel_mic_map[i].ds_pos) in mchp_pdmc_hw_params()
570 if (dd->channel_mic_map[i].clk_edge) in mchp_pdmc_hw_params()
574 for (osr_start = dd->audio_filter_en ? 64 : 8; in mchp_pdmc_hw_params()
579 round_rate = clk_round_rate(dd->gclk, in mchp_pdmc_hw_params()
583 diff_rate = abs((fs * 16 * osr_start) - round_rate); in mchp_pdmc_hw_params()
591 dev_err(comp->dev, "invalid sampling rate: %u\n", fs); in mchp_pdmc_hw_params()
592 return -EINVAL; in mchp_pdmc_hw_params()
596 clk_disable_unprepare(dd->gclk); in mchp_pdmc_hw_params()
599 ret = clk_set_rate(dd->gclk, gclk_rate); in mchp_pdmc_hw_params()
600 clk_prepare_enable(dd->gclk); in mchp_pdmc_hw_params()
602 dev_err(comp->dev, "unable to set rate %lu to GCLK: %d\n", in mchp_pdmc_hw_params()
607 mr_val |= mchp_pdmc_mr_set_osr(dd->audio_filter_en, osr); in mchp_pdmc_hw_params()
609 mr_val |= FIELD_PREP(MCHP_PDMC_MR_SINCORDER_MASK, dd->sinc_order); in mchp_pdmc_hw_params()
611 dd->addr.maxburst = mchp_pdmc_period_to_maxburst(snd_pcm_lib_period_bytes(substream)); in mchp_pdmc_hw_params()
612 mr_val |= FIELD_PREP(MCHP_PDMC_MR_CHUNK_MASK, dd->addr.maxburst); in mchp_pdmc_hw_params()
613 dev_dbg(comp->dev, "maxburst set to %d\n", dd->addr.maxburst); in mchp_pdmc_hw_params()
631 * PDMC doesn't wait for microphones' startup time thus the acquisition in mchp_pdmc_noise_filter_workaround()
640 usleep_range(dd->startup_delay_us, dd->startup_delay_us + 5); in mchp_pdmc_noise_filter_workaround()
642 while (steps--) in mchp_pdmc_noise_filter_workaround()
643 regmap_read(dd->regmap, MCHP_PDMC_RHR, &tmp); in mchp_pdmc_noise_filter_workaround()
646 regmap_read(dd->regmap, MCHP_PDMC_ISR, &tmp); in mchp_pdmc_noise_filter_workaround()
653 struct snd_soc_component *cpu = dai->component; in mchp_pdmc_trigger()
664 dd->pdmcen); in mchp_pdmc_trigger()
669 regmap_write(dd->regmap, MCHP_PDMC_IER, dd->suspend_irq | in mchp_pdmc_trigger()
671 dd->suspend_irq = 0; in mchp_pdmc_trigger()
674 regmap_read(dd->regmap, MCHP_PDMC_IMR, &dd->suspend_irq); in mchp_pdmc_trigger()
678 regmap_write(dd->regmap, MCHP_PDMC_IDR, dd->suspend_irq | in mchp_pdmc_trigger()
686 return -EINVAL; in mchp_pdmc_trigger()
690 regmap_read(dd->regmap, MCHP_PDMC_MR, &val); in mchp_pdmc_trigger()
691 dev_dbg(dd->dev, "MR (0x%02x): 0x%08x\n", MCHP_PDMC_MR, val); in mchp_pdmc_trigger()
692 regmap_read(dd->regmap, MCHP_PDMC_CFGR, &val); in mchp_pdmc_trigger()
693 dev_dbg(dd->dev, "CFGR (0x%02x): 0x%08x\n", MCHP_PDMC_CFGR, val); in mchp_pdmc_trigger()
694 regmap_read(dd->regmap, MCHP_PDMC_IMR, &val); in mchp_pdmc_trigger()
695 dev_dbg(dd->dev, "IMR (0x%02x): 0x%08x\n", MCHP_PDMC_IMR, val); in mchp_pdmc_trigger()
716 if (WARN_ON(pcm->streams[SNDRV_PCM_STREAM_CAPTURE].chmap_kctl)) in mchp_pdmc_add_chmap_ctls()
717 return -EBUSY; in mchp_pdmc_add_chmap_ctls()
720 return -ENOMEM; in mchp_pdmc_add_chmap_ctls()
721 info->pcm = pcm; in mchp_pdmc_add_chmap_ctls()
722 info->dd = dd; in mchp_pdmc_add_chmap_ctls()
723 info->chmap = mchp_pdmc_std_chmaps; in mchp_pdmc_add_chmap_ctls()
725 knew.device = pcm->device; in mchp_pdmc_add_chmap_ctls()
726 knew.count = pcm->streams[SNDRV_PCM_STREAM_CAPTURE].substream_count; in mchp_pdmc_add_chmap_ctls()
727 info->kctl = snd_ctl_new1(&knew, info); in mchp_pdmc_add_chmap_ctls()
728 if (!info->kctl) { in mchp_pdmc_add_chmap_ctls()
730 return -ENOMEM; in mchp_pdmc_add_chmap_ctls()
732 info->kctl->private_free = mchp_pdmc_chmap_ctl_private_free; in mchp_pdmc_add_chmap_ctls()
733 err = snd_ctl_add(pcm->card, info->kctl); in mchp_pdmc_add_chmap_ctls()
736 pcm->streams[SNDRV_PCM_STREAM_CAPTURE].chmap_kctl = info->kctl; in mchp_pdmc_add_chmap_ctls()
746 ret = mchp_pdmc_add_chmap_ctls(rtd->pcm, dd); in mchp_pdmc_pcm_new()
748 dev_err(dd->dev, "failed to add channel map controls: %d\n", ret); in mchp_pdmc_pcm_new()
775 /* PDMC interrupt handler */
782 regmap_read(dd->regmap, MCHP_PDMC_ISR, &isr); in mchp_pdmc_interrupt()
783 regmap_read(dd->regmap, MCHP_PDMC_IMR, &msr); in mchp_pdmc_interrupt()
786 dev_dbg(dd->dev, "ISR (0x%02x): 0x%08x, IMR (0x%02x): 0x%08x, pending: 0x%08x\n", in mchp_pdmc_interrupt()
792 dev_warn(dd->dev, "underrun detected\n"); in mchp_pdmc_interrupt()
793 regmap_write(dd->regmap, MCHP_PDMC_IDR, MCHP_PDMC_IR_RXUDR); in mchp_pdmc_interrupt()
797 dev_warn(dd->dev, "overrun detected\n"); in mchp_pdmc_interrupt()
798 regmap_write(dd->regmap, MCHP_PDMC_IDR, MCHP_PDMC_IR_RXOVR); in mchp_pdmc_interrupt()
871 struct device_node *np = dd->dev->of_node; in mchp_pdmc_dt_init()
877 dev_err(dd->dev, "device node not found\n"); in mchp_pdmc_dt_init()
878 return -EINVAL; in mchp_pdmc_dt_init()
881 dd->mic_no = of_property_count_u32_elems(np, "microchip,mic-pos"); in mchp_pdmc_dt_init()
882 if (dd->mic_no < 0) { in mchp_pdmc_dt_init()
883 dev_err(dd->dev, "failed to get microchip,mic-pos: %d", in mchp_pdmc_dt_init()
884 dd->mic_no); in mchp_pdmc_dt_init()
885 return dd->mic_no; in mchp_pdmc_dt_init()
887 if (!dd->mic_no || dd->mic_no % 2 || in mchp_pdmc_dt_init()
888 dd->mic_no / 2 > MCHP_PDMC_MAX_CHANNELS) { in mchp_pdmc_dt_init()
889 dev_err(dd->dev, "invalid array length for microchip,mic-pos: %d", in mchp_pdmc_dt_init()
890 dd->mic_no); in mchp_pdmc_dt_init()
891 return -EINVAL; in mchp_pdmc_dt_init()
894 dd->mic_no /= 2; in mchp_pdmc_dt_init()
896 dev_info(dd->dev, "%d PDM microphones declared\n", dd->mic_no); in mchp_pdmc_dt_init()
900 * microchip,mic-pos to be the same with the channel mapping; in mchp_pdmc_dt_init()
903 for (i = 0; i < dd->mic_no; i++) { in mchp_pdmc_dt_init()
907 ret = of_property_read_u32_index(np, "microchip,mic-pos", i * 2, in mchp_pdmc_dt_init()
910 dev_err(dd->dev, in mchp_pdmc_dt_init()
911 "failed to get value no %d value from microchip,mic-pos: %d", in mchp_pdmc_dt_init()
916 dev_err(dd->dev, in mchp_pdmc_dt_init()
917 "invalid DS index in microchip,mic-pos array: %d", in mchp_pdmc_dt_init()
919 return -EINVAL; in mchp_pdmc_dt_init()
922 ret = of_property_read_u32_index(np, "microchip,mic-pos", i * 2 + 1, in mchp_pdmc_dt_init()
925 dev_err(dd->dev, in mchp_pdmc_dt_init()
926 "failed to get value no %d value from microchip,mic-pos: %d", in mchp_pdmc_dt_init()
933 dev_err(dd->dev, in mchp_pdmc_dt_init()
934 "invalid edge in microchip,mic-pos array: %d", edge); in mchp_pdmc_dt_init()
935 return -EINVAL; in mchp_pdmc_dt_init()
938 dev_err(dd->dev, in mchp_pdmc_dt_init()
939 "duplicated mic (DS %d, edge %d) in microchip,mic-pos array", in mchp_pdmc_dt_init()
941 return -EINVAL; in mchp_pdmc_dt_init()
944 dd->channel_mic_map[i].ds_pos = ds; in mchp_pdmc_dt_init()
945 dd->channel_mic_map[i].clk_edge = edge; in mchp_pdmc_dt_init()
948 dd->startup_delay_us = 150000; in mchp_pdmc_dt_init()
949 of_property_read_u32(np, "microchip,startup-delay-us", &dd->startup_delay_us); in mchp_pdmc_dt_init()
959 struct snd_pcm_runtime *runtime = substream->runtime; in mchp_pdmc_process()
960 u8 *dma_ptr = runtime->dma_area + hwoff + in mchp_pdmc_process()
961 channel * (runtime->dma_bytes / runtime->channels); in mchp_pdmc_process()
980 regcache_cache_only(dd->regmap, true); in mchp_pdmc_runtime_suspend()
982 clk_disable_unprepare(dd->gclk); in mchp_pdmc_runtime_suspend()
983 clk_disable_unprepare(dd->pclk); in mchp_pdmc_runtime_suspend()
993 ret = clk_prepare_enable(dd->pclk); in mchp_pdmc_runtime_resume()
995 dev_err(dd->dev, in mchp_pdmc_runtime_resume()
999 ret = clk_prepare_enable(dd->gclk); in mchp_pdmc_runtime_resume()
1001 dev_err(dd->dev, in mchp_pdmc_runtime_resume()
1006 regcache_cache_only(dd->regmap, false); in mchp_pdmc_runtime_resume()
1007 regcache_mark_dirty(dd->regmap); in mchp_pdmc_runtime_resume()
1008 ret = regcache_sync(dd->regmap); in mchp_pdmc_runtime_resume()
1010 regcache_cache_only(dd->regmap, true); in mchp_pdmc_runtime_resume()
1011 clk_disable_unprepare(dd->gclk); in mchp_pdmc_runtime_resume()
1013 clk_disable_unprepare(dd->pclk); in mchp_pdmc_runtime_resume()
1021 struct device *dev = &pdev->dev; in mchp_pdmc_probe()
1031 return -ENOMEM; in mchp_pdmc_probe()
1033 dd->dev = &pdev->dev; in mchp_pdmc_probe()
1042 dd->pclk = devm_clk_get(dev, "pclk"); in mchp_pdmc_probe()
1043 if (IS_ERR(dd->pclk)) { in mchp_pdmc_probe()
1044 ret = PTR_ERR(dd->pclk); in mchp_pdmc_probe()
1049 dd->gclk = devm_clk_get(dev, "gclk"); in mchp_pdmc_probe()
1050 if (IS_ERR(dd->gclk)) { in mchp_pdmc_probe()
1051 ret = PTR_ERR(dd->gclk); in mchp_pdmc_probe()
1063 dd->regmap = devm_regmap_init_mmio(dev, io_base, in mchp_pdmc_probe()
1065 if (IS_ERR(dd->regmap)) { in mchp_pdmc_probe()
1066 ret = PTR_ERR(dd->regmap); in mchp_pdmc_probe()
1072 dev_name(&pdev->dev), dd); in mchp_pdmc_probe()
1082 dd->audio_filter_en = true; in mchp_pdmc_probe()
1083 dd->sinc_order = 3; in mchp_pdmc_probe()
1085 dd->addr.addr = (dma_addr_t)res->start + MCHP_PDMC_RHR; in mchp_pdmc_probe()
1088 pm_runtime_enable(dd->dev); in mchp_pdmc_probe()
1089 if (!pm_runtime_enabled(dd->dev)) { in mchp_pdmc_probe()
1090 ret = mchp_pdmc_runtime_resume(dd->dev); in mchp_pdmc_probe()
1110 regmap_read(dd->regmap, MCHP_PDMC_VER, &version); in mchp_pdmc_probe()
1111 dev_info(dd->dev, "hw version: %#lx\n", in mchp_pdmc_probe()
1117 if (!pm_runtime_status_suspended(dd->dev)) in mchp_pdmc_probe()
1118 mchp_pdmc_runtime_suspend(dd->dev); in mchp_pdmc_probe()
1119 pm_runtime_disable(dd->dev); in mchp_pdmc_probe()
1128 if (!pm_runtime_status_suspended(dd->dev)) in mchp_pdmc_remove()
1129 mchp_pdmc_runtime_suspend(dd->dev); in mchp_pdmc_remove()
1131 pm_runtime_disable(dd->dev); in mchp_pdmc_remove()
1136 .compatible = "microchip,sama7g5-pdmc",
1151 .name = "mchp-pdmc",
1160 MODULE_DESCRIPTION("Microchip PDMC driver under ALSA SoC architecture");