[RESEND PATCH v2 10/15] ASoC: qcom: qdsp6: Add support to q6routing driver

[bjorn.andersson@linaro.org (Bjorn Andersson)]

On Thu 14 Dec 09:33 PST 2017, srinivas.kandagatla at linaro.org wrote:

> From: Srinivas Kandagatla <srinivas.kandagatla@linaro.org>
> 
> This patch adds support to q6 routing driver which configures route
> between ASM and AFE module using ADM apis.
> 
> This driver uses dapm widgets to setup the matrix between AFE ports and
> ASM streams.
> 

Why is this a separate driver from the q6adm?

> Signed-off-by: Srinivas Kandagatla <srinivas.kandagatla@linaro.org>
> ---
>  sound/soc/qcom/Kconfig           |   5 +
>  sound/soc/qcom/qdsp6/Makefile    |   1 +
>  sound/soc/qcom/qdsp6/q6routing.c | 386 +++++++++++++++++++++++++++++++++++++++
>  sound/soc/qcom/qdsp6/q6routing.h |   9 +
>  4 files changed, 401 insertions(+)
>  create mode 100644 sound/soc/qcom/qdsp6/q6routing.c
>  create mode 100644 sound/soc/qcom/qdsp6/q6routing.h
> 
> diff --git a/sound/soc/qcom/Kconfig b/sound/soc/qcom/Kconfig
> index 121b9c957024..dd8fb0cde614 100644
> --- a/sound/soc/qcom/Kconfig
> +++ b/sound/soc/qcom/Kconfig
> @@ -60,12 +60,17 @@ config SND_SOC_QDSP6_CORE
>  	tristate
>  	default n
>  
> +config SND_SOC_QDSP6_ROUTING
> +	tristate
> +	default n
> +
>  config SND_SOC_QDSP6
>  	tristate "SoC ALSA audio driver for QDSP6"
>  	select SND_SOC_QDSP6_AFE
>  	select SND_SOC_QDSP6_ADM
>  	select SND_SOC_QDSP6_ASM
>  	select SND_SOC_QDSP6_CORE
> +	select SND_SOC_QDSP6_ROUTING
>  	help
>  	 To add support for MSM QDSP6 Soc Audio.
>  	 This will enable sound soc platform specific
> diff --git a/sound/soc/qcom/qdsp6/Makefile b/sound/soc/qcom/qdsp6/Makefile
> index ad7f10691e54..c1ad060a2341 100644
> --- a/sound/soc/qcom/qdsp6/Makefile
> +++ b/sound/soc/qcom/qdsp6/Makefile
> @@ -2,3 +2,4 @@ obj-$(CONFIG_SND_SOC_QDSP6_AFE) += q6afe.o
>  obj-$(CONFIG_SND_SOC_QDSP6_ADM) += q6adm.o
>  obj-$(CONFIG_SND_SOC_QDSP6_ASM) += q6asm.o
>  obj-$(CONFIG_SND_SOC_QDSP6_CORE) += q6core.o
> +obj-$(CONFIG_SND_SOC_QDSP6_ROUTING) += q6routing.o
> diff --git a/sound/soc/qcom/qdsp6/q6routing.c b/sound/soc/qcom/qdsp6/q6routing.c
> new file mode 100644
> index 000000000000..f5f12d61a1ee
> --- /dev/null
> +++ b/sound/soc/qcom/qdsp6/q6routing.c
> @@ -0,0 +1,386 @@
> +/* SPDX-License-Identifier: GPL-2.0
> +* Copyright (c) 2011-2016, The Linux Foundation
> +* Copyright (c) 2017, Linaro Limited
> +*/
> +#include <linux/init.h>
> +#include <linux/err.h>
> +#include <linux/module.h>
> +#include <linux/platform_device.h>
> +#include <linux/bitops.h>
> +#include <linux/mutex.h>
> +#include <linux/of_device.h>
> +#include <linux/slab.h>
> +#include <sound/core.h>
> +#include <sound/soc.h>
> +#include <sound/soc-dapm.h>
> +#include <sound/pcm.h>
> +#include <sound/control.h>
> +#include <sound/asound.h>
> +#include <sound/pcm_params.h>
> +#include "q6afe.h"
> +#include "q6asm.h"
> +#include "q6adm.h"
> +#include "q6routing.h"
> +
> +struct session_data {
> +	int state;
> +	int port_id;
> +	int path_type;
> +	int app_type;
> +	int acdb_id;
> +	int sample_rate;
> +	int bits_per_sample;
> +	int channels;
> +	int format;
> +	int perf_mode;
> +	int numcopps;
> +	int fedai_id;
> +	unsigned long copp_map;
> +};
> +
> +struct msm_routing_data {
> +	struct session_data sessions[MAX_SESSIONS];
> +	struct device *dev;
> +	struct mutex lock;
> +};
> +
> +static struct msm_routing_data *routing_data;
> +
> +/**
> + * q6routing_reg_phy_stream() - Register a new stream for route setup
> + *
> + * @fedai_id: Frontend dai id.
> + * @perf_mode: Performace mode.

"Performance"

> + * @stream_id: ASM stream id to map.
> + * @stream_type: Direction of stream
> + *
> + * Return: Will be an negative on error or a zero on success.
> + */
> +int q6routing_reg_phy_stream(int fedai_id, int perf_mode,

q6routing_stream_open() ?

> +			   int stream_id, int stream_type)
> +{
> +	int j, topology, num_copps = 0;
> +	struct route_payload payload;
> +	int copp_idx;
> +	struct session_data *session;
> +
> +	if (!routing_data) {
> +		pr_err("Routing driver not yet ready\n");
> +		return -EINVAL;
> +	}
> +
> +	session = &routing_data->sessions[stream_id - 1];
> +	mutex_lock(&routing_data->lock);
> +	session->fedai_id = fedai_id;
> +	payload.num_copps = 0; /* only RX needs to use payload */
> +	topology = NULL_COPP_TOPOLOGY;
> +	copp_idx = q6adm_open(routing_data->dev, session->port_id,
> +			      session->path_type, session->sample_rate,
> +			      session->channels, topology, perf_mode,
> +			      session->bits_per_sample, 0, 0);
> +	if ((copp_idx < 0) || (copp_idx >= MAX_COPPS_PER_PORT)) {

Make q6adm_open() not return >= MAX_COPPS_PER_PORT.

And drop the extra parenthesis.

> +		mutex_unlock(&routing_data->lock);
> +		return -EINVAL;
> +	}
> +
> +	set_bit(copp_idx, &session->copp_map);
> +	for (j = 0; j < MAX_COPPS_PER_PORT; j++) {

Use for_each_set_bit()

> +		unsigned long copp = session->copp_map;
> +
> +		if (test_bit(j, &copp)) {
> +			payload.port_id[num_copps] = session->port_id;
> +			payload.copp_idx[num_copps] = j;
> +			num_copps++;
> +		}
> +	}
> +
> +	if (num_copps) {
> +		payload.num_copps = num_copps;
> +		payload.session_id = stream_id;
> +		q6adm_matrix_map(routing_data->dev, session->path_type,
> +				 payload, perf_mode);
> +	}
> +	mutex_unlock(&routing_data->lock);
> +
> +	return 0;
> +}
> +EXPORT_SYMBOL_GPL(q6routing_reg_phy_stream);
> +
> +static struct session_data *routing_get_session(struct msm_routing_data *data,
> +						int port_id, int port_type)

