216 lines · c
1// SPDX-License-Identifier: GPL-2.0-only2//3// Copyright(c) 2022 Intel Corporation4//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 21static 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 32static const struct snd_kcontrol_new card_controls[] = {33 SOC_DAPM_PIN_SWITCH("Left Spk"),34 SOC_DAPM_PIN_SWITCH("Right Spk"),35};36 37static 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 42static 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 47static int48avs_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(fmt);63 snd_mask_set_format(fmt, SNDRV_PCM_FORMAT_S16_LE);64 return 0;65}66 67static 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(codec_dai, 0x30, 3, 8, 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(codec_dai, 0xC0, 3, 8, 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 94static const struct snd_soc_ops avs_max98373_ops = {95 .hw_params = avs_max98373_hw_params,96};97 98static int avs_create_dai_link(struct device *dev, const char *platform_name, int ssp_port,99 int tdm_slot, 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, sizeof(*dl), GFP_KERNEL);105 platform = devm_kzalloc(dev, sizeof(*platform), GFP_KERNEL);106 if (!dl || !platform)107 return -ENOMEM;108 109 platform->name = platform_name;110 111 dl->name = devm_kasprintf(dev, GFP_KERNEL,112 AVS_STRING_FMT("SSP", "-Codec", ssp_port, tdm_slot));113 dl->cpus = devm_kzalloc(dev, sizeof(*dl->cpus), GFP_KERNEL);114 dl->codecs = devm_kzalloc(dev, sizeof(*dl->codecs) * 2, GFP_KERNEL);115 if (!dl->name || !dl->cpus || !dl->codecs)116 return -ENOMEM;117 118 dl->cpus->dai_name = devm_kasprintf(dev, GFP_KERNEL,119 AVS_STRING_FMT("SSP", " Pin", ssp_port, tdm_slot));120 dl->codecs[0].name = devm_kasprintf(dev, GFP_KERNEL, MAX98373_DEV0_NAME);121 dl->codecs[0].dai_name = devm_kasprintf(dev, GFP_KERNEL, MAX98373_CODEC_NAME);122 dl->codecs[1].name = devm_kasprintf(dev, GFP_KERNEL, MAX98373_DEV1_NAME);123 dl->codecs[1].dai_name = devm_kasprintf(dev, GFP_KERNEL, MAX98373_CODEC_NAME);124 if (!dl->cpus->dai_name || !dl->codecs[0].name || !dl->codecs[0].dai_name ||125 !dl->codecs[1].name || !dl->codecs[1].dai_name)126 return -ENOMEM;127 128 dl->num_cpus = 1;129 dl->num_codecs = 2;130 dl->platforms = platform;131 dl->num_platforms = 1;132 dl->id = 0;133 dl->dai_fmt = SND_SOC_DAIFMT_DSP_B | SND_SOC_DAIFMT_NB_NF | SND_SOC_DAIFMT_CBC_CFC;134 dl->be_hw_params_fixup = avs_max98373_be_fixup;135 dl->nonatomic = 1;136 dl->no_pcm = 1;137 dl->dpcm_capture = 1;138 dl->dpcm_playback = 1;139 dl->ignore_pmdown_time = 1;140 dl->ops = &avs_max98373_ops;141 142 *dai_link = dl;143 144 return 0;145}146 147static int avs_max98373_probe(struct platform_device *pdev)148{149 struct snd_soc_dai_link *dai_link;150 struct snd_soc_acpi_mach *mach;151 struct snd_soc_card *card;152 struct device *dev = &pdev->dev;153 const char *pname;154 int ssp_port, tdm_slot, ret;155 156 mach = dev_get_platdata(dev);157 pname = mach->mach_params.platform;158 159 ret = avs_mach_get_ssp_tdm(dev, mach, &ssp_port, &tdm_slot);160 if (ret)161 return ret;162 163 ret = avs_create_dai_link(dev, pname, ssp_port, tdm_slot, &dai_link);164 if (ret) {165 dev_err(dev, "Failed to create dai link: %d", ret);166 return ret;167 }168 169 card = devm_kzalloc(dev, sizeof(*card), GFP_KERNEL);170 if (!card)171 return -ENOMEM;172 173 card->name = "avs_max98373";174 card->dev = dev;175 card->owner = THIS_MODULE;176 card->dai_link = dai_link;177 card->num_links = 1;178 card->codec_conf = card_codec_conf;179 card->num_configs = ARRAY_SIZE(card_codec_conf);180 card->controls = card_controls;181 card->num_controls = ARRAY_SIZE(card_controls);182 card->dapm_widgets = card_widgets;183 card->num_dapm_widgets = ARRAY_SIZE(card_widgets);184 card->dapm_routes = card_base_routes;185 card->num_dapm_routes = ARRAY_SIZE(card_base_routes);186 card->fully_routed = true;187 188 ret = snd_soc_fixup_dai_links_platform_name(card, pname);189 if (ret)190 return ret;191 192 return devm_snd_soc_register_card(dev, card);193}194 195static const struct platform_device_id avs_max98373_driver_ids[] = {196 {197 .name = "avs_max98373",198 },199 {},200};201MODULE_DEVICE_TABLE(platform, avs_max98373_driver_ids);202 203static struct platform_driver avs_max98373_driver = {204 .probe = avs_max98373_probe,205 .driver = {206 .name = "avs_max98373",207 .pm = &snd_soc_pm_ops,208 },209 .id_table = avs_max98373_driver_ids,210};211 212module_platform_driver(avs_max98373_driver)213 214MODULE_DESCRIPTION("Intel max98373 machine driver");215MODULE_LICENSE("GPL");216