avs/boards/i2s_test.c

0001 // SPDX-License-Identifier: GPL-2.0-only
0002 //
0003 // Copyright(c) 2021-2022 Intel Corporation. All rights reserved.
0004 //
0005 // Authors: Cezary Rojewski <cezary.rojewski@intel.com>
0006 //          Amadeusz Slawinski <amadeuszx.slawinski@linux.intel.com>
0007 //
0008
0009 #include <linux/module.h>
0010 #include <sound/pcm.h>
0011 #include <sound/pcm_params.h>
0012 #include <sound/soc.h>
0013 #include <sound/soc-acpi.h>
0014 #include <sound/soc-dapm.h>
0015
0016 static int avs_create_dai_link(struct device *dev, const char *platform_name, int ssp_port,
0017                    struct snd_soc_dai_link **dai_link)
0018 {
0019     struct snd_soc_dai_link_component *platform;
0020     struct snd_soc_dai_link *dl;
0021
0022     dl = devm_kzalloc(dev, sizeof(*dl), GFP_KERNEL);
0023     platform = devm_kzalloc(dev, sizeof(*platform), GFP_KERNEL);
0024     if (!dl || !platform)
0025         return -ENOMEM;
0026
0027     platform->name = platform_name;
0028
0029     dl->name = devm_kasprintf(dev, GFP_KERNEL, "SSP%d-Codec", ssp_port);
0030     dl->cpus = devm_kzalloc(dev, sizeof(*dl->cpus), GFP_KERNEL);
0031     dl->codecs = devm_kzalloc(dev, sizeof(*dl->codecs), GFP_KERNEL);
0032     if (!dl->name || !dl->cpus || !dl->codecs)
0033         return -ENOMEM;
0034
0035     dl->cpus->dai_name = devm_kasprintf(dev, GFP_KERNEL, "SSP%d Pin", ssp_port);
0036     dl->codecs->name = devm_kasprintf(dev, GFP_KERNEL, "snd-soc-dummy");
0037     dl->codecs->dai_name = devm_kasprintf(dev, GFP_KERNEL, "snd-soc-dummy-dai");
0038     if (!dl->cpus->dai_name || !dl->codecs->name || !dl->codecs->dai_name)
0039         return -ENOMEM;
0040
0041     dl->num_cpus = 1;
0042     dl->num_codecs = 1;
0043     dl->platforms = platform;
0044     dl->num_platforms = 1;
0045     dl->id = 0;
0046     dl->nonatomic = 1;
0047     dl->no_pcm = 1;
0048     dl->dpcm_capture = 1;
0049     dl->dpcm_playback = 1;
0050
0051     *dai_link = dl;
0052
0053     return 0;
0054 }
0055
0056 static int avs_create_dapm_routes(struct device *dev, int ssp_port,
0057                   struct snd_soc_dapm_route **routes, int *num_routes)
0058 {
0059     struct snd_soc_dapm_route *dr;
0060     const int num_dr = 2;
0061
0062     dr = devm_kcalloc(dev, num_dr, sizeof(*dr), GFP_KERNEL);
0063     if (!dr)
0064         return -ENOMEM;
0065
0066     dr[0].sink = devm_kasprintf(dev, GFP_KERNEL, "ssp%dpb", ssp_port);
0067     dr[0].source = devm_kasprintf(dev, GFP_KERNEL, "ssp%d Tx", ssp_port);
0068     if (!dr[0].sink || !dr[0].source)
0069         return -ENOMEM;
0070
0071     dr[1].sink = devm_kasprintf(dev, GFP_KERNEL, "ssp%d Rx", ssp_port);
0072     dr[1].source = devm_kasprintf(dev, GFP_KERNEL, "ssp%dcp", ssp_port);
0073     if (!dr[1].sink || !dr[1].source)
0074         return -ENOMEM;
0075
0076     *routes = dr;
0077     *num_routes = num_dr;
0078
0079     return 0;
0080 }
0081
0082 static int avs_create_dapm_widgets(struct device *dev, int ssp_port,
0083                    struct snd_soc_dapm_widget **widgets, int *num_widgets)
0084 {
0085     struct snd_soc_dapm_widget *dw;
0086     const int num_dw = 2;
0087
0088     dw = devm_kcalloc(dev, num_dw, sizeof(*dw), GFP_KERNEL);
0089     if (!dw)
0090         return -ENOMEM;
0091
0092     dw[0].id = snd_soc_dapm_hp;
0093     dw[0].reg = SND_SOC_NOPM;
0094     dw[0].name = devm_kasprintf(dev, GFP_KERNEL, "ssp%dpb", ssp_port);
0095     if (!dw[0].name)
0096         return -ENOMEM;
0097
0098     dw[1].id = snd_soc_dapm_mic;
0099     dw[1].reg = SND_SOC_NOPM;
0100     dw[1].name = devm_kasprintf(dev, GFP_KERNEL, "ssp%dcp", ssp_port);
0101     if (!dw[1].name)
0102         return -ENOMEM;
0103
0104     *widgets = dw;
0105     *num_widgets = num_dw;
0106
0107     return 0;
0108 }
0109
0110 static int avs_i2s_test_probe(struct platform_device *pdev)
0111 {
0112     struct snd_soc_dapm_widget *widgets;
0113     struct snd_soc_dapm_route *routes;
0114     struct snd_soc_dai_link *dai_link;
0115     struct snd_soc_acpi_mach *mach;
0116     struct snd_soc_card *card;
0117     struct device *dev = &pdev->dev;
0118     const char *pname;
0119     int num_routes, num_widgets;
0120     int ssp_port, ret;
0121
0122     mach = dev_get_platdata(dev);
0123     pname = mach->mach_params.platform;
0124     ssp_port = __ffs(mach->mach_params.i2s_link_mask);
0125
0126     card = devm_kzalloc(dev, sizeof(*card), GFP_KERNEL);
0127     if (!card)
0128         return -ENOMEM;
0129
0130     card->name = devm_kasprintf(dev, GFP_KERNEL, "ssp%d-loopback", ssp_port);
0131     if (!card->name)
0132         return -ENOMEM;
0133
0134     ret = avs_create_dai_link(dev, pname, ssp_port, &dai_link);
0135     if (ret) {
0136         dev_err(dev, "Failed to create dai link: %d\n", ret);
0137         return ret;
0138     }
0139
0140     ret = avs_create_dapm_routes(dev, ssp_port, &routes, &num_routes);
0141     if (ret) {
0142         dev_err(dev, "Failed to create dapm routes: %d\n", ret);
0143         return ret;
0144     }
0145
0146     ret = avs_create_dapm_widgets(dev, ssp_port, &widgets, &num_widgets);
0147     if (ret) {
0148         dev_err(dev, "Failed to create dapm widgets: %d\n", ret);
0149         return ret;
0150     }
0151
0152     card->dev = dev;
0153     card->owner = THIS_MODULE;
0154     card->dai_link = dai_link;
0155     card->num_links = 1;
0156     card->dapm_routes = routes;
0157     card->num_dapm_routes = num_routes;
0158     card->dapm_widgets = widgets;
0159     card->num_dapm_widgets = num_widgets;
0160     card->fully_routed = true;
0161
0162     ret = snd_soc_fixup_dai_links_platform_name(card, pname);
0163     if (ret)
0164         return ret;
0165
0166     return devm_snd_soc_register_card(dev, card);
0167 }
0168
0169 static struct platform_driver avs_i2s_test_driver = {
0170     .probe = avs_i2s_test_probe,
0171     .driver = {
0172         .name = "avs_i2s_test",
0173         .pm = &snd_soc_pm_ops,
0174     },
0175 };
0176
0177 module_platform_driver(avs_i2s_test_driver);
0178
0179 MODULE_LICENSE("GPL");
0180 MODULE_ALIAS("platform:avs_i2s_test");