port_type is ignored

> +{
> +	int i;
> +
> +	for (i = 0; i < MAX_SESSIONS; i++)
> +		if (port_id == data->sessions[i].port_id)
> +			return &data->sessions[i];
> +
> +	return NULL;
> +}
> +
> +static struct session_data *get_session_from_id(struct msm_routing_data *data,
> +						int fedai_id)
> +{
> +	int i;
> +
> +	for (i = 0; i < MAX_SESSIONS; i++) {
> +		if (fedai_id == data->sessions[i].fedai_id)
> +			return &data->sessions[i];
> +	}
> +
> +	return NULL;
> +}
> +/**
> + * q6routing_dereg_phy_stream() - Deregister a stream
> + *
> + * @fedai_id: Frontend dai id.
> + * @stream_type: Direction of stream
> + *
> + * Return: Will be an negative on error or a zero on success.
> + */
> +void q6routing_dereg_phy_stream(int fedai_id, int stream_type)

q6routing_stream_close()?

> +{
> +	struct session_data *session;
> +	int idx;
> +
> +	session = get_session_from_id(routing_data, fedai_id);
> +	if (!session)
> +		return;
> +
> +	for_each_set_bit(idx, &session->copp_map, MAX_COPPS_PER_PORT)
> +		q6adm_close(routing_data->dev, session->port_id,
> +			    session->perf_mode, idx);
> +
> +	session->fedai_id = -1;
> +	session->copp_map = 0;
> +}
> +EXPORT_SYMBOL_GPL(q6routing_dereg_phy_stream);
> +
> +static int msm_routing_get_audio_mixer(struct snd_kcontrol *kcontrol,
> +				       struct snd_ctl_elem_value *ucontrol)
> +{
> +	struct snd_soc_dapm_context *dapm =
> +	    snd_soc_dapm_kcontrol_dapm(kcontrol);
> +	struct soc_mixer_control *mc =
> +	    (struct soc_mixer_control *)kcontrol->private_value;
> +	int session_id = mc->shift;
> +	struct snd_soc_platform *platform = snd_soc_dapm_to_platform(dapm);
> +	struct msm_routing_data *priv = snd_soc_platform_get_drvdata(platform);
> +	struct session_data *session = &priv->sessions[session_id];
> +
> +	if (session->port_id != -1)
> +		ucontrol->value.integer.value[0] = 1;
> +	else
> +		ucontrol->value.integer.value[0] = 0;
> +
> +	return 0;
> +}
> +
> +static int msm_routing_put_audio_mixer(struct snd_kcontrol *kcontrol,
> +				       struct snd_ctl_elem_value *ucontrol)
> +{
> +	struct snd_soc_dapm_context *dapm =
> +				    snd_soc_dapm_kcontrol_dapm(kcontrol);
> +	struct snd_soc_platform *platform = snd_soc_dapm_to_platform(dapm);
> +	struct msm_routing_data *data = snd_soc_platform_get_drvdata(platform);
> +	struct soc_mixer_control *mc =
> +		    (struct soc_mixer_control *)kcontrol->private_value;
> +	struct snd_soc_dapm_update *update = NULL;
> +	int be_id = mc->reg;
> +	int session_id = mc->shift;
> +	struct session_data *session = &data->sessions[session_id];
> +
> +	if (ucontrol->value.integer.value[0]) {
> +		session->port_id = be_id;
> +		snd_soc_dapm_mixer_update_power(dapm, kcontrol, 1, update);
> +	} else {
> +		session->port_id = -1;
> +		snd_soc_dapm_mixer_update_power(dapm, kcontrol, 0, update);
> +	}
> +
> +	return 1;
> +}
> +
> +static const struct snd_kcontrol_new hdmi_mixer_controls[] = {
> +	SOC_SINGLE_EXT("MultiMedia1", AFE_PORT_HDMI_RX,
> +		       MSM_FRONTEND_DAI_MULTIMEDIA1, 1, 0,
> +		       msm_routing_get_audio_mixer,
> +		       msm_routing_put_audio_mixer),
> +	SOC_SINGLE_EXT("MultiMedia2", AFE_PORT_HDMI_RX,
> +		       MSM_FRONTEND_DAI_MULTIMEDIA2, 1, 0,
> +		       msm_routing_get_audio_mixer,
> +		       msm_routing_put_audio_mixer),
> +	SOC_SINGLE_EXT("MultiMedia3", AFE_PORT_HDMI_RX,
> +		       MSM_FRONTEND_DAI_MULTIMEDIA3, 1, 0,
> +		       msm_routing_get_audio_mixer,
> +		       msm_routing_put_audio_mixer),
> +	SOC_SINGLE_EXT("MultiMedia4", AFE_PORT_HDMI_RX,
> +		       MSM_FRONTEND_DAI_MULTIMEDIA4, 1, 0,
> +		       msm_routing_get_audio_mixer,
> +		       msm_routing_put_audio_mixer),
> +	SOC_SINGLE_EXT("MultiMedia5", AFE_PORT_HDMI_RX,
> +		       MSM_FRONTEND_DAI_MULTIMEDIA5, 1, 0,
> +		       msm_routing_get_audio_mixer,
> +		       msm_routing_put_audio_mixer),
> +	SOC_SINGLE_EXT("MultiMedia6", AFE_PORT_HDMI_RX,
> +		       MSM_FRONTEND_DAI_MULTIMEDIA6, 1, 0,
> +		       msm_routing_get_audio_mixer,
> +		       msm_routing_put_audio_mixer),
> +	SOC_SINGLE_EXT("MultiMedia7", AFE_PORT_HDMI_RX,
> +		       MSM_FRONTEND_DAI_MULTIMEDIA7, 1, 0,
> +		       msm_routing_get_audio_mixer,
> +		       msm_routing_put_audio_mixer),
> +	SOC_SINGLE_EXT("MultiMedia8", AFE_PORT_HDMI_RX,
> +		       MSM_FRONTEND_DAI_MULTIMEDIA8, 1, 0,
> +		       msm_routing_get_audio_mixer,
> +		       msm_routing_put_audio_mixer),
> +};
> +
> +static const struct snd_soc_dapm_widget msm_qdsp6_widgets[] = {
> +	/* Frontend AIF */
> +	/* Widget name equals to Front-End DAI name<Need confirmation>,

Perhaps this should be confirmed and the comment updated?

> +	 * Stream name must contains substring of front-end dai name
> +	 */
> +	SND_SOC_DAPM_AIF_IN("MM_DL1", "MultiMedia1 Playback", 0, 0, 0, 0),
> +	SND_SOC_DAPM_AIF_IN("MM_DL2", "MultiMedia2 Playback", 0, 0, 0, 0),
> +	SND_SOC_DAPM_AIF_IN("MM_DL3", "MultiMedia3 Playback", 0, 0, 0, 0),
> +	SND_SOC_DAPM_AIF_IN("MM_DL4", "MultiMedia4 Playback", 0, 0, 0, 0),
> +	SND_SOC_DAPM_AIF_IN("MM_DL5", "MultiMedia5 Playback", 0, 0, 0, 0),
> +	SND_SOC_DAPM_AIF_IN("MM_DL6", "MultiMedia6 Playback", 0, 0, 0, 0),
> +	SND_SOC_DAPM_AIF_IN("MM_DL7", "MultiMedia7 Playback", 0, 0, 0, 0),
> +	SND_SOC_DAPM_AIF_IN("MM_DL8", "MultiMedia8 Playback", 0, 0, 0, 0),
> +
> +	/* Mixer definitions */
> +	SND_SOC_DAPM_MIXER("HDMI Mixer", SND_SOC_NOPM, 0, 0,
> +			   hdmi_mixer_controls,
> +			   ARRAY_SIZE(hdmi_mixer_controls)),
> +};
> +
> +static const struct snd_soc_dapm_route intercon[] = {
> +	{"HDMI Mixer", "MultiMedia1", "MM_DL1"},
> +	{"HDMI Mixer", "MultiMedia2", "MM_DL2"},
> +	{"HDMI Mixer", "MultiMedia3", "MM_DL3"},
> +	{"HDMI Mixer", "MultiMedia4", "MM_DL4"},
> +	{"HDMI Mixer", "MultiMedia5", "MM_DL5"},
> +	{"HDMI Mixer", "MultiMedia6", "MM_DL6"},
> +	{"HDMI Mixer", "MultiMedia7", "MM_DL7"},
> +	{"HDMI Mixer", "MultiMedia8", "MM_DL8"},
> +	{"HDMI", NULL, "HDMI Mixer"},
> +	{"HDMI-RX", NULL, "HDMI"},
> +};
> +
> +static int routing_hw_params(struct snd_pcm_substream *substream,
> +				     struct snd_pcm_hw_params *params)
> +{
> +	struct snd_soc_pcm_runtime *rtd = substream->private_data;
> +	unsigned int be_id = rtd->cpu_dai->id;
> +	struct snd_soc_platform *platform = rtd->platform;
> +	struct msm_routing_data *data = snd_soc_platform_get_drvdata(platform);
> +	struct session_data *session;
> +	int port_id, port_type, path_type, bits_per_sample;

bits_per_sample is likely unused.

> +
> +	if (substream->stream == SNDRV_PCM_STREAM_PLAYBACK) {
> +		path_type = ADM_PATH_PLAYBACK;
> +		port_type = MSM_AFE_PORT_TYPE_RX;
> +	}
> +
> +	port_id = be_id;

Why alias this variable?

> +
> +	session = routing_get_session(data, port_id, port_type);
> +
> +	if (!session) {
> +		pr_err("No session matrix setup yet..\n");
> +		return -EINVAL;
> +	}
> +
> +	mutex_lock(&data->lock);
> +
> +	session->path_type = path_type;
> +	session->sample_rate = params_rate(params);
> +	session->channels = params_channels(params);
> +	session->format = params_format(params);
> +
> +	if (session->format == SNDRV_PCM_FORMAT_S16_LE)
> +		session->bits_per_sample = 16;
> +	else if (session->format == SNDRV_PCM_FORMAT_S24_LE)
> +		bits_per_sample = 24;

session-> ?

Perhaps switch on params_format(params) instead? And fail in the default
case.

> +
> +	mutex_unlock(&data->lock);
> +	return 0;
> +}
> +
> +static int routing_close(struct snd_pcm_substream *substream)
> +{
> +	return 0;
> +}
> +
> +static int routing_prepare(struct snd_pcm_substream *substream)
> +{
> +	return 0;
> +}
> +
> +static struct snd_pcm_ops q6pcm_routing_ops = {
> +	.hw_params = routing_hw_params,
> +	.close = routing_close,
> +	.prepare = routing_prepare,
> +};
> +
> +/* Not used but frame seems to require it */

