Loading...
1 2 3 4 5 6 7 8 9 10 11 12 13 14 15 16 17 18 19 20 21 22 23 24 25 26 27 28 29 30 31 32 33 34 35 36 37 38 39 40 41 42 43 44 45 46 47 48 49 50 51 52 53 54 55 56 57 58 59 60 61 62 63 64 65 66 67 68 69 70 71 72 73 74 75 76 77 78 79 80 81 82 83 84 85 86 87 88 89 90 91 92 93 94 95 96 97 98 99 100 101 102 103 104 105 106 107 108 109 110 111 112 113 114 115 116 117 118 119 120 121 122 123 124 125 126 127 128 129 130 131 132 133 134 135 136 137 138 139 140 141 142 143 144 145 146 147 148 149 150 151 152 153 154 155 156 157 158 159 160 161 162 163 164 165 166 167 168 169 170 171 172 173 174 175 176 177 178 | // SPDX-License-Identifier: GPL-2.0+ // Copyright 2017-2020 NXP #include <linux/module.h> #include <linux/of_platform.h> #include <linux/of_reserved_mem.h> #include <linux/i2c.h> #include <linux/of_gpio.h> #include <linux/slab.h> #include <linux/gpio.h> #include <linux/clk.h> #include <sound/soc.h> #include <sound/jack.h> #include <sound/control.h> #include <sound/pcm_params.h> #include <sound/soc-dapm.h> #include "imx-pcm-rpmsg.h" struct imx_rpmsg { struct snd_soc_dai_link dai; struct snd_soc_card card; unsigned long sysclk; }; static const struct snd_soc_dapm_widget imx_rpmsg_dapm_widgets[] = { SND_SOC_DAPM_HP("Headphone Jack", NULL), SND_SOC_DAPM_SPK("Ext Spk", NULL), SND_SOC_DAPM_MIC("Mic Jack", NULL), SND_SOC_DAPM_MIC("Main MIC", NULL), }; static int imx_rpmsg_late_probe(struct snd_soc_card *card) { struct imx_rpmsg *data = snd_soc_card_get_drvdata(card); struct snd_soc_pcm_runtime *rtd = list_first_entry(&card->rtd_list, struct snd_soc_pcm_runtime, list); struct snd_soc_dai *codec_dai = asoc_rtd_to_codec(rtd, 0); struct device *dev = card->dev; int ret; if (!data->sysclk) return 0; ret = snd_soc_dai_set_sysclk(codec_dai, 0, data->sysclk, SND_SOC_CLOCK_IN); if (ret && ret != -ENOTSUPP) { dev_err(dev, "failed to set sysclk in %s\n", __func__); return ret; } return 0; } static int imx_rpmsg_probe(struct platform_device *pdev) { struct snd_soc_dai_link_component *dlc; struct device *dev = pdev->dev.parent; /* rpmsg_pdev is the platform device for the rpmsg node that probed us */ struct platform_device *rpmsg_pdev = to_platform_device(dev); struct device_node *np = rpmsg_pdev->dev.of_node; struct of_phandle_args args; struct imx_rpmsg *data; int ret = 0; dlc = devm_kzalloc(&pdev->dev, 3 * sizeof(*dlc), GFP_KERNEL); if (!dlc) return -ENOMEM; data = devm_kzalloc(&pdev->dev, sizeof(*data), GFP_KERNEL); if (!data) { ret = -ENOMEM; goto fail; } ret = of_reserved_mem_device_init_by_idx(&pdev->dev, np, 0); if (ret) dev_warn(&pdev->dev, "no reserved DMA memory\n"); data->dai.cpus = &dlc[0]; data->dai.num_cpus = 1; data->dai.platforms = &dlc[1]; data->dai.num_platforms = 1; data->dai.codecs = &dlc[2]; data->dai.num_codecs = 1; data->dai.name = "rpmsg hifi"; data->dai.stream_name = "rpmsg hifi"; data->dai.dai_fmt = SND_SOC_DAIFMT_I2S | SND_SOC_DAIFMT_NB_NF | SND_SOC_DAIFMT_CBC_CFC; /* Optional codec node */ ret = of_parse_phandle_with_fixed_args(np, "audio-codec", 0, 0, &args); if (ret) { data->dai.codecs->dai_name = "snd-soc-dummy-dai"; data->dai.codecs->name = "snd-soc-dummy"; } else { struct clk *clk; data->dai.codecs->of_node = args.np; ret = snd_soc_get_dai_name(&args, &data->dai.codecs->dai_name); if (ret) { dev_err(&pdev->dev, "Unable to get codec_dai_name\n"); goto fail; } clk = devm_get_clk_from_child(&pdev->dev, args.np, NULL); if (!IS_ERR(clk)) data->sysclk = clk_get_rate(clk); } data->dai.cpus->dai_name = dev_name(&rpmsg_pdev->dev); data->dai.platforms->name = IMX_PCM_DRV_NAME; data->dai.playback_only = true; data->dai.capture_only = true; data->card.num_links = 1; data->card.dai_link = &data->dai; if (of_property_read_bool(np, "fsl,rpmsg-out")) data->dai.capture_only = false; if (of_property_read_bool(np, "fsl,rpmsg-in")) data->dai.playback_only = false; if (data->dai.playback_only && data->dai.capture_only) { dev_err(&pdev->dev, "no enabled rpmsg DAI link\n"); ret = -EINVAL; goto fail; } data->card.dev = &pdev->dev; data->card.owner = THIS_MODULE; data->card.dapm_widgets = imx_rpmsg_dapm_widgets; data->card.num_dapm_widgets = ARRAY_SIZE(imx_rpmsg_dapm_widgets); data->card.late_probe = imx_rpmsg_late_probe; /* * Inoder to use common api to get card name and audio routing. * Use parent of_node for this device, revert it after finishing using */ data->card.dev->of_node = np; ret = snd_soc_of_parse_card_name(&data->card, "model"); if (ret) goto fail; if (of_property_read_bool(np, "audio-routing")) { ret = snd_soc_of_parse_audio_routing(&data->card, "audio-routing"); if (ret) { dev_err(&pdev->dev, "failed to parse audio-routing: %d\n", ret); goto fail; } } platform_set_drvdata(pdev, &data->card); snd_soc_card_set_drvdata(&data->card, data); ret = devm_snd_soc_register_card(&pdev->dev, &data->card); if (ret) { dev_err_probe(&pdev->dev, ret, "snd_soc_register_card failed\n"); goto fail; } fail: pdev->dev.of_node = NULL; return ret; } static struct platform_driver imx_rpmsg_driver = { .driver = { .name = "imx-audio-rpmsg", .pm = &snd_soc_pm_ops, }, .probe = imx_rpmsg_probe, }; module_platform_driver(imx_rpmsg_driver); MODULE_DESCRIPTION("Freescale SoC Audio RPMSG Machine Driver"); MODULE_AUTHOR("Shengjiu Wang <shengjiu.wang@nxp.com>"); MODULE_ALIAS("platform:imx-audio-rpmsg"); MODULE_LICENSE("GPL v2"); |