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);
>
