[PATCH v6 1/2] ASoC:codecs: Add a transmitter interface to the HDMI CODEC CODEC

[Andrew Jackson]

On 09/24/14 08:49, Jean-Francois Moine wrote:
> The audio constraints of the HDMI interface are defined by the EDID
> which is sent by the connected device.
> 
> The HDMI transmitters may have one or many audio sources.
> 
> This patch adds two functions to the HDMI CODEC:
> - it updates the audio constraints from the EDID,
> - it gives the audio source type to the HDMI transmitter
>   on start of audio streaming.
> 
> Signed-off-by: Jean-Francois Moine <moinejf at free.fr>
> ---
>  include/sound/hdmi.h    |  20 ++++++
>  sound/soc/codecs/hdmi.c | 174 ++++++++++++++++++++++++++++++++++++++++++++++--
>  2 files changed, 188 insertions(+), 6 deletions(-)
>  create mode 100644 include/sound/hdmi.h
> 
> diff --git a/include/sound/hdmi.h b/include/sound/hdmi.h
> new file mode 100644
> index 0000000..49062c7
> --- /dev/null
> +++ b/include/sound/hdmi.h
> @@ -0,0 +1,20 @@
> +#ifndef SND_HDMI_H
> +#define SND_HDMI_H
> +
> +#include <sound/soc.h>
> +
> +/* platform_data */
> +struct hdmi_data {
> +	int (*get_audio)(struct device *dev,
> +			 int *max_channels,
> +			 int *rate_mask,
> +			 int *fmt);
> +	void (*audio_switch)(struct device *dev,
> +			     int port_index,
> +			     unsigned sample_rate,
> +			     int sample_format);
> +	int ndais;
> +	struct snd_soc_dai_driver *dais;
> +	struct snd_soc_codec_driver *driver;
> +};
> +#endif
> diff --git a/sound/soc/codecs/hdmi.c b/sound/soc/codecs/hdmi.c
> index 1087fd5..6ea2772 100644
> --- a/sound/soc/codecs/hdmi.c
> +++ b/sound/soc/codecs/hdmi.c
> @@ -22,9 +22,146 @@
>  #include <sound/soc.h>
>  #include <linux/of.h>
>  #include <linux/of_device.h>
> +#include <sound/pcm_params.h>
> +#include <sound/hdmi.h>
>  
>  #define DRV_NAME "hdmi-audio-codec"
>  
> +struct hdmi_priv {
> +	struct hdmi_data hdmi_data;
> +	struct snd_pcm_hw_constraint_list rate_constraints;
> +};
> +
> +static int hdmi_dev_match(struct device *dev, void *data)
> +{
> +	return !strcmp(dev_name(dev), (char *) data);
> +}
> +
> +/* get the codec device */
> +static struct device *hdmi_get_cdev(struct device *dev)
> +{
> +	struct device *cdev;
> +
> +	cdev = device_find_child(dev,
> +				 DRV_NAME,
> +				 hdmi_dev_match);
> +	if (!cdev)
> +		dev_err(dev, "Cannot get codec device");
> +	else
> +		put_device(cdev);
> +	return cdev;
> +}
> +
> +static int hdmi_startup(struct snd_pcm_substream *substream,
> +			struct snd_soc_dai *dai)
> +{
> +	struct snd_pcm_runtime *runtime = substream->runtime;
> +	struct device *cdev;
> +	struct hdmi_priv *priv;
> +	struct snd_pcm_hw_constraint_list *rate_constraints;
> +	int ret, max_channels, rate_mask, fmt;
> +	u64 formats;
> +	static const u32 hdmi_rates[] = {
> +		32000, 44100, 48000, 88200, 96000, 176400, 192000
> +	};
> +
> +	cdev = hdmi_get_cdev(dai->dev);
> +	if (!cdev)
> +		return -ENODEV;
> +	priv = dev_get_drvdata(cdev);

It might be a good idea to qualify priv (and perhaps get_audio and audio_switch) here?  This might be that the relevant (function) pointers are non-NULL.

	Andrew

> +
> +	/* get the EDID values and the rate constraints buffer */
> +	ret = priv->hdmi_data.get_audio(dai->dev,
> +					&max_channels, &rate_mask, &fmt);
> +	if (ret < 0)
> +		return ret;				/* no screen */
> +
> +	/* convert the EDID values to audio constraints */
> +	rate_constraints = &priv->rate_constraints;
> +	rate_constraints->list = hdmi_rates;
> +	rate_constraints->count = ARRAY_SIZE(hdmi_rates);
> +	rate_constraints->mask = rate_mask;
> +	snd_pcm_hw_constraint_list(runtime, 0,
> +				   SNDRV_PCM_HW_PARAM_RATE,
> +				   rate_constraints);
> +
> +	formats = 0;
> +	if (fmt & 1)
> +		formats |= SNDRV_PCM_FMTBIT_S16_LE;
> +	if (fmt & 2)
> +		formats |= SNDRV_PCM_FMTBIT_S20_3LE;
> +	if (fmt & 4)
> +		formats |= SNDRV_PCM_FMTBIT_S24_LE;
> +	snd_pcm_hw_constraint_mask64(runtime,
> +				SNDRV_PCM_HW_PARAM_FORMAT,
> +				formats);
> +
> +	snd_pcm_hw_constraint_minmax(runtime,
> +				SNDRV_PCM_HW_PARAM_CHANNELS,
> +				1, max_channels);
> +	return 0;
> +}
> +
> +static int hdmi_hw_params(struct snd_pcm_substream *substream,
> +			  struct snd_pcm_hw_params *params,
> +			  struct snd_soc_dai *dai)
> +{
> +	struct device *cdev;
> +	struct hdmi_priv *priv;
> +
> +	cdev = hdmi_get_cdev(dai->dev);
> +	if (!cdev)
> +		return -ENODEV;
> +	priv = dev_get_drvdata(cdev);
> +
> +	priv->hdmi_data.audio_switch(dai->dev, dai->id,
> +				     params_rate(params),
> +				     params_format(params));
> +	return 0;
> +}
> +
> +static void hdmi_shutdown(struct snd_pcm_substream *substream,
> +			  struct snd_soc_dai *dai)
> +{
> +	struct device *cdev;
> +	struct hdmi_priv *priv;
> +
> +	cdev = hdmi_get_cdev(dai->dev);
> +	if (!cdev)
> +		return;
> +	priv = dev_get_drvdata(cdev);
> +
> +	priv->hdmi_data.audio_switch(dai->dev, -1, 0, 0);	/* stop */
> +}
> +
> +static const struct snd_soc_dai_ops hdmi_ops = {
> +	.startup = hdmi_startup,
> +	.hw_params = hdmi_hw_params,
> +	.shutdown = hdmi_shutdown,
> +};
> +
> +static int hdmi_codec_probe(struct snd_soc_codec *codec)
> +{
> +	struct hdmi_priv *priv;
> +	struct device *dev = codec->dev;	/* encoder device */
> +	struct device *cdev;			/* codec device */
> +
> +	cdev = hdmi_get_cdev(dev);
> +	if (!cdev)
> +		return -ENODEV;
> +
> +	/* allocate some memory to store
> +	 * the encoder callback functions and the rate constraints */
> +	priv = devm_kzalloc(cdev, sizeof *priv, GFP_KERNEL);
> +	if (!priv)
> +		return -ENOMEM;
> +	dev_set_drvdata(cdev, priv);
> +
> +	memcpy(&priv->hdmi_data, cdev->platform_data,
> +				sizeof priv->hdmi_data);
> +	return 0;
> +}
> +
>  static const struct snd_soc_dapm_widget hdmi_widgets[] = {
>  	SND_SOC_DAPM_INPUT("RX"),
>  	SND_SOC_DAPM_OUTPUT("TX"),
> @@ -77,13 +214,38 @@ static struct snd_soc_codec_driver hdmi_codec = {
>  	.num_dapm_routes = ARRAY_SIZE(hdmi_routes),
>  };
>  
> -static int hdmi_codec_probe(struct platform_device *pdev)
> +static int hdmi_codec_dev_probe(struct platform_device *pdev)
>  {
> -	return snd_soc_register_codec(&pdev->dev, &hdmi_codec,
> -			&hdmi_codec_dai, 1);
> +	struct hdmi_data *pdata = pdev->dev.platform_data;
> +	struct snd_soc_dai_driver *dais;
> +	struct snd_soc_codec_driver *driver;
> +	int i, ret;
> +
> +	if (!pdata)
> +		return snd_soc_register_codec(&pdev->dev, &hdmi_codec,
> +						&hdmi_codec_dai, 1);
> +
> +	/* creation from a video encoder as a child device */
> +	dais = devm_kmemdup(&pdev->dev,
> +			    pdata->dais,
> +			    sizeof *pdata->dais * pdata->ndais,
> +			    GFP_KERNEL);
> +	for (i = 0; i < pdata->ndais; i++)
> +		dais[i].ops = &hdmi_ops;
> +
> +	driver = devm_kmemdup(&pdev->dev,
> +			    pdata->driver,
> +			    sizeof *pdata->driver,
> +			    GFP_KERNEL);
> +	driver->probe = hdmi_codec_probe;
> +
> +	/* register the codec on the video encoder */
> +	ret = snd_soc_register_codec(pdev->dev.parent, driver,
> +					dais, pdata->ndais);
> +	return ret;
>  }
>  
> -static int hdmi_codec_remove(struct platform_device *pdev)
> +static int hdmi_codec_dev_remove(struct platform_device *pdev)
>  {
>  	snd_soc_unregister_codec(&pdev->dev);
>  	return 0;
> @@ -96,8 +258,8 @@ static struct platform_driver hdmi_codec_driver = {
>  		.of_match_table = of_match_ptr(hdmi_audio_codec_ids),
>  	},
>  
> -	.probe		= hdmi_codec_probe,
> -	.remove		= hdmi_codec_remove,
> +	.probe		= hdmi_codec_dev_probe,
> +	.remove		= hdmi_codec_dev_remove,
>  };
>  
>  module_platform_driver(hdmi_codec_driver);
>