| Message ID | 1631124057-17155-3-git-send-email-srivasam@codeaurora.org (mailing list archive) |
|---|---|
| State | Superseded |
| Headers | show |
| Series | Machine driver to support LPASS SC7280 sound card registration | expand |
Quoting Srinivasa Rao Mandadapu (2021-09-08 11:00:57) > diff --git a/sound/soc/qcom/sc7280.c b/sound/soc/qcom/sc7280.c > new file mode 100644 > index 0000000..1ab29f6 > --- /dev/null > +++ b/sound/soc/qcom/sc7280.c > @@ -0,0 +1,347 @@ > +// SPDX-License-Identifier: GPL-2.0-only > +// > +// Copyright (c) 2020-2021, The Linux Foundation. All rights reserved. > +// > +// sc7280.c -- ALSA SoC Machine driver for sc7280 > + > +#include <dt-bindings/sound/sc7180-lpass.h> > +#include <dt-bindings/sound/qcom,q6afe.h> Can these come after the linux/sound includes? > +#include <linux/gpio.h> > +#include <linux/gpio/consumer.h> > +#include <linux/module.h> > +#include <linux/of_device.h> > +#include <linux/platform_device.h> > +#include <sound/core.h> > +#include <sound/jack.h> > +#include <sound/pcm.h> > +#include <sound/soc.h> > +#include <uapi/linux/input-event-codes.h> Is this include used? > + > +#include "../codecs/wcd938x.h" > +#include "common.h" > +#include "lpass.h" > + > +#define DRIVER_NAME "SC7280" Is this useful? Why not just inline it in the one place it is used so we don't have to jump to the define to figure out what it is? > +#define LPASS_MAX_PORTS (LPASS_CDC_DMA_VA_TX8 + 1) > + > + > +struct sc7280_snd_data { > + bool stream_prepared[LPASS_MAX_PORTS]; > + struct snd_soc_card card; > + struct sdw_stream_runtime *sruntime[LPASS_MAX_PORTS]; > + struct snd_soc_jack hs_jack; > + struct snd_soc_jack hdmi_jack; > + bool jack_setup; > +}; > + > +static void sc7280_jack_free(struct snd_jack *jack) > +{ > + struct snd_soc_component *component = jack->private_data; > + > + snd_soc_component_set_jack(component, NULL, NULL); > +} > + > +static int sc7280_headset_init(struct snd_soc_pcm_runtime *rtd) > +{ > + struct snd_soc_card *card = rtd->card; > + struct sc7280_snd_data *pdata = snd_soc_card_get_drvdata(card); > + struct snd_soc_dai *codec_dai = asoc_rtd_to_codec(rtd, 0); > + struct snd_soc_dai *cpu_dai = asoc_rtd_to_cpu(rtd, 0); > + struct snd_soc_component *component = codec_dai->component; > + struct snd_jack *jack; > + int rval, i; > + > + if (!pdata->jack_setup) { > + rval = snd_soc_card_jack_new(card, "Headset Jack", > + SND_JACK_HEADSET | SND_JACK_LINEOUT | > + SND_JACK_MECHANICAL | > + SND_JACK_BTN_0 | SND_JACK_BTN_1 | > + SND_JACK_BTN_2 | SND_JACK_BTN_3 | > + SND_JACK_BTN_4 | SND_JACK_BTN_5, > + &pdata->hs_jack, NULL, 0); > + > + if (rval < 0) { > + dev_err(card->dev, "Unable to add Headset Jack\n"); > + return rval; > + } > + > + jack = pdata->hs_jack.jack; > + > + snd_jack_set_key(jack, SND_JACK_BTN_0, KEY_MEDIA); > + snd_jack_set_key(jack, SND_JACK_BTN_1, KEY_VOICECOMMAND); > + snd_jack_set_key(jack, SND_JACK_BTN_2, KEY_VOLUMEUP); > + snd_jack_set_key(jack, SND_JACK_BTN_3, KEY_VOLUMEDOWN); > + > + jack->private_data = component; > + jack->private_free = sc7280_jack_free; > + pdata->jack_setup = true; > + } > + switch (cpu_dai->id) { > + case LPASS_CDC_DMA_RX0: > + case LPASS_CDC_DMA_TX3: > + for_each_rtd_codec_dais(rtd, i, codec_dai) { > + rval = snd_soc_component_set_jack(component, &pdata->hs_jack, NULL); > + if (rval != 0 && rval != -EOPNOTSUPP) { > + dev_warn(card->dev, "Failed to set jack: %d\n", rval); Why not dev_err? > + return rval; > + } > + } > + > + break; > + default: > + break; > + } > + > + return 0; > +} > + > +static int sc7280_hdmi_init(struct snd_soc_pcm_runtime *rtd) > +{ > + struct snd_soc_card *card = rtd->card; > + struct sc7280_snd_data *pdata = snd_soc_card_get_drvdata(card); > + struct snd_soc_dai *codec_dai = asoc_rtd_to_codec(rtd, 0); > + struct snd_soc_component *component = codec_dai->component; > + struct snd_jack *jack; > + int rval; > + > + rval = snd_soc_card_jack_new( > + card, "HDMI Jack", > + SND_JACK_LINEOUT, > + &pdata->hdmi_jack, NULL, 0); > + > + if (rval < 0) { > + dev_err(card->dev, "Unable to add HDMI Jack\n"); > + return rval; > + } > + > + jack = pdata->hdmi_jack.jack; > + jack->private_data = component; > + jack->private_free = sc7280_jack_free; > + > + return snd_soc_component_set_jack(component, &pdata->hdmi_jack, NULL); > +} > + > +static int sc7280_init(struct snd_soc_pcm_runtime *rtd) > +{ > + struct snd_soc_dai *cpu_dai = asoc_rtd_to_cpu(rtd, 0); > + > + switch (cpu_dai->id) { > + case LPASS_CDC_DMA_TX3: > + return sc7280_headset_init(rtd); > + case LPASS_CDC_DMA_RX0: > + case LPASS_CDC_DMA_VA_TX0: > + case MI2S_SECONDARY: > + return 0; > + case LPASS_DP_RX: > + return sc7280_hdmi_init(rtd); > + default: > + dev_err(rtd->dev, "%s: invalid dai id 0x%x\n", __func__, cpu_dai->id); > + return -EINVAL; > + } Nitpick: Add newline. > + return 0; Can we even get here? Maybe remove return from default above and make this a return -EINVAL. > +} > + > +static int sc7280_snd_startup(struct snd_pcm_substream *substream) > +{ > + struct snd_soc_pcm_runtime *rtd = substream->private_data; > + struct snd_soc_dai *cpu_dai = asoc_rtd_to_cpu(rtd, 0); > + > + switch (cpu_dai->id) { > + case LPASS_CDC_DMA_RX0: > + case LPASS_CDC_DMA_TX3: > + case LPASS_CDC_DMA_VA_TX0: > + break; > + case MI2S_SECONDARY: > + break; > + case LPASS_DP_RX: > + break; > + default: > + dev_err(rtd->dev, "%s: invalid dai id 0x%x\n", __func__, cpu_dai->id); > + return -EINVAL; > + } Nitpick: Add newline. > + return 0; > +} > + > +static int sc7280_snd_hw_params(struct snd_pcm_substream *substream, > + struct snd_pcm_hw_params *params) > +{ > + struct snd_pcm_runtime *runtime = substream->runtime; > + struct snd_soc_pcm_runtime *rtd = substream->private_data; > + struct snd_soc_dai *codec_dai; > + struct snd_soc_dai *cpu_dai = asoc_rtd_to_cpu(rtd, 0); const? > + struct sc7280_snd_data *pdata = snd_soc_card_get_drvdata(rtd->card); > + struct sdw_stream_runtime *sruntime; > + int i; > + > + snd_pcm_hw_constraint_minmax(runtime, SNDRV_PCM_HW_PARAM_CHANNELS, 2, 2); > + snd_pcm_hw_constraint_minmax(runtime, SNDRV_PCM_HW_PARAM_RATE, 48000, 48000); > + > + switch (cpu_dai->id) { > + case LPASS_CDC_DMA_TX3: > + case LPASS_CDC_DMA_RX0: > + for_each_rtd_codec_dais(rtd, i, codec_dai) { > + sruntime = snd_soc_dai_get_sdw_stream(codec_dai, substream->stream); > + if (sruntime != ERR_PTR(-EOPNOTSUPP)) > + pdata->sruntime[cpu_dai->id] = sruntime; > + } > + break; > + } > + > + return 0; > + Nitpick: Drop newline. > +} > + > +static int sc7280_snd_swr_prepare(struct snd_pcm_substream *substream) > +{ > + struct snd_soc_pcm_runtime *rtd = substream->private_data; > + struct snd_soc_dai *cpu_dai = asoc_rtd_to_cpu(rtd, 0); const? > + struct sc7280_snd_data *data = snd_soc_card_get_drvdata(rtd->card); > + struct sdw_stream_runtime *sruntime = data->sruntime[cpu_dai->id]; > + int ret; > + > + if (!sruntime) > + return 0; > + > + if (data->stream_prepared[cpu_dai->id]) { > + sdw_disable_stream(sruntime); > + sdw_deprepare_stream(sruntime); > + data->stream_prepared[cpu_dai->id] = false; > + } > + > + ret = sdw_prepare_stream(sruntime); > + if (ret) > + return ret; > + > + ret = sdw_enable_stream(sruntime); > + if (ret) { > + sdw_deprepare_stream(sruntime); > + return ret; > + } > + data->stream_prepared[cpu_dai->id] = true; Why two spaces after ]? > + > + return ret; > +} > + > + > +static int sc7280_snd_prepare(struct snd_pcm_substream *substream) > +{ > + struct snd_soc_pcm_runtime *rtd = substream->private_data; > + struct snd_soc_dai *cpu_dai = asoc_rtd_to_cpu(rtd, 0); const? > + > + switch (cpu_dai->id) { > + case LPASS_CDC_DMA_RX0: > + case LPASS_CDC_DMA_TX3: > + return sc7280_snd_swr_prepare(substream); > + default: > + break; > + } > + > + return 0; > +} > + > +static int sc7280_snd_hw_free(struct snd_pcm_substream *substream) > +{ > + struct snd_soc_pcm_runtime *rtd = substream->private_data; > + struct sc7280_snd_data *data = snd_soc_card_get_drvdata(rtd->card); > + struct snd_soc_dai *cpu_dai = asoc_rtd_to_cpu(rtd, 0); const? > + struct sdw_stream_runtime *sruntime = data->sruntime[cpu_dai->id]; > + > + switch (cpu_dai->id) { > + case LPASS_CDC_DMA_RX0: > + case LPASS_CDC_DMA_TX3: > + if (sruntime && data->stream_prepared[cpu_dai->id]) { > + sdw_disable_stream(sruntime); > + sdw_deprepare_stream(sruntime); > + data->stream_prepared[cpu_dai->id] = false; > + } > + break; > + default: > + break; > + } > + return 0; > +} > + > +static void sc7280_snd_shutdown(struct snd_pcm_substream *substream) > +{ > + struct snd_soc_pcm_runtime *rtd = substream->private_data; > + struct snd_soc_dai *cpu_dai = asoc_rtd_to_cpu(rtd, 0); > + > + switch (cpu_dai->id) { > + case LPASS_CDC_DMA_RX0: > + case LPASS_CDC_DMA_TX3: > + case LPASS_CDC_DMA_VA_TX0: > + break; > + case MI2S_SECONDARY: > + break; > + case LPASS_DP_RX: > + break; > + default: > + dev_err(rtd->dev, "%s: invalid dai id 0x%x\n", __func__, cpu_dai->id); Can use %#x to skip the 0x part. > + break; > + } > +} > + > +static const struct snd_soc_ops sc7280_ops = { > + .startup = sc7280_snd_startup, > + .shutdown = sc7280_snd_shutdown, > + .hw_params = sc7280_snd_hw_params, > + .hw_free = sc7280_snd_hw_free, > + .prepare = sc7280_snd_prepare, > +}; > + > +static const struct snd_soc_dapm_widget sc7280_snd_widgets[] = { > + SND_SOC_DAPM_HP("Headphone Jack", NULL), > + SND_SOC_DAPM_MIC("Headset Mic", NULL), > +}; > + > +static int sc7280_snd_platform_probe(struct platform_device *pdev) > +{ > + struct snd_soc_card *card; > + struct sc7280_snd_data *data; > + struct device *dev = &pdev->dev; > + struct snd_soc_dai_link *link; > + int ret, i; > + > + /* Allocate the private data */ > + data = devm_kzalloc(dev, sizeof(*data), GFP_KERNEL); > + if (!data) > + return -ENOMEM; > + > + card = &data->card; > + data->jack_setup = false; Isn't that implicit via kzalloc above? This can be dropped. > + snd_soc_card_set_drvdata(card, data); > + > + card->owner = THIS_MODULE; > + card->driver_name = DRIVER_NAME; > + card->dev = dev; > + > + ret = qcom_snd_parse_of(card); > + if (ret) > + return ret; > + > + for_each_card_prelinks(card, i, link) { > + link->init = sc7280_init; > + link->ops = &sc7280_ops; > + } > + ret = devm_snd_soc_register_card(dev, card); > + return ret; Nitpick: return devm_snd_soc_register_card(dev, card) > +} > + > +static const struct of_device_id sc7280_snd_device_id[] = { > + {.compatible = "google,sc7280-herobrine"}, > + {}, Nitpick: Drop comma here so nothing can come after without causing a compile error. > +}; > +MODULE_DEVICE_TABLE(of, sc7280_snd_device_id); > +
Thanks for Your Time Stephen!!! On 9/9/2021 4:12 AM, Stephen Boyd wrote: > Quoting Srinivasa Rao Mandadapu (2021-09-08 11:00:57) >> diff --git a/sound/soc/qcom/sc7280.c b/sound/soc/qcom/sc7280.c >> new file mode 100644 >> index 0000000..1ab29f6 >> --- /dev/null >> +++ b/sound/soc/qcom/sc7280.c >> @@ -0,0 +1,347 @@ >> +// SPDX-License-Identifier: GPL-2.0-only >> +// >> +// Copyright (c) 2020-2021, The Linux Foundation. All rights reserved. >> +// >> +// sc7280.c -- ALSA SoC Machine driver for sc7280 >> + >> +#include <dt-bindings/sound/sc7180-lpass.h> >> +#include <dt-bindings/sound/qcom,q6afe.h> > Can these come after the linux/sound includes? yes. it can be moved to below. > >> +#include <linux/gpio.h> >> +#include <linux/gpio/consumer.h> >> +#include <linux/module.h> >> +#include <linux/of_device.h> >> +#include <linux/platform_device.h> >> +#include <sound/core.h> >> +#include <sound/jack.h> >> +#include <sound/pcm.h> >> +#include <sound/soc.h> >> +#include <uapi/linux/input-event-codes.h> > Is this include used? This is is required for macros KEY_MEDIA' KEY_'VOICECOMMAND' 'KEY_VOLUMEUP'. > >> + >> +#include "../codecs/wcd938x.h" >> +#include "common.h" >> +#include "lpass.h" >> + >> +#define DRIVER_NAME "SC7280" > Is this useful? Why not just inline it in the one place it is used so we > don't have to jump to the define to figure out what it is? Yes. will make it inline. >> +#define LPASS_MAX_PORTS (LPASS_CDC_DMA_VA_TX8 + 1) >> + >> + >> +struct sc7280_snd_data { >> + bool stream_prepared[LPASS_MAX_PORTS]; >> + struct snd_soc_card card; >> + struct sdw_stream_runtime *sruntime[LPASS_MAX_PORTS]; >> + struct snd_soc_jack hs_jack; >> + struct snd_soc_jack hdmi_jack; >> + bool jack_setup; >> +}; >> + >> +static void sc7280_jack_free(struct snd_jack *jack) >> +{ >> + struct snd_soc_component *component = jack->private_data; >> + >> + snd_soc_component_set_jack(component, NULL, NULL); >> +} >> + >> +static int sc7280_headset_init(struct snd_soc_pcm_runtime *rtd) >> +{ >> + struct snd_soc_card *card = rtd->card; >> + struct sc7280_snd_data *pdata = snd_soc_card_get_drvdata(card); >> + struct snd_soc_dai *codec_dai = asoc_rtd_to_codec(rtd, 0); >> + struct snd_soc_dai *cpu_dai = asoc_rtd_to_cpu(rtd, 0); >> + struct snd_soc_component *component = codec_dai->component; >> + struct snd_jack *jack; >> + int rval, i; >> + >> + if (!pdata->jack_setup) { >> + rval = snd_soc_card_jack_new(card, "Headset Jack", >> + SND_JACK_HEADSET | SND_JACK_LINEOUT | >> + SND_JACK_MECHANICAL | >> + SND_JACK_BTN_0 | SND_JACK_BTN_1 | >> + SND_JACK_BTN_2 | SND_JACK_BTN_3 | >> + SND_JACK_BTN_4 | SND_JACK_BTN_5, >> + &pdata->hs_jack, NULL, 0); >> + >> + if (rval < 0) { >> + dev_err(card->dev, "Unable to add Headset Jack\n"); >> + return rval; >> + } >> + >> + jack = pdata->hs_jack.jack; >> + >> + snd_jack_set_key(jack, SND_JACK_BTN_0, KEY_MEDIA); >> + snd_jack_set_key(jack, SND_JACK_BTN_1, KEY_VOICECOMMAND); >> + snd_jack_set_key(jack, SND_JACK_BTN_2, KEY_VOLUMEUP); >> + snd_jack_set_key(jack, SND_JACK_BTN_3, KEY_VOLUMEDOWN); >> + >> + jack->private_data = component; >> + jack->private_free = sc7280_jack_free; >> + pdata->jack_setup = true; >> + } >> + switch (cpu_dai->id) { >> + case LPASS_CDC_DMA_RX0: >> + case LPASS_CDC_DMA_TX3: >> + for_each_rtd_codec_dais(rtd, i, codec_dai) { >> + rval = snd_soc_component_set_jack(component, &pdata->hs_jack, NULL); >> + if (rval != 0 && rval != -EOPNOTSUPP) { >> + dev_warn(card->dev, "Failed to set jack: %d\n", rval); > Why not dev_err? Okay. will change to dev_err(). > >> + return rval; >> + } >> + } >> + >> + break; >> + default: >> + break; >> + } >> + >> + return 0; >> +} >> + >> +static int sc7280_hdmi_init(struct snd_soc_pcm_runtime *rtd) >> +{ >> + struct snd_soc_card *card = rtd->card; >> + struct sc7280_snd_data *pdata = snd_soc_card_get_drvdata(card); >> + struct snd_soc_dai *codec_dai = asoc_rtd_to_codec(rtd, 0); >> + struct snd_soc_component *component = codec_dai->component; >> + struct snd_jack *jack; >> + int rval; >> + >> + rval = snd_soc_card_jack_new( >> + card, "HDMI Jack", >> + SND_JACK_LINEOUT, >> + &pdata->hdmi_jack, NULL, 0); >> + >> + if (rval < 0) { >> + dev_err(card->dev, "Unable to add HDMI Jack\n"); >> + return rval; >> + } >> + >> + jack = pdata->hdmi_jack.jack; >> + jack->private_data = component; >> + jack->private_free = sc7280_jack_free; >> + >> + return snd_soc_component_set_jack(component, &pdata->hdmi_jack, NULL); >> +} >> + >> +static int sc7280_init(struct snd_soc_pcm_runtime *rtd) >> +{ >> + struct snd_soc_dai *cpu_dai = asoc_rtd_to_cpu(rtd, 0); >> + >> + switch (cpu_dai->id) { >> + case LPASS_CDC_DMA_TX3: >> + return sc7280_headset_init(rtd); >> + case LPASS_CDC_DMA_RX0: >> + case LPASS_CDC_DMA_VA_TX0: >> + case MI2S_SECONDARY: >> + return 0; >> + case LPASS_DP_RX: >> + return sc7280_hdmi_init(rtd); >> + default: >> + dev_err(rtd->dev, "%s: invalid dai id 0x%x\n", __func__, cpu_dai->id); >> + return -EINVAL; >> + } > Nitpick: Add newline. Okay. > >> + return 0; > Can we even get here? Maybe remove return from default above and make > this a return -EINVAL. > >> +} >> + >> +static int sc7280_snd_startup(struct snd_pcm_substream *substream) >> +{ >> + struct snd_soc_pcm_runtime *rtd = substream->private_data; >> + struct snd_soc_dai *cpu_dai = asoc_rtd_to_cpu(rtd, 0); >> + >> + switch (cpu_dai->id) { >> + case LPASS_CDC_DMA_RX0: >> + case LPASS_CDC_DMA_TX3: >> + case LPASS_CDC_DMA_VA_TX0: >> + break; >> + case MI2S_SECONDARY: >> + break; >> + case LPASS_DP_RX: >> + break; >> + default: >> + dev_err(rtd->dev, "%s: invalid dai id 0x%x\n", __func__, cpu_dai->id); >> + return -EINVAL; >> + } > Nitpick: Add newline. Okay. > >> + return 0; >> +} >> + >> +static int sc7280_snd_hw_params(struct snd_pcm_substream *substream, >> + struct snd_pcm_hw_params *params) >> +{ >> + struct snd_pcm_runtime *runtime = substream->runtime; >> + struct snd_soc_pcm_runtime *rtd = substream->private_data; >> + struct snd_soc_dai *codec_dai; >> + struct snd_soc_dai *cpu_dai = asoc_rtd_to_cpu(rtd, 0); > const? Okay. > >> + struct sc7280_snd_data *pdata = snd_soc_card_get_drvdata(rtd->card); >> + struct sdw_stream_runtime *sruntime; >> + int i; >> + >> + snd_pcm_hw_constraint_minmax(runtime, SNDRV_PCM_HW_PARAM_CHANNELS, 2, 2); >> + snd_pcm_hw_constraint_minmax(runtime, SNDRV_PCM_HW_PARAM_RATE, 48000, 48000); >> + >> + switch (cpu_dai->id) { >> + case LPASS_CDC_DMA_TX3: >> + case LPASS_CDC_DMA_RX0: >> + for_each_rtd_codec_dais(rtd, i, codec_dai) { >> + sruntime = snd_soc_dai_get_sdw_stream(codec_dai, substream->stream); >> + if (sruntime != ERR_PTR(-EOPNOTSUPP)) >> + pdata->sruntime[cpu_dai->id] = sruntime; >> + } >> + break; >> + } >> + >> + return 0; >> + > Nitpick: Drop newline. Okay. > >> +} >> + >> +static int sc7280_snd_swr_prepare(struct snd_pcm_substream *substream) >> +{ >> + struct snd_soc_pcm_runtime *rtd = substream->private_data; >> + struct snd_soc_dai *cpu_dai = asoc_rtd_to_cpu(rtd, 0); > const? Okay. > >> + struct sc7280_snd_data *data = snd_soc_card_get_drvdata(rtd->card); >> + struct sdw_stream_runtime *sruntime = data->sruntime[cpu_dai->id]; >> + int ret; >> + >> + if (!sruntime) >> + return 0; >> + >> + if (data->stream_prepared[cpu_dai->id]) { >> + sdw_disable_stream(sruntime); >> + sdw_deprepare_stream(sruntime); >> + data->stream_prepared[cpu_dai->id] = false; >> + } >> + >> + ret = sdw_prepare_stream(sruntime); >> + if (ret) >> + return ret; >> + >> + ret = sdw_enable_stream(sruntime); >> + if (ret) { >> + sdw_deprepare_stream(sruntime); >> + return ret; >> + } >> + data->stream_prepared[cpu_dai->id] = true; > Why two spaces after ]? Okay. Will remove it. > >> + >> + return ret; >> +} >> + >> + >> +static int sc7280_snd_prepare(struct snd_pcm_substream *substream) >> +{ >> + struct snd_soc_pcm_runtime *rtd = substream->private_data; >> + struct snd_soc_dai *cpu_dai = asoc_rtd_to_cpu(rtd, 0); > const? Okay. > >> + >> + switch (cpu_dai->id) { >> + case LPASS_CDC_DMA_RX0: >> + case LPASS_CDC_DMA_TX3: >> + return sc7280_snd_swr_prepare(substream); >> + default: >> + break; >> + } >> + >> + return 0; >> +} >> + >> +static int sc7280_snd_hw_free(struct snd_pcm_substream *substream) >> +{ >> + struct snd_soc_pcm_runtime *rtd = substream->private_data; >> + struct sc7280_snd_data *data = snd_soc_card_get_drvdata(rtd->card); >> + struct snd_soc_dai *cpu_dai = asoc_rtd_to_cpu(rtd, 0); > const? Okay. > >> + struct sdw_stream_runtime *sruntime = data->sruntime[cpu_dai->id]; >> + >> + switch (cpu_dai->id) { >> + case LPASS_CDC_DMA_RX0: >> + case LPASS_CDC_DMA_TX3: >> + if (sruntime && data->stream_prepared[cpu_dai->id]) { >> + sdw_disable_stream(sruntime); >> + sdw_deprepare_stream(sruntime); >> + data->stream_prepared[cpu_dai->id] = false; >> + } >> + break; >> + default: >> + break; >> + } >> + return 0; >> +} >> + >> +static void sc7280_snd_shutdown(struct snd_pcm_substream *substream) >> +{ >> + struct snd_soc_pcm_runtime *rtd = substream->private_data; >> + struct snd_soc_dai *cpu_dai = asoc_rtd_to_cpu(rtd, 0); >> + >> + switch (cpu_dai->id) { >> + case LPASS_CDC_DMA_RX0: >> + case LPASS_CDC_DMA_TX3: >> + case LPASS_CDC_DMA_VA_TX0: >> + break; >> + case MI2S_SECONDARY: >> + break; >> + case LPASS_DP_RX: >> + break; >> + default: >> + dev_err(rtd->dev, "%s: invalid dai id 0x%x\n", __func__, cpu_dai->id); > Can use %#x to skip the 0x part. Okay. Will Change it to %d. > >> + break; >> + } >> +} >> + >> +static const struct snd_soc_ops sc7280_ops = { >> + .startup = sc7280_snd_startup, >> + .shutdown = sc7280_snd_shutdown, >> + .hw_params = sc7280_snd_hw_params, >> + .hw_free = sc7280_snd_hw_free, >> + .prepare = sc7280_snd_prepare, >> +}; >> + >> +static const struct snd_soc_dapm_widget sc7280_snd_widgets[] = { >> + SND_SOC_DAPM_HP("Headphone Jack", NULL), >> + SND_SOC_DAPM_MIC("Headset Mic", NULL), >> +}; >> + >> +static int sc7280_snd_platform_probe(struct platform_device *pdev) >> +{ >> + struct snd_soc_card *card; >> + struct sc7280_snd_data *data; >> + struct device *dev = &pdev->dev; >> + struct snd_soc_dai_link *link; >> + int ret, i; >> + >> + /* Allocate the private data */ >> + data = devm_kzalloc(dev, sizeof(*data), GFP_KERNEL); >> + if (!data) >> + return -ENOMEM; >> + >> + card = &data->card; >> + data->jack_setup = false; > Isn't that implicit via kzalloc above? This can be dropped. Yes. Will remove it. > >> + snd_soc_card_set_drvdata(card, data); >> + >> + card->owner = THIS_MODULE; >> + card->driver_name = DRIVER_NAME; >> + card->dev = dev; >> + >> + ret = qcom_snd_parse_of(card); >> + if (ret) >> + return ret; >> + >> + for_each_card_prelinks(card, i, link) { >> + link->init = sc7280_init; >> + link->ops = &sc7280_ops; >> + } >> + ret = devm_snd_soc_register_card(dev, card); >> + return ret; > Nitpick: > > return devm_snd_soc_register_card(dev, card) Okay. will change it. > >> +} >> + >> +static const struct of_device_id sc7280_snd_device_id[] = { >> + {.compatible = "google,sc7280-herobrine"}, >> + {}, > Nitpick: Drop comma here so nothing can come after without causing a > compile error. Okay. Will remove it. > >> +}; >> +MODULE_DEVICE_TABLE(of, sc7280_snd_device_id); >> +
diff --git a/sound/soc/qcom/Kconfig b/sound/soc/qcom/Kconfig index cc7c1de..d9ffcb7 100644 --- a/sound/soc/qcom/Kconfig +++ b/sound/soc/qcom/Kconfig @@ -152,4 +152,16 @@ config SND_SOC_SC7180 SC7180 SoC-based systems. Say Y if you want to use audio device on this SoCs. +config SND_SOC_SC7280 + tristate "SoC Machine driver for SC7280 boards" + depends on I2C && SOUNDWIRE + select SND_SOC_QCOM_COMMON + select SND_SOC_MAX98357A + select SND_SOC_LPASS_RX_MACRO + select SND_SOC_LPASS_TX_MACRO + help + To add support for audio on Qualcomm Technologies Inc. + SC7280 SoC-based systems. + Say Y if you want to use audio device on this SoCs. + endif #SND_SOC_QCOM diff --git a/sound/soc/qcom/Makefile b/sound/soc/qcom/Makefile index 1600ae5..625aec6 100644 --- a/sound/soc/qcom/Makefile +++ b/sound/soc/qcom/Makefile @@ -19,6 +19,7 @@ snd-soc-storm-objs := storm.o snd-soc-apq8016-sbc-objs := apq8016_sbc.o snd-soc-apq8096-objs := apq8096.o snd-soc-sc7180-objs := sc7180.o +snd-soc-sc7280-objs := sc7280.o snd-soc-sdm845-objs := sdm845.o snd-soc-sm8250-objs := sm8250.o snd-soc-qcom-common-objs := common.o @@ -27,6 +28,7 @@ obj-$(CONFIG_SND_SOC_STORM) += snd-soc-storm.o obj-$(CONFIG_SND_SOC_APQ8016_SBC) += snd-soc-apq8016-sbc.o obj-$(CONFIG_SND_SOC_MSM8996) += snd-soc-apq8096.o obj-$(CONFIG_SND_SOC_SC7180) += snd-soc-sc7180.o +obj-$(CONFIG_SND_SOC_SC7280) += snd-soc-sc7280.o obj-$(CONFIG_SND_SOC_SDM845) += snd-soc-sdm845.o obj-$(CONFIG_SND_SOC_SM8250) += snd-soc-sm8250.o obj-$(CONFIG_SND_SOC_QCOM_COMMON) += snd-soc-qcom-common.o diff --git a/sound/soc/qcom/sc7280.c b/sound/soc/qcom/sc7280.c new file mode 100644 index 0000000..1ab29f6 --- /dev/null +++ b/sound/soc/qcom/sc7280.c @@ -0,0 +1,347 @@ +// SPDX-License-Identifier: GPL-2.0-only +// +// Copyright (c) 2020-2021, The Linux Foundation. All rights reserved. +// +// sc7280.c -- ALSA SoC Machine driver for sc7280 + +#include <dt-bindings/sound/sc7180-lpass.h> +#include <dt-bindings/sound/qcom,q6afe.h> +#include <linux/gpio.h> +#include <linux/gpio/consumer.h> +#include <linux/module.h> +#include <linux/of_device.h> +#include <linux/platform_device.h> +#include <sound/core.h> +#include <sound/jack.h> +#include <sound/pcm.h> +#include <sound/soc.h> +#include <uapi/linux/input-event-codes.h> + +#include "../codecs/wcd938x.h" +#include "common.h" +#include "lpass.h" + +#define DRIVER_NAME "SC7280" +#define LPASS_MAX_PORTS (LPASS_CDC_DMA_VA_TX8 + 1) + + +struct sc7280_snd_data { + bool stream_prepared[LPASS_MAX_PORTS]; + struct snd_soc_card card; + struct sdw_stream_runtime *sruntime[LPASS_MAX_PORTS]; + struct snd_soc_jack hs_jack; + struct snd_soc_jack hdmi_jack; + bool jack_setup; +}; + +static void sc7280_jack_free(struct snd_jack *jack) +{ + struct snd_soc_component *component = jack->private_data; + + snd_soc_component_set_jack(component, NULL, NULL); +} + +static int sc7280_headset_init(struct snd_soc_pcm_runtime *rtd) +{ + struct snd_soc_card *card = rtd->card; + struct sc7280_snd_data *pdata = snd_soc_card_get_drvdata(card); + struct snd_soc_dai *codec_dai = asoc_rtd_to_codec(rtd, 0); + struct snd_soc_dai *cpu_dai = asoc_rtd_to_cpu(rtd, 0); + struct snd_soc_component *component = codec_dai->component; + struct snd_jack *jack; + int rval, i; + + if (!pdata->jack_setup) { + rval = snd_soc_card_jack_new(card, "Headset Jack", + SND_JACK_HEADSET | SND_JACK_LINEOUT | + SND_JACK_MECHANICAL | + SND_JACK_BTN_0 | SND_JACK_BTN_1 | + SND_JACK_BTN_2 | SND_JACK_BTN_3 | + SND_JACK_BTN_4 | SND_JACK_BTN_5, + &pdata->hs_jack, NULL, 0); + + if (rval < 0) { + dev_err(card->dev, "Unable to add Headset Jack\n"); + return rval; + } + + jack = pdata->hs_jack.jack; + + snd_jack_set_key(jack, SND_JACK_BTN_0, KEY_MEDIA); + snd_jack_set_key(jack, SND_JACK_BTN_1, KEY_VOICECOMMAND); + snd_jack_set_key(jack, SND_JACK_BTN_2, KEY_VOLUMEUP); + snd_jack_set_key(jack, SND_JACK_BTN_3, KEY_VOLUMEDOWN); + + jack->private_data = component; + jack->private_free = sc7280_jack_free; + pdata->jack_setup = true; + } + switch (cpu_dai->id) { + case LPASS_CDC_DMA_RX0: + case LPASS_CDC_DMA_TX3: + for_each_rtd_codec_dais(rtd, i, codec_dai) { + rval = snd_soc_component_set_jack(component, &pdata->hs_jack, NULL); + if (rval != 0 && rval != -EOPNOTSUPP) { + dev_warn(card->dev, "Failed to set jack: %d\n", rval); + return rval; + } + } + + break; + default: + break; + } + + return 0; +} + +static int sc7280_hdmi_init(struct snd_soc_pcm_runtime *rtd) +{ + struct snd_soc_card *card = rtd->card; + struct sc7280_snd_data *pdata = snd_soc_card_get_drvdata(card); + struct snd_soc_dai *codec_dai = asoc_rtd_to_codec(rtd, 0); + struct snd_soc_component *component = codec_dai->component; + struct snd_jack *jack; + int rval; + + rval = snd_soc_card_jack_new( + card, "HDMI Jack", + SND_JACK_LINEOUT, + &pdata->hdmi_jack, NULL, 0); + + if (rval < 0) { + dev_err(card->dev, "Unable to add HDMI Jack\n"); + return rval; + } + + jack = pdata->hdmi_jack.jack; + jack->private_data = component; + jack->private_free = sc7280_jack_free; + + return snd_soc_component_set_jack(component, &pdata->hdmi_jack, NULL); +} + +static int sc7280_init(struct snd_soc_pcm_runtime *rtd) +{ + struct snd_soc_dai *cpu_dai = asoc_rtd_to_cpu(rtd, 0); + + switch (cpu_dai->id) { + case LPASS_CDC_DMA_TX3: + return sc7280_headset_init(rtd); + case LPASS_CDC_DMA_RX0: + case LPASS_CDC_DMA_VA_TX0: + case MI2S_SECONDARY: + return 0; + case LPASS_DP_RX: + return sc7280_hdmi_init(rtd); + default: + dev_err(rtd->dev, "%s: invalid dai id 0x%x\n", __func__, cpu_dai->id); + return -EINVAL; + } + return 0; +} + +static int sc7280_snd_startup(struct snd_pcm_substream *substream) +{ + struct snd_soc_pcm_runtime *rtd = substream->private_data; + struct snd_soc_dai *cpu_dai = asoc_rtd_to_cpu(rtd, 0); + + switch (cpu_dai->id) { + case LPASS_CDC_DMA_RX0: + case LPASS_CDC_DMA_TX3: + case LPASS_CDC_DMA_VA_TX0: + break; + case MI2S_SECONDARY: + break; + case LPASS_DP_RX: + break; + default: + dev_err(rtd->dev, "%s: invalid dai id 0x%x\n", __func__, cpu_dai->id); + return -EINVAL; + } + return 0; +} + +static int sc7280_snd_hw_params(struct snd_pcm_substream *substream, + struct snd_pcm_hw_params *params) +{ + struct snd_pcm_runtime *runtime = substream->runtime; + struct snd_soc_pcm_runtime *rtd = substream->private_data; + struct snd_soc_dai *codec_dai; + struct snd_soc_dai *cpu_dai = asoc_rtd_to_cpu(rtd, 0); + struct sc7280_snd_data *pdata = snd_soc_card_get_drvdata(rtd->card); + struct sdw_stream_runtime *sruntime; + int i; + + snd_pcm_hw_constraint_minmax(runtime, SNDRV_PCM_HW_PARAM_CHANNELS, 2, 2); + snd_pcm_hw_constraint_minmax(runtime, SNDRV_PCM_HW_PARAM_RATE, 48000, 48000); + + switch (cpu_dai->id) { + case LPASS_CDC_DMA_TX3: + case LPASS_CDC_DMA_RX0: + for_each_rtd_codec_dais(rtd, i, codec_dai) { + sruntime = snd_soc_dai_get_sdw_stream(codec_dai, substream->stream); + if (sruntime != ERR_PTR(-EOPNOTSUPP)) + pdata->sruntime[cpu_dai->id] = sruntime; + } + break; + } + + return 0; + +} + +static int sc7280_snd_swr_prepare(struct snd_pcm_substream *substream) +{ + struct snd_soc_pcm_runtime *rtd = substream->private_data; + struct snd_soc_dai *cpu_dai = asoc_rtd_to_cpu(rtd, 0); + struct sc7280_snd_data *data = snd_soc_card_get_drvdata(rtd->card); + struct sdw_stream_runtime *sruntime = data->sruntime[cpu_dai->id]; + int ret; + + if (!sruntime) + return 0; + + if (data->stream_prepared[cpu_dai->id]) { + sdw_disable_stream(sruntime); + sdw_deprepare_stream(sruntime); + data->stream_prepared[cpu_dai->id] = false; + } + + ret = sdw_prepare_stream(sruntime); + if (ret) + return ret; + + ret = sdw_enable_stream(sruntime); + if (ret) { + sdw_deprepare_stream(sruntime); + return ret; + } + data->stream_prepared[cpu_dai->id] = true; + + return ret; +} + + +static int sc7280_snd_prepare(struct snd_pcm_substream *substream) +{ + struct snd_soc_pcm_runtime *rtd = substream->private_data; + struct snd_soc_dai *cpu_dai = asoc_rtd_to_cpu(rtd, 0); + + switch (cpu_dai->id) { + case LPASS_CDC_DMA_RX0: + case LPASS_CDC_DMA_TX3: + return sc7280_snd_swr_prepare(substream); + default: + break; + } + + return 0; +} + +static int sc7280_snd_hw_free(struct snd_pcm_substream *substream) +{ + struct snd_soc_pcm_runtime *rtd = substream->private_data; + struct sc7280_snd_data *data = snd_soc_card_get_drvdata(rtd->card); + struct snd_soc_dai *cpu_dai = asoc_rtd_to_cpu(rtd, 0); + struct sdw_stream_runtime *sruntime = data->sruntime[cpu_dai->id]; + + switch (cpu_dai->id) { + case LPASS_CDC_DMA_RX0: + case LPASS_CDC_DMA_TX3: + if (sruntime && data->stream_prepared[cpu_dai->id]) { + sdw_disable_stream(sruntime); + sdw_deprepare_stream(sruntime); + data->stream_prepared[cpu_dai->id] = false; + } + break; + default: + break; + } + return 0; +} + +static void sc7280_snd_shutdown(struct snd_pcm_substream *substream) +{ + struct snd_soc_pcm_runtime *rtd = substream->private_data; + struct snd_soc_dai *cpu_dai = asoc_rtd_to_cpu(rtd, 0); + + switch (cpu_dai->id) { + case LPASS_CDC_DMA_RX0: + case LPASS_CDC_DMA_TX3: + case LPASS_CDC_DMA_VA_TX0: + break; + case MI2S_SECONDARY: + break; + case LPASS_DP_RX: + break; + default: + dev_err(rtd->dev, "%s: invalid dai id 0x%x\n", __func__, cpu_dai->id); + break; + } +} + +static const struct snd_soc_ops sc7280_ops = { + .startup = sc7280_snd_startup, + .shutdown = sc7280_snd_shutdown, + .hw_params = sc7280_snd_hw_params, + .hw_free = sc7280_snd_hw_free, + .prepare = sc7280_snd_prepare, +}; + +static const struct snd_soc_dapm_widget sc7280_snd_widgets[] = { + SND_SOC_DAPM_HP("Headphone Jack", NULL), + SND_SOC_DAPM_MIC("Headset Mic", NULL), +}; + +static int sc7280_snd_platform_probe(struct platform_device *pdev) +{ + struct snd_soc_card *card; + struct sc7280_snd_data *data; + struct device *dev = &pdev->dev; + struct snd_soc_dai_link *link; + int ret, i; + + /* Allocate the private data */ + data = devm_kzalloc(dev, sizeof(*data), GFP_KERNEL); + if (!data) + return -ENOMEM; + + card = &data->card; + data->jack_setup = false; + snd_soc_card_set_drvdata(card, data); + + card->owner = THIS_MODULE; + card->driver_name = DRIVER_NAME; + card->dev = dev; + + ret = qcom_snd_parse_of(card); + if (ret) + return ret; + + for_each_card_prelinks(card, i, link) { + link->init = sc7280_init; + link->ops = &sc7280_ops; + } + ret = devm_snd_soc_register_card(dev, card); + return ret; +} + +static const struct of_device_id sc7280_snd_device_id[] = { + {.compatible = "google,sc7280-herobrine"}, + {}, +}; +MODULE_DEVICE_TABLE(of, sc7280_snd_device_id); + +static struct platform_driver sc7280_snd_driver = { + .probe = sc7280_snd_platform_probe, + .driver = { + .name = "msm-snd-sc7280", + .of_match_table = sc7280_snd_device_id, + .pm = &snd_soc_pm_ops, + }, +}; +module_platform_driver(sc7280_snd_driver); + +MODULE_DESCRIPTION("sc7280 ASoC Machine Driver"); +MODULE_LICENSE("GPL v2");
Add new machine driver to register sound card on sc7280 based targets and do the required configuration for lpass cpu dai and external codecs connected over MI2S and soundwire interfaces. Add support for audio jack detection, soundwire init and MBHC. Signed-off-by: Srinivasa Rao Mandadapu <srivasam@codeaurora.org> --- sound/soc/qcom/Kconfig | 12 ++ sound/soc/qcom/Makefile | 2 + sound/soc/qcom/sc7280.c | 347 ++++++++++++++++++++++++++++++++++++++++++++++++ 3 files changed, 361 insertions(+) create mode 100644 sound/soc/qcom/sc7280.c