1 // SPDX-License-Identifier: GPL-2.0-only 2 // 3 // Copyright(c) 2021-2022 Intel Corporation 4 // 5 // Authors: Cezary Rojewski <cezary.rojewski@intel.com> 6 // Amadeusz Slawinski <amadeuszx.slawinski@linux.intel.com> 7 // 8 9 #include <linux/module.h> 10 #include <sound/pcm.h> 11 #include <sound/pcm_params.h> 12 #include <sound/soc.h> 13 #include <sound/soc-acpi.h> 14 #include <sound/soc-dapm.h> 15 #include "../utils.h" 16 17 static int avs_create_dai_link(struct device *dev, const char *platform_name, int ssp_port, 18 int tdm_slot, struct snd_soc_dai_link **dai_link) 19 { 20 struct snd_soc_dai_link_component *platform; 21 struct snd_soc_dai_link *dl; 22 23 dl = devm_kzalloc(dev, sizeof(*dl), GFP_KERNEL); 24 platform = devm_kzalloc(dev, sizeof(*platform), GFP_KERNEL); 25 if (!dl || !platform) 26 return -ENOMEM; 27 28 platform->name = platform_name; 29 30 dl->name = devm_kasprintf(dev, GFP_KERNEL, 31 AVS_STRING_FMT("SSP", "-Codec", ssp_port, tdm_slot)); 32 dl->cpus = devm_kzalloc(dev, sizeof(*dl->cpus), GFP_KERNEL); 33 if (!dl->name || !dl->cpus) 34 return -ENOMEM; 35 36 dl->cpus->dai_name = devm_kasprintf(dev, GFP_KERNEL, 37 AVS_STRING_FMT("SSP", " Pin", ssp_port, tdm_slot)); 38 dl->codecs = &snd_soc_dummy_dlc; 39 if (!dl->cpus->dai_name || !dl->codecs->name || !dl->codecs->dai_name) 40 return -ENOMEM; 41 42 dl->num_cpus = 1; 43 dl->num_codecs = 1; 44 dl->platforms = platform; 45 dl->num_platforms = 1; 46 dl->id = 0; 47 dl->nonatomic = 1; 48 dl->no_pcm = 1; 49 50 *dai_link = dl; 51 52 return 0; 53 } 54 55 static int avs_i2s_test_probe(struct platform_device *pdev) 56 { 57 struct snd_soc_dai_link *dai_link; 58 struct snd_soc_acpi_mach *mach; 59 struct avs_mach_pdata *pdata; 60 struct snd_soc_card *card; 61 struct device *dev = &pdev->dev; 62 const char *pname; 63 int ssp_port, tdm_slot, ret; 64 65 mach = dev_get_platdata(dev); 66 pname = mach->mach_params.platform; 67 pdata = mach->pdata; 68 69 if (!avs_mach_singular_ssp(mach)) { 70 dev_err(dev, "Invalid SSP configuration\n"); 71 return -EINVAL; 72 } 73 ssp_port = avs_mach_ssp_port(mach); 74 75 if (!avs_mach_singular_tdm(mach, ssp_port)) { 76 dev_err(dev, "Invalid TDM configuration\n"); 77 return -EINVAL; 78 } 79 tdm_slot = avs_mach_ssp_tdm(mach, ssp_port); 80 81 card = devm_kzalloc(dev, sizeof(*card), GFP_KERNEL); 82 if (!card) 83 return -ENOMEM; 84 85 if (pdata->obsolete_card_names) { 86 card->name = devm_kasprintf(dev, GFP_KERNEL, 87 AVS_STRING_FMT("ssp", "-loopback", ssp_port, tdm_slot)); 88 } else { 89 card->driver_name = "avs_i2s_test"; 90 card->long_name = card->name = devm_kasprintf(dev, GFP_KERNEL, 91 AVS_STRING_FMT("AVS I2S TEST-", "", 92 ssp_port, tdm_slot)); 93 } 94 if (!card->name) 95 return -ENOMEM; 96 97 ret = avs_create_dai_link(dev, pname, ssp_port, tdm_slot, &dai_link); 98 if (ret) { 99 dev_err(dev, "Failed to create dai link: %d\n", ret); 100 return ret; 101 } 102 103 card->dev = dev; 104 card->owner = THIS_MODULE; 105 card->dai_link = dai_link; 106 card->num_links = 1; 107 card->fully_routed = true; 108 109 ret = snd_soc_fixup_dai_links_platform_name(card, pname); 110 if (ret) 111 return ret; 112 113 return devm_snd_soc_register_deferrable_card(dev, card); 114 } 115 116 static const struct platform_device_id avs_i2s_test_driver_ids[] = { 117 { 118 .name = "avs_i2s_test", 119 }, 120 {}, 121 }; 122 MODULE_DEVICE_TABLE(platform, avs_i2s_test_driver_ids); 123 124 static struct platform_driver avs_i2s_test_driver = { 125 .probe = avs_i2s_test_probe, 126 .driver = { 127 .name = "avs_i2s_test", 128 .pm = &snd_soc_pm_ops, 129 }, 130 .id_table = avs_i2s_test_driver_ids, 131 }; 132 133 module_platform_driver(avs_i2s_test_driver); 134 135 MODULE_DESCRIPTION("Intel i2s test machine driver"); 136 MODULE_LICENSE("GPL"); 137