| 1 | // SPDX-License-Identifier: GPL-2.0-only |
| 2 | // |
| 3 | // Copyright(c) 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 <linux/platform_device.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 | #define MAX98373_DEV0_NAME "i2c-MX98373:00" |
| 18 | #define MAX98373_DEV1_NAME "i2c-MX98373:01" |
| 19 | #define MAX98373_CODEC_NAME "max98373-aif1" |
| 20 | |
| 21 | static struct snd_soc_codec_conf card_codec_conf[] = { |
| 22 | { |
| 23 | .dlc = COMP_CODEC_CONF(MAX98373_DEV0_NAME), |
| 24 | .name_prefix = "Right" , |
| 25 | }, |
| 26 | { |
| 27 | .dlc = COMP_CODEC_CONF(MAX98373_DEV1_NAME), |
| 28 | .name_prefix = "Left" , |
| 29 | }, |
| 30 | }; |
| 31 | |
| 32 | static const struct snd_kcontrol_new card_controls[] = { |
| 33 | SOC_DAPM_PIN_SWITCH("Left Spk" ), |
| 34 | SOC_DAPM_PIN_SWITCH("Right Spk" ), |
| 35 | }; |
| 36 | |
| 37 | static const struct snd_soc_dapm_widget card_widgets[] = { |
| 38 | SND_SOC_DAPM_SPK("Left Spk" , NULL), |
| 39 | SND_SOC_DAPM_SPK("Right Spk" , NULL), |
| 40 | }; |
| 41 | |
| 42 | static const struct snd_soc_dapm_route card_base_routes[] = { |
| 43 | { "Left Spk" , NULL, "Left BE_OUT" }, |
| 44 | { "Right Spk" , NULL, "Right BE_OUT" }, |
| 45 | }; |
| 46 | |
| 47 | static int |
| 48 | avs_max98373_be_fixup(struct snd_soc_pcm_runtime *runrime, struct snd_pcm_hw_params *params) |
| 49 | { |
| 50 | struct snd_interval *rate, *channels; |
| 51 | struct snd_mask *fmt; |
| 52 | |
| 53 | rate = hw_param_interval(params, SNDRV_PCM_HW_PARAM_RATE); |
| 54 | channels = hw_param_interval(params, SNDRV_PCM_HW_PARAM_CHANNELS); |
| 55 | fmt = hw_param_mask(params, SNDRV_PCM_HW_PARAM_FORMAT); |
| 56 | |
| 57 | /* The ADSP will convert the FE rate to 48k, stereo */ |
| 58 | rate->min = rate->max = 48000; |
| 59 | channels->min = channels->max = 2; |
| 60 | |
| 61 | /* set SSP0 to 16 bit */ |
| 62 | snd_mask_none(mask: fmt); |
| 63 | snd_mask_set_format(mask: fmt, SNDRV_PCM_FORMAT_S16_LE); |
| 64 | return 0; |
| 65 | } |
| 66 | |
| 67 | static int avs_max98373_hw_params(struct snd_pcm_substream *substream, |
| 68 | struct snd_pcm_hw_params *params) |
| 69 | { |
| 70 | struct snd_soc_pcm_runtime *runtime = snd_soc_substream_to_rtd(substream); |
| 71 | struct snd_soc_dai *codec_dai; |
| 72 | int ret, i; |
| 73 | |
| 74 | for_each_rtd_codec_dais(runtime, i, codec_dai) { |
| 75 | if (!strcmp(codec_dai->component->name, MAX98373_DEV0_NAME)) { |
| 76 | ret = snd_soc_dai_set_tdm_slot(dai: codec_dai, tx_mask: 0x30, rx_mask: 3, slots: 8, slot_width: 16); |
| 77 | if (ret < 0) { |
| 78 | dev_err(runtime->dev, "DEV0 TDM slot err:%d\n" , ret); |
| 79 | return ret; |
| 80 | } |
| 81 | } |
| 82 | if (!strcmp(codec_dai->component->name, MAX98373_DEV1_NAME)) { |
| 83 | ret = snd_soc_dai_set_tdm_slot(dai: codec_dai, tx_mask: 0xC0, rx_mask: 3, slots: 8, slot_width: 16); |
| 84 | if (ret < 0) { |
| 85 | dev_err(runtime->dev, "DEV1 TDM slot err:%d\n" , ret); |
| 86 | return ret; |
| 87 | } |
| 88 | } |
| 89 | } |
| 90 | |
| 91 | return 0; |
| 92 | } |
| 93 | |
| 94 | static const struct snd_soc_ops avs_max98373_ops = { |
| 95 | .hw_params = avs_max98373_hw_params, |
| 96 | }; |
| 97 | |
| 98 | static int avs_create_dai_link(struct device *dev, int ssp_port, int tdm_slot, |
| 99 | struct snd_soc_dai_link **dai_link) |
| 100 | { |
| 101 | struct snd_soc_dai_link_component *platform; |
| 102 | struct snd_soc_dai_link *dl; |
| 103 | |
| 104 | dl = devm_kzalloc(dev, size: sizeof(*dl), GFP_KERNEL); |
| 105 | platform = devm_kzalloc(dev, size: sizeof(*platform), GFP_KERNEL); |
| 106 | if (!dl || !platform) |
| 107 | return -ENOMEM; |
| 108 | |
| 109 | dl->name = devm_kasprintf(dev, GFP_KERNEL, |
| 110 | AVS_STRING_FMT("SSP" , "-Codec" , ssp_port, tdm_slot)); |
| 111 | dl->cpus = devm_kzalloc(dev, size: sizeof(*dl->cpus), GFP_KERNEL); |
| 112 | dl->codecs = devm_kcalloc(dev, n: 2, size: sizeof(*dl->codecs), GFP_KERNEL); |
| 113 | if (!dl->name || !dl->cpus || !dl->codecs) |
| 114 | return -ENOMEM; |
| 115 | |
| 116 | dl->cpus->dai_name = devm_kasprintf(dev, GFP_KERNEL, |
| 117 | AVS_STRING_FMT("SSP" , " Pin" , ssp_port, tdm_slot)); |
| 118 | dl->codecs[0].name = devm_kasprintf(dev, GFP_KERNEL, MAX98373_DEV0_NAME); |
| 119 | dl->codecs[0].dai_name = devm_kasprintf(dev, GFP_KERNEL, MAX98373_CODEC_NAME); |
| 120 | dl->codecs[1].name = devm_kasprintf(dev, GFP_KERNEL, MAX98373_DEV1_NAME); |
| 121 | dl->codecs[1].dai_name = devm_kasprintf(dev, GFP_KERNEL, MAX98373_CODEC_NAME); |
| 122 | if (!dl->cpus->dai_name || !dl->codecs[0].name || !dl->codecs[0].dai_name || |
| 123 | !dl->codecs[1].name || !dl->codecs[1].dai_name) |
| 124 | return -ENOMEM; |
| 125 | |
| 126 | platform->name = dev_name(dev); |
| 127 | dl->num_cpus = 1; |
| 128 | dl->num_codecs = 2; |
| 129 | dl->platforms = platform; |
| 130 | dl->num_platforms = 1; |
| 131 | dl->id = 0; |
| 132 | dl->dai_fmt = SND_SOC_DAIFMT_DSP_B | SND_SOC_DAIFMT_NB_NF | SND_SOC_DAIFMT_CBC_CFC; |
| 133 | dl->be_hw_params_fixup = avs_max98373_be_fixup; |
| 134 | dl->nonatomic = 1; |
| 135 | dl->no_pcm = 1; |
| 136 | dl->ignore_pmdown_time = 1; |
| 137 | dl->ops = &avs_max98373_ops; |
| 138 | |
| 139 | *dai_link = dl; |
| 140 | |
| 141 | return 0; |
| 142 | } |
| 143 | |
| 144 | static int avs_max98373_probe(struct platform_device *pdev) |
| 145 | { |
| 146 | struct snd_soc_dai_link *dai_link; |
| 147 | struct snd_soc_acpi_mach *mach; |
| 148 | struct avs_mach_pdata *pdata; |
| 149 | struct snd_soc_card *card; |
| 150 | struct device *dev = &pdev->dev; |
| 151 | int ssp_port, tdm_slot, ret; |
| 152 | |
| 153 | mach = dev_get_platdata(dev); |
| 154 | pdata = mach->pdata; |
| 155 | |
| 156 | ret = avs_mach_get_ssp_tdm(dev, mach, ssp_port: &ssp_port, tdm_slot: &tdm_slot); |
| 157 | if (ret) |
| 158 | return ret; |
| 159 | |
| 160 | ret = avs_create_dai_link(dev, ssp_port, tdm_slot, dai_link: &dai_link); |
| 161 | if (ret) { |
| 162 | dev_err(dev, "Failed to create dai link: %d" , ret); |
| 163 | return ret; |
| 164 | } |
| 165 | |
| 166 | card = devm_kzalloc(dev, size: sizeof(*card), GFP_KERNEL); |
| 167 | if (!card) |
| 168 | return -ENOMEM; |
| 169 | |
| 170 | if (pdata->obsolete_card_names) { |
| 171 | card->name = "avs_max98373" ; |
| 172 | } else { |
| 173 | card->driver_name = "avs_max98373" ; |
| 174 | card->long_name = card->name = "AVS I2S MAX98373" ; |
| 175 | } |
| 176 | card->dev = dev; |
| 177 | card->owner = THIS_MODULE; |
| 178 | card->dai_link = dai_link; |
| 179 | card->num_links = 1; |
| 180 | card->codec_conf = card_codec_conf; |
| 181 | card->num_configs = ARRAY_SIZE(card_codec_conf); |
| 182 | card->controls = card_controls; |
| 183 | card->num_controls = ARRAY_SIZE(card_controls); |
| 184 | card->dapm_widgets = card_widgets; |
| 185 | card->num_dapm_widgets = ARRAY_SIZE(card_widgets); |
| 186 | card->dapm_routes = card_base_routes; |
| 187 | card->num_dapm_routes = ARRAY_SIZE(card_base_routes); |
| 188 | card->fully_routed = true; |
| 189 | |
| 190 | return devm_snd_soc_register_deferrable_card(dev, card); |
| 191 | } |
| 192 | |
| 193 | static const struct platform_device_id avs_max98373_driver_ids[] = { |
| 194 | { |
| 195 | .name = "avs_max98373" , |
| 196 | }, |
| 197 | {}, |
| 198 | }; |
| 199 | MODULE_DEVICE_TABLE(platform, avs_max98373_driver_ids); |
| 200 | |
| 201 | static struct platform_driver avs_max98373_driver = { |
| 202 | .probe = avs_max98373_probe, |
| 203 | .driver = { |
| 204 | .name = "avs_max98373" , |
| 205 | .pm = &snd_soc_pm_ops, |
| 206 | }, |
| 207 | .id_table = avs_max98373_driver_ids, |
| 208 | }; |
| 209 | |
| 210 | module_platform_driver(avs_max98373_driver) |
| 211 | |
| 212 | MODULE_DESCRIPTION("Intel max98373 machine driver" ); |
| 213 | MODULE_LICENSE("GPL" ); |
| 214 | |