Remove comment?

> +static int msm_routing_probe(struct snd_soc_platform *platform)
> +{
> +	int i;
> +
> +	for (i = 0; i < MAX_SESSIONS; i++)
> +		routing_data->sessions[i].port_id = -1;
> +
> +	snd_soc_platform_set_drvdata(platform, routing_data);
> +
> +	return 0;
> +}
> +
> +static struct snd_soc_platform_driver msm_soc_routing_platform = {
> +	.ops = &q6pcm_routing_ops,
> +	.probe = msm_routing_probe,
> +	.component_driver = {
> +			     .dapm_widgets = msm_qdsp6_widgets,
> +			     .num_dapm_widgets = ARRAY_SIZE(msm_qdsp6_widgets),
> +			     .dapm_routes = intercon,
> +			     .num_dapm_routes = ARRAY_SIZE(intercon),
> +			     },
> +};
> +
> +static int q6pcm_routing_probe(struct platform_device *pdev)
> +{
> +
> +	routing_data = devm_kzalloc(&pdev->dev,
> +				    sizeof(*routing_data), GFP_KERNEL);
> +	if (!routing_data)
> +		return -ENOMEM;
> +
> +	routing_data->dev = &pdev->dev;
> +
> +	mutex_init(&routing_data->lock);
> +	dev_set_drvdata(&pdev->dev, routing_data);
> +
> +	return devm_snd_soc_register_platform(&pdev->dev,
> +					      &msm_soc_routing_platform);
> +}
> +
> +static int q6pcm_routing_remove(struct platform_device *pdev)
> +{

As you return here routing_data will be freed.  The early check in
q6routing_reg_phy_stream() seems to indicate that this driver can be
called even though the routing device isn't available.

So you probably want to clear that variable, at least.

> +	return 0;
> +}
> +
> +static struct platform_driver q6pcm_routing_driver = {
> +	.driver = {
> +		   .name = "q6routing",
> +		   .owner = THIS_MODULE,

Drop .owner

> +		   },
> +	.probe = q6pcm_routing_probe,
> +	.remove = q6pcm_routing_remove,
> +};
> +
> +module_platform_driver(q6pcm_routing_driver);
> +
> +MODULE_DESCRIPTION("Q6 Routing platform");
> +MODULE_LICENSE("GPL v2");
> diff --git a/sound/soc/qcom/qdsp6/q6routing.h b/sound/soc/qcom/qdsp6/q6routing.h
> new file mode 100644
> index 000000000000..7f0feb196acc
> --- /dev/null
> +++ b/sound/soc/qcom/qdsp6/q6routing.h
> @@ -0,0 +1,9 @@
> +/* SPDX-License-Identifier: GPL-2.0 */
> +#ifndef _Q6_PCM_ROUTING_H
> +#define _Q6_PCM_ROUTING_H
> +
> +int q6routing_reg_phy_stream(int fedai_id, int perf_mode,
> +			   int stream_id, int stream_type);
> +void q6routing_dereg_phy_stream(int fedai_id, int stream_type);
> +
> +#endif /*_Q6_PCM_ROUTING_H */
> -- 
> 2.15.0
>