Re: [PATCH 2/2] ASoC: qcom: SC7280: Add machine driver
From: Stephen Boyd
Date: Wed Sep 08 2021 - 18:42:53 EST
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);
> +